@ -73,8 +73,8 @@ psci_fiq_enter:
lsr r9 , r9 , #10
and r9 , r9 , #0xf
movw r8 , #( S U N 6 I _ C P U C F G _ B A S E & 0 x f f f f )
movt r8 , #( S U N 6 I _ C P U C F G _ B A S E > > 1 6 )
movw r8 , #( S U N X I _ C P U C F G _ B A S E & 0xfff f)
movt r8 , #( S U N X I _ C P U C F G _ B A S E > > 1 6)
@ Wait for the core to enter WFI
lsl r11 , r9 , #6 @ x64
@ -114,8 +114,8 @@ psci_fiq_enter:
str r10 , [ r12 , #0x140 ]
# endif
movw r8 , #( S U N 6 I _ C P U C F G _ B A S E & 0 x f f f f )
movt r8 , #( S U N 6 I _ C P U C F G _ B A S E > > 1 6 )
movw r8 , #( S U N X I _ C P U C F G _ B A S E & 0xfff f)
movt r8 , #( S U N X I _ C P U C F G _ B A S E > > 1 6)
@ Unlock CPU
ldr r10 , [ r8 , #0x1e4 ]
@ -139,8 +139,8 @@ psci_cpu_on:
str r2 , [ r0 ] @ store target PC at stack top
dsb
movw r0 , #( S U N 6 I _ C P U C F G _ B A S E & 0 x f f f f )
movt r0 , #( S U N 6 I _ C P U C F G _ B A S E > > 1 6 )
movw r0 , #( S U N X I _ C P U C F G _ B A S E & 0xfff f)
movt r0 , #( S U N X I _ C P U C F G _ B A S E > > 1 6)
@ CPU mask
and r1 , r1 , #3 @ only care about first cluster
@ -189,8 +189,8 @@ psci_cpu_on:
str r6 , [ r0 , #0x100 ]
@ re-calculate CPU control register address
movw r0 , #( S U N 6 I _ C P U C F G _ B A S E & 0 x f f f f )
movt r0 , #( S U N 6 I _ C P U C F G _ B A S E > > 1 6 )
movw r0 , #( S U N X I _ C P U C F G _ B A S E & 0xfff f)
movt r0 , #( S U N X I _ C P U C F G _ B A S E > > 1 6)
@ Deassert reset on target CPU
mov r6 , #3