67 lines
1.4 KiB
ArmAsm
67 lines
1.4 KiB
ArmAsm
.arm.little
|
|
|
|
.create "build/k11MainHook.bin", 0
|
|
.arm
|
|
|
|
bindSGI0:
|
|
; hook __kernel_main to bind SGI0 for own purposes
|
|
push {r0-r4, lr}
|
|
sub sp, #16 ; 3 args passed through the stack + alignment
|
|
adr r0, parameters
|
|
ldr r0, [r0, #4]
|
|
adr r1, interruptEvent
|
|
mov r2, #0
|
|
mrc p15, 0, r3, c0, c0, 5
|
|
and r3, #3
|
|
mov r4, #0
|
|
str r4, [sp]
|
|
str r4, [sp, #4]
|
|
str r4, [sp, #8]
|
|
|
|
ldr r12, [InterruptManager_MapInterrupt]
|
|
blx r12
|
|
cmp r0, #0
|
|
blt .
|
|
|
|
add sp, #16
|
|
pop {r0-r4, pc}
|
|
|
|
executeCustomHandler:
|
|
push {r4, lr}
|
|
mrs r4, cpsr
|
|
adr r0, parameters
|
|
bl convertVAToPA
|
|
orr r0, #(1 << 31)
|
|
ldr r12, [r0]
|
|
|
|
blx r12
|
|
|
|
mov r0, #0
|
|
msr cpsr_cx, r4
|
|
pop {r4, pc}
|
|
|
|
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
|
|
|
|
; Result InterruptManager::MapInterrupt(InterruptManager *this, InterruptEvent *iEvent, u32 interruptID, u32 coreID, s32 priority, bool willBeMasked, bool isLevelHighActive);
|
|
InterruptManager_MapInterrupt: .ascii "bind"
|
|
|
|
_vtable: .word executeCustomHandler
|
|
interruptEvent: .word _vtable
|
|
|
|
parameters:
|
|
|
|
.close
|