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