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