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         __CPUINIT
  13
  14 /*
  15  * SIRFSOC specific entry point for secondary CPUs.  This provides
  16  * a "holding pen" into which all secondary cores are held until we're
  17  * ready for them to initialise.
  18  */
  19 ENTRY(sirfsoc_secondary_startup)
  20         bl v7_invalidate_l1
  21         mrc     p15, 0, r0, c0, c0, 5
  22         and     r0, r0, #15
  23         adr     r4, 1f
  24         ldmia   r4, {r5, r6}
  25         sub     r4, r4, r5
  26         add     r6, r6, r4
  27 pen:    ldr     r7, [r6]
  28         cmp     r7, r0
  29         bne     pen
  30
  31         /*
  32          * we've been released from the holding pen: secondary_stack
  33          * should now contain the SVC stack for this core
  34          */
  35         b       secondary_startup
  36 ENDPROC(sirfsoc_secondary_startup)
  37
  38         .align
  39 1:      .long   .
  40         .long   pen_release