[deliverable/linux.git] / arch / arm / mach-imx / headsmp.S

/*
 * Copyright 2011 Freescale Semiconductor, Inc.
 * Copyright 2011 Linaro Ltd.
 *
 * The code contained herein is licensed under the GNU General Public
 * License. You may obtain a copy of the GNU General Public License
 * Version 2 or later at the following locations:
 *
 * http://www.opensource.org/licenses/gpl-license.html
 * http://www.gnu.org/copyleft/gpl.html
 */

#include <linux/linkage.h>
#include <linux/init.h>
#include <asm/assembler.h>

diag_reg_offset:
	.word	g_diag_reg - .

	.macro	set_diag_reg
	adr	r0, diag_reg_offset
	ldr	r1, [r0]
	add	r1, r1, r0		@ r1 = physical &g_diag_reg
	ldr	r0, [r1]
	mcr	p15, 0, r0, c15, c0, 1	@ write diagnostic register
	.endm

ENTRY(v7_secondary_startup)
ARM_BE8(setend be)			@ go BE8 if entered LE
	set_diag_reg
	b	secondary_startup
ENDPROC(v7_secondary_startup)
Commit	Line	Data
69c31b7a SG	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>
26e30c64	15	#include <asm/assembler.h>
69c31b7a	16
087bb283 SG	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
69c31b7a	28	ENTRY(v7_secondary_startup)
26e30c64	29	ARM_BE8(setend be) @ go BE8 if entered LE
087bb283	30	set_diag_reg
69c31b7a SG	31	b secondary_startup
69c31b7a SG	32	ENDPROC(v7_secondary_startup)