|
|
|
@ -60,16 +60,16 @@ _start:
|
|
|
|
|
5: cmp x0, #4
|
|
|
|
|
beq 5f
|
|
|
|
|
msr sp_el1, x1
|
|
|
|
|
// enable AArch64 in EL1
|
|
|
|
|
mov x0, #(1 << 31) // AArch64
|
|
|
|
|
orr x0, x0, #(1 << 1) // SWIO hardwired on Pi3
|
|
|
|
|
msr hcr_el2, x0
|
|
|
|
|
mrs x0, hcr_el2
|
|
|
|
|
// enable CNTP for EL1
|
|
|
|
|
mrs x0, cnthctl_el2
|
|
|
|
|
orr x0, x0, #3
|
|
|
|
|
msr cnthctl_el2, x0
|
|
|
|
|
msr cntvoff_el2, xzr
|
|
|
|
|
// enable AArch64 in EL1
|
|
|
|
|
mov x0, #(1 << 31) // AArch64
|
|
|
|
|
orr x0, x0, #(1 << 1) // SWIO hardwired on Pi3
|
|
|
|
|
msr hcr_el2, x0
|
|
|
|
|
mrs x0, hcr_el2
|
|
|
|
|
// change execution level to EL1
|
|
|
|
|
mov x2, #0x3c4
|
|
|
|
|
msr spsr_el2, x2
|
|
|
|
|