1/*
2 *  arch/arm/mach-sti/headsmp.S
3 *
4 * Copyright (C) 2013 STMicroelectronics (R&D) Limited.
5 *		http://www.st.com
6 *
7 * Cloned from linux/arch/arm/mach-vexpress/headsmp.S
8 *
9 *  Copyright (c) 2003 ARM Limited
10 *  All Rights Reserved
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License version 2 as
14 * published by the Free Software Foundation.
15 */
16#include <linux/linkage.h>
17#include <linux/init.h>
18
19/*
20 * ST specific entry point for secondary CPUs.  This provides
21 * a "holding pen" into which all secondary cores are held until we're
22 * ready for them to initialise.
23 */
24ENTRY(sti_secondary_startup)
25	mrc	p15, 0, r0, c0, c0, 5
26	and	r0, r0, #15
27	adr	r4, 1f
28	ldmia	r4, {r5, r6}
29	sub	r4, r4, r5
30	add	r6, r6, r4
31pen:	ldr	r7, [r6]
32	cmp	r7, r0
33	bne	pen
34
35	/*
36	 * we've been released from the holding pen: secondary_stack
37	 * should now contain the SVC stack for this core
38	 */
39	b	secondary_startup
40
411:	.long	.
42	.long	pen_release
43