| /* |
| * Copyright (c) 2003 ARM Limited |
| * All Rights Reserved |
| * Copyright (c) 2010, 2012 Code Aurora Forum. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| #include <linux/linkage.h> |
| #include <linux/init.h> |
| |
| __CPUINIT |
| |
| /* |
| * MSM specific entry point for secondary CPUs. This provides |
| * a "holding pen" into which all secondary cores are held until we're |
| * ready for them to initialise. |
| * |
| * This is executing in physical space with cache's off. |
| */ |
| ENTRY(msm_secondary_startup) |
| mrc p15, 0, r0, c0, c0, 5 @ MPIDR |
| and r0, r0, #15 @ What CPU am I |
| adr r4, 1f @ address of |
| ldmia r4, {r5, r6} @ load curr addr and pen_rel addr |
| sub r4, r4, r5 @ determine virtual/phys offsets |
| add r6, r6, r4 @ apply |
| pen: |
| wfe |
| dsb @ ensure subsequent access is |
| @ after event |
| |
| ldr r7, [r6] @ pen_rel has cpu to remove from reset |
| cmp r7, r0 @ are we lucky? |
| bne pen |
| |
| /* |
| * we've been released from the holding pen: secondary_stack |
| * should now contain the SVC stack for this core |
| */ |
| mvn r7, #0 @ -1 to registers |
| str r7,[r6] @ back to the pen for ack |
| b secondary_startup |
| |
| 1: .long . |
| .long pen_release |