44 lines
848 B
ArmAsm
44 lines
848 B
ArmAsm
|
.arm.little
|
||
|
|
|
||
|
|
.create "build/svcConnectToPortInitHook.bin", 0
|
||
|
|
.arm
|
||
|
|
push {r0-r4, lr}
|
||
|
|
adr r0, jumpAddress
|
||
|
|
bl convertVAToPA
|
||
|
|
orr r4, r0, #(1 << 31)
|
||
|
|
|
||
|
|
loop:
|
||
|
|
ldr r12, [r4]
|
||
|
|
cmp r12, #0
|
||
|
|
bne loop_end
|
||
|
|
ldr r12, [SleepThread]
|
||
|
|
ldr r0, =(10 * 1000 * 1000)
|
||
|
|
mov r1, #0
|
||
|
|
blx r12
|
||
|
|
b loop
|
||
|
|
|
||
|
|
loop_end:
|
||
|
|
pop {r0-r4, lr}
|
||
|
|
bx r12
|
||
|
|
|
||
|
|
convertVAToPA:
|
||
|
|
mov r1, #0x1000
|
||
|
|
sub r1, #1
|
||
|
|
and r2, r0, r1
|
||
|
|
bic r0, r1
|
||
|
|
mcr p15, 0, r0, c7, c8, 0 ; VA to PA translation with privileged read permission check
|
||
|
|
mrc p15, 0, r0, c7, c4, 0 ; read PA register
|
||
|
|
tst r0, #1 ; failure bit
|
||
|
|
bic r0, r1
|
||
|
|
addeq r0, r2
|
||
|
|
movne r0, #0
|
||
|
|
bx lr
|
||
|
|
|
||
|
|
.pool
|
||
|
|
_base: .ascii "base"
|
||
|
|
jumpAddressOrig: .ascii "orig"
|
||
|
|
SleepThread: .ascii "SlpT"
|
||
|
|
jumpAddress: .word 0
|
||
|
|
|
||
|
|
.close
|