arch/arm/mach-sti/headsmp.S

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