117 lines
1.8 KiB
ArmAsm
117 lines
1.8 KiB
ArmAsm
/*
|
|
mini - a Free Software replacement for the Nintendo/BroadOn IOS.
|
|
random utilities
|
|
|
|
Copyright (C) 2008, 2009 Hector Martin "marcan" <marcan@marcansoft.com>
|
|
|
|
# This code is licensed to you under the terms of the GNU GPL, version 2;
|
|
# see file COPYING or http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt
|
|
*/
|
|
|
|
.arm
|
|
|
|
.globl memcpy
|
|
.globl memset32
|
|
.globl memset16
|
|
.globl memset8
|
|
|
|
.text
|
|
|
|
memcpy:
|
|
cmp r2, #0
|
|
bxeq lr
|
|
|
|
stmfd sp!, {r4-r6}
|
|
orr r3, r0, r1
|
|
tst r3, #3
|
|
bne _unaligned
|
|
cmp r2, #0x0F
|
|
bls _dwordcopyfast
|
|
cmp r2, #0x1F
|
|
bls _fastcopy16
|
|
stmfd sp!, {r7-r9}
|
|
|
|
_fastcopy32:
|
|
ldmia r1!, {r3-r9,r12}
|
|
stmia r0!, {r3-r9,r12}
|
|
sub r2, r2, #0x20
|
|
cmp r2, #0x1F
|
|
bls _done
|
|
b _fastcopy32
|
|
_done:
|
|
ldmfd sp!, {r7-r9}
|
|
|
|
_fastcopy16:
|
|
cmp r2, #0xf
|
|
bls _dwordcopyfast
|
|
ldmia r1!, {r3-r6}
|
|
stmia r0!, {r3-r6}
|
|
sub r2, r2, #0x10
|
|
b _fastcopy16
|
|
|
|
_dwordcopyfast:
|
|
cmp r2, #3
|
|
bls _unaligned
|
|
ldr r3, [r1], #4
|
|
str r3, [r0], #4
|
|
sub r2, r2, #4
|
|
b _dwordcopyfast
|
|
|
|
_unaligned:
|
|
cmp r0, #0x1800000
|
|
bcs _bytecopy
|
|
mov r12, #0xff
|
|
_dwordcopy:
|
|
cmp r2, #0
|
|
beq _done2
|
|
mov r6, r0
|
|
and r3, r6, #3
|
|
ldr r4, [r6,-r3]!
|
|
mov r3, r3, lsl #3
|
|
rsb r3, r3, #0x18
|
|
bic r5, r4, r12, lsl r3
|
|
ldrb r4, [r1],#1
|
|
orr r4, r5, r4, lsl r3
|
|
str r4, [r6]
|
|
add r0, r0, #1
|
|
sub r2, r2, #1
|
|
b _dwordcopy
|
|
|
|
_bytecopy:
|
|
cmp r2, #0
|
|
beq _done2
|
|
ldrb r3, [r1], #1
|
|
strb r3, [r0], #1
|
|
sub r2, r2, #1
|
|
b _bytecopy
|
|
_done2:
|
|
ldmfd sp!, {r4-r6}
|
|
bx lr
|
|
|
|
memset32:
|
|
bics r2, #3
|
|
bxeq lr
|
|
1: str r1, [r0] ,#4
|
|
subs r2, #4
|
|
bne 1b
|
|
bx lr
|
|
|
|
|
|
memset16:
|
|
bics r2, #1
|
|
bxeq lr
|
|
1: strh r1, [r0], #2
|
|
subs r2, #2
|
|
bne 1b
|
|
bx lr
|
|
|
|
memset8:
|
|
cmp r2, #0
|
|
bxeq lr
|
|
1: strb r1, [r0], #1
|
|
subs r2, #1
|
|
bne 1b
|
|
bx lr
|
|
|
|
|