summaryrefslogtreecommitdiff
path: root/arch/arm/mach-imx/headsmp.S
diff options
context:
space:
mode:
authorAnson Huang <b20788@freescale.com>2016-10-27 15:33:59 +0300
committerLeonard Crestez <leonard.crestez@nxp.com>2018-08-23 16:42:26 +0300
commitbf7b36140309606dff10fed299ad9aca246099cb (patch)
tree1908dfdc3f92fc485a7ff2dd56606323d23c15d3 /arch/arm/mach-imx/headsmp.S
parent66c0e029532448a456017a59350f30d65e61d919 (diff)
MLK-11265-7 ARM: imx: add smp support for imx7d
Add SMP support for i.MX7D, including CPU hotplug support. Signed-off-by: Anson Huang <b20788@freescale.com>
Diffstat (limited to 'arch/arm/mach-imx/headsmp.S')
-rw-r--r--arch/arm/mach-imx/headsmp.S13
1 files changed, 12 insertions, 1 deletions
diff --git a/arch/arm/mach-imx/headsmp.S b/arch/arm/mach-imx/headsmp.S
index 6c28d28b3c64..5d6a5e2fe9ee 100644
--- a/arch/arm/mach-imx/headsmp.S
+++ b/arch/arm/mach-imx/headsmp.S
@@ -1,5 +1,5 @@
/*
- * Copyright 2011 Freescale Semiconductor, Inc.
+ * Copyright 2011-2015 Freescale Semiconductor, Inc.
* Copyright 2011 Linaro Ltd.
*
* The code contained herein is licensed under the GNU General Public
@@ -27,6 +27,17 @@ diag_reg_offset:
ENTRY(v7_secondary_startup)
ARM_BE8(setend be) @ go BE8 if entered LE
+ mrc p15, 0, r0, c0, c0, 0
+ ldr r1, =0xf00
+ orr r1, r1, #0xff
+ mov r0, r0, lsr #4
+ and r0, r0, r1
+ /* 0xc07 is cortex A7's ID */
+ ldr r1, =0xc00
+ orr r1, r1, #0x7
+ cmp r0, r1
+ beq secondary_startup
+
set_diag_reg
b secondary_startup
ENDPROC(v7_secondary_startup)