mirror of
https://github.com/d0k3/GodMode9.git
synced 2025-06-26 05:32:47 +00:00
70757e3385
- moved all SPI code to the ARM11 - reimplemented NVRAM reading for the new SPI interface
43 lines
921 B
ArmAsm
43 lines
921 B
ArmAsm
#include <arm.h>
|
|
|
|
.arm
|
|
.align 3
|
|
|
|
.section .vector, "ax"
|
|
vectors:
|
|
b XRQ_Reset @ RESET
|
|
b XRQ_Reset @ UNDEFINED
|
|
b XRQ_Reset @ SVC
|
|
b XRQ_Reset @ PREFETCH ABORT
|
|
b XRQ_Reset @ DATA ABORT
|
|
b XRQ_Reset @ RESERVED
|
|
b XRQ_IRQ @ IRQ
|
|
b XRQ_Reset @ FIQ
|
|
|
|
XRQ_Reset:
|
|
mov r0, #0x18000000
|
|
add r1, r0, #(6 << 20)
|
|
mov r2, #0xFFFFFFFF
|
|
1:
|
|
cmp r0, r1
|
|
strne r2, [r0], #4
|
|
moveq r0, #0x18000000
|
|
b 1b
|
|
|
|
XRQ_IRQ:
|
|
sub lr, lr, #4 @ Fix return address
|
|
srsfd sp!, #SR_SVC_MODE @ Store IRQ mode LR and SPSR on the SVC stack
|
|
cps #SR_SVC_MODE @ Switch to SVC mode
|
|
push {r0-r4, r12, lr} @ Preserve registers
|
|
|
|
and r4, sp, #7 @ Fix SP to be 8byte aligned
|
|
sub sp, sp, r4
|
|
|
|
mov lr, pc
|
|
ldr pc, =GIC_MainHandler
|
|
|
|
add sp, sp, r4
|
|
|
|
pop {r0-r4, r12, lr}
|
|
rfeia sp! @ Return from exception
|