1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
2 | /* |
3 | * arch/arm/mach-spear13XX/headsmp.S |
4 | * |
5 | * Picked from realview |
6 | * Copyright (c) 2012 ST Microelectronics Limited |
7 | * Shiraz Hashim <shiraz.linux.kernel@gmail.com> |
8 | */ |
9 | |
10 | #include <linux/linkage.h> |
11 | #include <linux/init.h> |
12 | |
13 | __INIT |
14 | |
15 | /* |
16 | * spear13xx specific entry point for secondary CPUs. This provides |
17 | * a "holding pen" into which all secondary cores are held until we're |
18 | * ready for them to initialise. |
19 | */ |
20 | ENTRY(spear13xx_secondary_startup) |
21 | mrc p15, 0, r0, c0, c0, 5 |
22 | and r0, r0, #15 |
23 | adr r4, 1f |
24 | ldmia r4, {r5, r6} |
25 | sub r4, r4, r5 |
26 | add r6, r6, r4 |
27 | pen: ldr r7, [r6] |
28 | cmp r7, r0 |
29 | bne pen |
30 | |
31 | /* re-enable coherency */ |
32 | mrc p15, 0, r0, c1, c0, 1 |
33 | orr r0, r0, #(1 << 6) | (1 << 0) |
34 | mcr p15, 0, r0, c1, c0, 1 |
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 | |
41 | .align |
42 | 1: .long . |
43 | .long spear_pen_release |
44 | ENDPROC(spear13xx_secondary_startup) |
45 | |