diff options
Diffstat (limited to 'arch/arm/mach-imx/headsmp.S')
-rw-r--r-- | arch/arm/mach-imx/headsmp.S | 10 |
1 files changed, 6 insertions, 4 deletions
diff --git a/arch/arm/mach-imx/headsmp.S b/arch/arm/mach-imx/headsmp.S index fcba58be8e79..c19cfc3166ae 100644 --- a/arch/arm/mach-imx/headsmp.S +++ b/arch/arm/mach-imx/headsmp.S @@ -22,11 +22,13 @@ diag_reg_offset: ENTRY(v7_secondary_startup) ARM_BE8(setend be) @ go BE8 if entered LE mrc p15, 0, r0, c0, c0, 0 - lsl r0, r0, #16 - lsr r0, r0, #20 + ldr r1, =0xf00 + orr r1, r1, #0xff + mov r0, r0, lsr #4 + and r0, r0, r1 /* 0xc07 is cortex A7's ID */ - mov r1, #0xc00 - orr r1, #0x7 + ldr r1, =0xc00 + orr r1, r1, #0x7 cmp r0, r1 beq secondary_startup |