1 /* SPDX-License-Identifier: GPL-2.0-or-later */
3 /***************************************************************************
4 * Copyright (C) 2006 by Magnus Lundin *
7 * Copyright (C) 2008 by Spencer Oliver *
8 * spen@spen-soft.co.uk *
9 ***************************************************************************/
22 * r3 = count (32bit words)
25 * r4 = pFLASH_CTRL_BASE
32 ldr r4, pFLASH_CTRL_BASE
36 ldr r8, [r0, #0] /* read wp */
37 cmp r8, #0 /* abort if wp == 0 */
39 ldr r7, [r0, #4] /* read rp */
40 cmp r7, r8 /* wait until rp != wp */
44 str r2, [r4, #0] /* FMA - write address */
45 add r2, r2, #4 /* increment target address */
47 str r8, [r4, #4] /* FMD - write data */
48 str r5, [r4, #8] /* FMC - enable write */
54 cmp r7, r1 /* wrap rp at end of buffer */
56 addcs r7, r0, #8 /* skip loader args */
57 str r7, [r0, #4] /* store rp */
58 subs r3, r3, #1 /* decrement word count */
59 cbz r3, exit /* loop if not done */
64 pFLASH_CTRL_BASE: .word 0x400FD000
65 FLASHWRITECMD: .word 0xA4420001