Commit | Line | Data |
---|---|---|
e3978dc7 VK |
1 | /* |
2 | * arch/arm/mach-spear13XX/headsmp.S | |
3 | * | |
4 | * Picked from realview | |
5 | * Copyright (c) 2012 ST Microelectronics Limited | |
6 | * Shiraz Hashim <shiraz.hashim@st.com> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | */ | |
12 | ||
13 | #include <linux/linkage.h> | |
14 | #include <linux/init.h> | |
15 | ||
16 | __INIT | |
17 | ||
18 | /* | |
19 | * spear13xx specific entry point for secondary CPUs. This provides | |
20 | * a "holding pen" into which all secondary cores are held until we're | |
21 | * ready for them to initialise. | |
22 | */ | |
23 | ENTRY(spear13xx_secondary_startup) | |
24 | mrc p15, 0, r0, c0, c0, 5 | |
25 | and r0, r0, #15 | |
26 | adr r4, 1f | |
27 | ldmia r4, {r5, r6} | |
28 | sub r4, r4, r5 | |
29 | add r6, r6, r4 | |
30 | pen: ldr r7, [r6] | |
31 | cmp r7, r0 | |
32 | bne pen | |
33 | ||
34 | /* re-enable coherency */ | |
35 | mrc p15, 0, r0, c1, c0, 1 | |
36 | orr r0, r0, #(1 << 6) | (1 << 0) | |
37 | mcr p15, 0, r0, c1, c0, 1 | |
38 | /* | |
39 | * we've been released from the holding pen: secondary_stack | |
40 | * should now contain the SVC stack for this core | |
41 | */ | |
42 | b secondary_startup | |
43 | ||
44 | .align | |
45 | 1: .long . | |
46 | .long pen_release | |
47 | ENDPROC(spear13xx_secondary_startup) |