arch/arm/plat-versatile/headsmp.S

   1 /*
   2  *  linux/arch/arm/plat-versatile/headsmp.S
   3  *
   4  *  Copyright (c) 2003 ARM Limited
   5  *  All Rights Reserved
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  */
  11 #include <linux/linkage.h>
  12 #include <linux/init.h>
  13
  14 /*
  15  * Realview/Versatile Express specific entry point for secondary CPUs.
  16  * This provides a "holding pen" into which all secondary cores are held
  17  * until we're ready for them to initialise.
  18  */
  19 ENTRY(versatile_secondary_startup)
  20         mrc     p15, 0, r0, c0, c0, 5
  21         bic     r0, #0xff000000
  22         adr     r4, 1f
  23         ldmia   r4, {r5, r6}
  24         sub     r4, r4, r5
  25         add     r6, r6, r4
  26 pen:    ldr     r7, [r6]
  27         cmp     r7, r0
  28         bne     pen
  29
  30         /*
  31          * we've been released from the holding pen: secondary_stack
  32          * should now contain the SVC stack for this core
  33          */
  34         b       secondary_startup
  35
  36         .align
  37 1:      .long   .
  38         .long   pen_release
  39 ENDPROC(versatile_secondary_startup)