Linux-libre 5.4.48-gnu
[librecmc/linux-libre.git] / arch / arm / mach-prima2 / headsmp.S
1 /* SPDX-License-Identifier: GPL-2.0-or-later */
2 /*
3  * Entry of the second core for CSR Marco dual-core SMP SoCs
4  *
5  * Copyright (c) 2012 Cambridge Silicon Radio Limited, a CSR plc group company.
6  */
7
8 #include <linux/linkage.h>
9 #include <linux/init.h>
10
11 /*
12  * SIRFSOC specific entry point for secondary CPUs.  This provides
13  * a "holding pen" into which all secondary cores are held until we're
14  * ready for them to initialise.
15  */
16 ENTRY(sirfsoc_secondary_startup)
17         mrc     p15, 0, r0, c0, c0, 5
18         and     r0, r0, #15
19         adr     r4, 1f
20         ldmia   r4, {r5, r6}
21         sub     r4, r4, r5
22         add     r6, r6, r4
23 pen:    ldr     r7, [r6]
24         cmp     r7, r0
25         bne     pen
26
27         /*
28          * we've been released from the holding pen: secondary_stack
29          * should now contain the SVC stack for this core
30          */
31         b       secondary_startup
32 ENDPROC(sirfsoc_secondary_startup)
33
34         .align
35 1:      .long   .
36         .long   prima2_pen_release