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 */ 23ENTRY(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 30pen: 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 451: .long . 46 .long pen_release 47ENDPROC(spear13xx_secondary_startup) 48