headsmp.S 995 B

1234567891011121314151617181920212223242526272829303132333435363738
  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. #include <linux/linkage.h>
  9. #include <linux/init.h>
  10. /*
  11. * SIRFSOC specific entry point for secondary CPUs. This provides
  12. * a "holding pen" into which all secondary cores are held until we're
  13. * ready for them to initialise.
  14. */
  15. ENTRY(sirfsoc_secondary_startup)
  16. bl v7_invalidate_l1
  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. * we've been released from the holding pen: secondary_stack
  28. * should now contain the SVC stack for this core
  29. */
  30. b secondary_startup
  31. ENDPROC(sirfsoc_secondary_startup)
  32. .align
  33. 1: .long .
  34. .long pen_release