diff options
Diffstat (limited to 'boot.S')
| -rw-r--r-- | boot.S | 15 |
1 files changed, 14 insertions, 1 deletions
@@ -67,6 +67,19 @@ start: mov r0, #0xf0000000 mcr p15, 0, r0, c12, c0, 1 @ Monitor vector base address + @ + @ Turn on CCI snoops + @ + mov r3, #3 + ldr r4, =0x2c090000 + mov r5, #0x4000 @ A15 + str r3, [r4, r5] + mov r5, #0x5000 @ A7 + str r3, [r4, r5] +0: ldr r3, [r4, #0xc] @ status reg + tst r3, #1 + bne 0b + @ Set up hvbar so hvc comes back here. ldr r0, =vectors mov r7, #0xfffffff0 @@ -93,7 +106,7 @@ vectors: into_hyp_mode: @ Check CPU nr again mrc p15, 0, r0, c0, c0, 5 @ MPIDR (ARMv7 only) - and r0, r0, #15 @ CPU number + bfc r0, #24, #8 @ CPU number, taking multicluster into account cmp r0, #0 @ primary CPU? beq 2f |