xref: /openbmc/linux/arch/arm/mach-imx/headsmp.S (revision f35e839a)
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/asm-offsets.h>
16#include <asm/hardware/cache-l2x0.h>
17
18	.section ".text.head", "ax"
19
20#ifdef CONFIG_SMP
21ENTRY(v7_secondary_startup)
22	bl	v7_invalidate_l1
23	b	secondary_startup
24ENDPROC(v7_secondary_startup)
25#endif
26
27#ifdef CONFIG_ARM_CPU_SUSPEND
28/*
29 * The following code must assume it is running from physical address
30 * where absolute virtual addresses to the data section have to be
31 * turned into relative ones.
32 */
33
34#ifdef CONFIG_CACHE_L2X0
35	.macro	pl310_resume
36	adr	r0, l2x0_saved_regs_offset
37	ldr	r2, [r0]
38	add	r2, r2, r0
39	ldr	r0, [r2, #L2X0_R_PHY_BASE]	@ get physical base of l2x0
40	ldr	r1, [r2, #L2X0_R_AUX_CTRL]	@ get aux_ctrl value
41	str	r1, [r0, #L2X0_AUX_CTRL]	@ restore aux_ctrl
42	mov	r1, #0x1
43	str	r1, [r0, #L2X0_CTRL]		@ re-enable L2
44	.endm
45
46l2x0_saved_regs_offset:
47	.word	l2x0_saved_regs - .
48
49#else
50	.macro	pl310_resume
51	.endm
52#endif
53
54ENTRY(v7_cpu_resume)
55	bl	v7_invalidate_l1
56	pl310_resume
57	b	cpu_resume
58ENDPROC(v7_cpu_resume)
59#endif
60