mirror of
https://github.com/Atmosphere-NX/Atmosphere.git
synced 2024-11-06 04:01:44 +00:00
63 lines
1.3 KiB
ArmAsm
63 lines
1.3 KiB
ArmAsm
|
.align 4
|
||
|
|
.section .text.warm.start, "ax", %progbits
|
||
|
|
.global __start_warm
|
||
|
|
__start_warm:
|
||
|
|
/* mask all interrupts */
|
||
|
|
msr daifset, daif
|
||
|
|
|
||
|
|
/*
|
||
|
|
Enable invalidates of branch target buffer, then flush
|
||
|
|
the entire instruction cache at the local level, and
|
||
|
|
with the reg change, the branch target buffer, then disable
|
||
|
|
invalidates of the branch target buffer again.
|
||
|
|
*/
|
||
|
|
mrs x0, cpuactlr_el1
|
||
|
|
orr x0, x0, #1
|
||
|
|
msr cpuactlr_el1, x0
|
||
|
|
|
||
|
|
dsb sy
|
||
|
|
isb
|
||
|
|
ic iallu
|
||
|
|
dsb sy
|
||
|
|
isb
|
||
|
|
|
||
|
|
mrs x0, cpuactlr_el1
|
||
|
|
bic x0, x0, #1
|
||
|
|
msr cpuactlr_el1, x0
|
||
|
|
|
||
|
|
/* if the OS lock is set, disable it and request a warm reset */
|
||
|
|
mrs x0, oslsr_el1
|
||
|
|
ands x0, x0, #2
|
||
|
|
b.eq _set_lock_and_sp
|
||
|
|
mov x0, xzr
|
||
|
|
msr oslar_el1, x0
|
||
|
|
|
||
|
|
mov x0, #(1 << 63)
|
||
|
|
msr cpuactlr_el1, x0 /* disable regional clock gating */
|
||
|
|
isb
|
||
|
|
mov x0, #3
|
||
|
|
msr rmr_el3, x0
|
||
|
|
isb
|
||
|
|
dsb
|
||
|
|
wfi
|
||
|
|
|
||
|
|
_set_lock_and_sp:
|
||
|
|
/* set the OS lock */
|
||
|
|
mov x0, #1
|
||
|
|
msr oslar_el1, x0
|
||
|
|
bl __synchronize_cores
|
||
|
|
|
||
|
|
/* set SP = SP_EL3 (handler stack) */
|
||
|
|
msr spsel, #1
|
||
|
|
ldr x20, =__warm_crt0_stack_top__
|
||
|
|
mov sp, x20
|
||
|
|
bl reconfigure_memory
|
||
|
|
ldr x16, =__init_warm
|
||
|
|
br x16
|
||
|
|
|
||
|
|
.section .text.warm, "ax", %progbits
|
||
|
|
__init_warm:
|
||
|
|
ldr x20, =__warm_init_stack_top__
|
||
|
|
mov sp, x20
|
||
|
|
b warmboot_main
|