GNU Linux-libre 4.19.264-gnu1
[releases.git] / arch / arm / mach-imx / headsmp.S
1 /*
2  * Copyright 2011 Freescale Semiconductor, Inc.
3  * Copyright 2011 Linaro Ltd.
4  *
5  * The code contained herein is licensed under the GNU General Public
6  * License. You may obtain a copy of the GNU General Public License
7  * Version 2 or later at the following locations:
8  *
9  * http://www.opensource.org/licenses/gpl-license.html
10  * http://www.gnu.org/copyleft/gpl.html
11  */
12
13 #include <linux/linkage.h>
14 #include <linux/init.h>
15 #include <asm/assembler.h>
16
17 diag_reg_offset:
18         .word   g_diag_reg - .
19
20         .macro  set_diag_reg
21         adr     r0, diag_reg_offset
22         ldr     r1, [r0]
23         add     r1, r1, r0              @ r1 = physical &g_diag_reg
24         ldr     r0, [r1]
25         mcr     p15, 0, r0, c15, c0, 1  @ write diagnostic register
26         .endm
27
28 ENTRY(v7_secondary_startup)
29 ARM_BE8(setend be)                      @ go BE8 if entered LE
30         set_diag_reg
31         b       secondary_startup
32 ENDPROC(v7_secondary_startup)