contrib/loaders/flash/numicro_m4/numicro_m4.S

   1 /* SPDX-License-Identifier: GPL-2.0-or-later */
   2
   3 /***************************************************************************
   4  *   Copyright (C) 2017 Zale Yu                                            *
   5  *   CYYU@nuvoton.com                                                      *
   6  *                                                                         *
   7  *   Copyright (C) 2022 Jian-Hong Pan                                      *
   8  *   chienhung.pan@gmail.com                                               *
   9  ***************************************************************************/
  10
  11         .text
  12         .cpu cortex-m4
  13         .thumb
  14
  15         /* Params:
  16          * r0 - workarea buffer / result
  17          * r1 - target address
  18          * r2 - wordcount
  19          * Clobbered:
  20          * r4 - tmp
  21          * r5 - tmp
  22          * r6 - tmp
  23          * r7 - tmp
  24          */
  25
  26 .L1:
  27         /* for(register uint32_t i=0;i<wcount;i++){ */
  28         mov     r4, r0
  29         mov     r3, #0
  30 .L2:
  31         sub     r5, r1, r0
  32         add     r7, r4, r5
  33         cmp     r3, r2
  34         beq     .L7
  35 .L4:
  36         /* NUMICRO_FLASH_ISPADR = faddr; */
  37         ldr     r6, .L8
  38         str     r7, [r6]
  39         /* NUMICRO_FLASH_ISPDAT = *pLW; */
  40         ldmia   r4!, {r7}
  41         ldr     r5, .L8+4
  42         str     r7, [r5]
  43         /* faddr += 4; */
  44         /* pLW++; */
  45         /*  Trigger write action  */
  46         /* NUMICRO_FLASH_ISPTRG = ISPTRG_ISPGO; */
  47         ldr     r5, .L8+8
  48         mov     r6, #1
  49         str     r6, [r5]
  50 .L3:
  51         /* while((NUMICRO_FLASH_ISPTRG & ISPTRG_ISPGO) == ISPTRG_ISPGO){}; */
  52         ldr     r7, [r5]
  53         lsl     r7, r7, #31
  54         bmi     .L3
  55
  56         add     r3, r3, #1
  57         b       .L2
  58 .L7:
  59         /* return (NUMICRO_FLASH_ISPCON & ISPCON_ISPFF); */
  60         ldr     r3, .L8+12
  61         ldr     r0, [r3]
  62         mov     r1, #64
  63         and     r0, r1
  64 .L9:
  65         bkpt    #0
  66 .L8:
  67         .word   0x4000C004
  68         .word   0x4000C008
  69         .word   0x4000C010
  70         .word   0x4000C000