diff options
Diffstat (limited to 'lib/aarch32/misc_helpers.S')
| -rw-r--r-- | lib/aarch32/misc_helpers.S | 35 |
1 files changed, 35 insertions, 0 deletions
diff --git a/lib/aarch32/misc_helpers.S b/lib/aarch32/misc_helpers.S index fd7c6dd1..bf4084a8 100644 --- a/lib/aarch32/misc_helpers.S +++ b/lib/aarch32/misc_helpers.S @@ -34,6 +34,7 @@ .globl smc .globl zeromem + .globl memcpy4 .globl disable_mmu_icache_secure .globl disable_mmu_secure @@ -73,6 +74,40 @@ z_end: bx lr endfunc zeromem +/* -------------------------------------------------------------------------- + * void memcpy4(void *dest, const void *src, unsigned int length) + * + * Copy length bytes from memory area src to memory area dest. + * The memory areas should not overlap. + * Destination and source addresses must be 4-byte aligned. + * -------------------------------------------------------------------------- + */ +func memcpy4 +#if ASM_ASSERTION + orr r3, r0, r1 + tst r3, #0x3 + ASM_ASSERT(eq) +#endif +/* copy 4 bytes at a time */ +m_loop4: + cmp r2, #4 + blt m_loop1 + ldr r3, [r1], #4 + str r3, [r0], #4 + sub r2, r2, #4 + b m_loop4 +/* copy byte per byte */ +m_loop1: + cmp r2,#0 + beq m_end + ldrb r3, [r1], #1 + strb r3, [r0], #1 + subs r2, r2, #1 + bne m_loop1 +m_end: + bx lr +endfunc memcpy4 + /* --------------------------------------------------------------------------- * Disable the MMU in Secure State * --------------------------------------------------------------------------- |