2020年01月06日 | ARM Memory Copy

  1         MODULE  ARM_MEMORY

  2 

  3         PUBLIC  ARM_MEMCPY

  4         PUBLIC  ARM_MEMSET

  5         PUBLIC  ARM_MEMSET8

  6         PUBLIC  ARM_MEMSET16

  7         PUBLIC  ARM_MEMSET32

  8 

  9         SECTION .text:CODE:NOROOT(2)

 10         CODE32

 11 

 12 ;-------------------------------------------------------------------------------

 13 ; void ARM_MEMCPY(void* pDest, void* pSrc, U32 NumBytes)

 14 ;

 15 ; Function description

 16 ;   Copy data in memory from source address to destination address.

 17 ;

 18 ; Register usage:

 19 ;

 20 ;   R0    pDest

 21 ;   R1    pSrc

 22 ;   R2    NumBytes

 23 ;

 24 ;   R3    Used for data transfers

 25 ;   R4    Used for data transfers

 26 ;   R12   Used for data transfers

 27 ;   R14   Used for data transfers

 28 ;

 29 ;   R13   SP

 30 ;   R14   LR (contains return address)

 31 ;   R15   PC

 32 ;

 33 ;-------------------------------------------------------------------------------

 34 ARM_MEMCPY:

 35 ;-------------------------------------------------------------------------------

 36         cmp         R2, #+3                           ; R2 = NumBytes

 37         bls         ARM_MEMCPY_HandleTrailingBytes    ; If we have less than one complete word, use single byte transfer

 38 

 39         ands        R12, R0, #+3                      ; R0 = destination address

 40         beq         ARM_MEMCPY_DestIsDWordAligned     ; Is destination address already word aligned ?

 41 

 42 ;-------------------------------------------------------------------------------

 43 ; Handle as much bytes as necessary to align destination address

 44 ;

 45         ldrb        R3, [R1], #+1                     ; We need at least one byte to the next word alignment, so we read one.

 46         cmp         R12, #+2                          ; Set condition codes according to the mis-alignment

 47         add         R2, R2, R12                       ; Adjust NumBytes : 1, 2, 3

 48         ldrbls      R12, [R1], #+1                    ; Lower or same (LS)? -> We need one or two bytes to the next word aligned address

 49         strb        R3, [R0], #+1

 50         ldrbcc      R3, [R1], #+1                     ; Carry clear (CC)? -> We need one more byte

 51         strbls      R12, [R0], #+1

 52         sub         R2, R2, #+4                       ; Adjust NumBytes

 53         strbcc      R3, [R0], #+1                     ; now destination address already is word aligned

 54 

 55 ;-------------------------------------------------------------------------------

 56 ; Choose best way to transfer data

 57 ;

 58 ARM_MEMCPY_DestIsDWordAligned:

 59         ands        R3, R1, #+3

 60         beq         ARM_MEMCPY_HandleBulkWordData     ; If source and destination are aligned, use bulk word transfer

 61 

 62         subs        R2, R2, #+4

 63         bcc         ARM_MEMCPY_HandleTrailingBytes    ; If we have less than one complete word left, use single byte transfer

 64 

 65         ldr         R12, [R1, -R3]!                   ; Read first mis-aligned data word and word align source address

 66         cmp         R3, #+2

 67         beq         ARM_MEMCPY_Loop16BitShift

 68 

 69         bhi         ARM_MEMCPY_Loop24BitShift

 70 

 71 ;-------------------------------------------------------------------------------

 72 ; Handle data in units of word

 73 ;

 74 ; This is done by reading mis-aligned words from source address and

 75 ; shift them into the right alignment. After this the next data word

 76 ; will be read to complete the missing data part.

 77 ;

 78 ARM_MEMCPY_Loop8BitShift:

 79         mov         R3, R12, LSR #+8           ; Shift data word into right position

 80         ldr         R12, [R1, #+4]!            ; Load next mis-aligned data word

 81         subs        R2, R2, #+4                ; Decrement NumBytes

 82         orr         R3, R3, R12, LSL #+24      ; Combine missing part of data to build full data word

 83         str         R3, [R0], #+4              ; Store complete word

 84         bcs         ARM_MEMCPY_Loop8BitShift

 85 

 86         add         R1, R1, #+1                ; Adjust source address

 87         b           ARM_MEMCPY_HandleTrailingBytes         ; Handle trailing bytes

 88 

 89 ARM_MEMCPY_Loop16BitShift:

 90         mov         R3, R12, LSR #+16          ; Shift data word into right position

 91         ldr         R12, [R1, #+4]!            ; Load next mis-aligned data word

 92         subs        R2, R2, #+4                ; Decrement NumBytes

 93         orr         R3, R3, R12, LSL #+16      ; Combine missing part of data to build full data word

 94         str         R3, [R0], #+4              ; Store complete word

 95         bcs         ARM_MEMCPY_Loop16BitShift

 96 

 97         add         R1, R1, #+2                ; Adjust source address

 98         b           ARM_MEMCPY_HandleTrailingBytes         ; Handle trailing bytes

 99 

100 ARM_MEMCPY_Loop24BitShift:

101         mov         R3, R12, LSR #+24          ; Shift data word into right position

102         ldr         R12, [R1, #+4]!            ; Load next mis-aligned data word

103         subs        R2, R2, #+4                ; Decrement NumBytes

104         orr         R3, R3, R12, LSL #+8       ; Combine missing part of data to build full data word

105         str         R3, [R0], #+4              ; Store complete word

106         bcs         ARM_MEMCPY_Loop24BitShift

107 

108         add         R1, R1, #+3                ; Adjust source address

109         b           ARM_MEMCPY_HandleTrailingBytes         ; Handle trailing bytes

110 

111 ;-------------------------------------------------------------------------------