Commit | Line | Data |
---|---|---|
65ebcc11 SK |
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 | __INIT | |
20 | ||
21 | /* | |
22 | * ST specific entry point for secondary CPUs. This provides | |
23 | * a "holding pen" into which all secondary cores are held until we're | |
24 | * ready for them to initialise. | |
25 | */ | |
26 | ENTRY(sti_secondary_startup) | |
27 | mrc p15, 0, r0, c0, c0, 5 | |
28 | and r0, r0, #15 | |
29 | adr r4, 1f | |
30 | ldmia r4, {r5, r6} | |
31 | sub r4, r4, r5 | |
32 | add r6, r6, r4 | |
33 | pen: ldr r7, [r6] | |
34 | cmp r7, r0 | |
35 | bne pen | |
36 | ||
37 | /* | |
38 | * we've been released from the holding pen: secondary_stack | |
39 | * should now contain the SVC stack for this core | |
40 | */ | |
41 | b secondary_startup | |
42 | ||
43 | 1: .long . | |
44 | .long pen_release |