xref: /linux/arch/arm/mach-imx/headsmp.S (revision 827634added7f38b7d724cab1dccdb2b004c13c3)
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
16diag_reg_offset:
17	.word	g_diag_reg - .
18
19	.macro	set_diag_reg
20	adr	r0, diag_reg_offset
21	ldr	r1, [r0]
22	add	r1, r1, r0		@ r1 = physical &g_diag_reg
23	ldr	r0, [r1]
24	mcr	p15, 0, r0, c15, c0, 1	@ write diagnostic register
25	.endm
26
27ENTRY(v7_secondary_startup)
28	bl	v7_invalidate_l1
29	set_diag_reg
30	b	secondary_startup
31ENDPROC(v7_secondary_startup)
32