headsmp.S 1.0 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344
  1. /*
  2. * arch/arm/mach-sti/headsmp.S
  3. *
  4. * Copyright (C) 2013 STMicroelectronics (R&D) Limited.
  5. * http://www.st.com
  6. *
  7. * Cloned from linux/arch/arm/mach-vexpress/headsmp.S
  8. *
  9. * Copyright (c) 2003 ARM Limited
  10. * All Rights Reserved
  11. *
  12. * This program is free software; you can redistribute it and/or modify
  13. * it under the terms of the GNU General Public License version 2 as
  14. * published by the Free Software Foundation.
  15. */
  16. #include <linux/linkage.h>
  17. #include <linux/init.h>
  18. /*
  19. * ST 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. */
  23. ENTRY(sti_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
  30. pen: ldr r7, [r6]
  31. cmp r7, r0
  32. bne pen
  33. /*
  34. * we've been released from the holding pen: secondary_stack
  35. * should now contain the SVC stack for this core
  36. */
  37. b secondary_startup
  38. ENDPROC(sti_secondary_startup)
  39. 1: .long .
  40. .long pen_release