arch/arm/mach-imx/headsmp.S

   1 /*
   2  * Copyright 2011 Freescale Semiconductor, Inc.
   3  * Copyright 2011 Linaro Ltd.
   4  *
   5  * The code contained herein is licensed under the GNU General Public
   6  * License. You may obtain a copy of the GNU General Public License
   7  * Version 2 or later at the following locations:
   8  *
   9  * http://www.opensource.org/licenses/gpl-license.html
  10  * http://www.gnu.org/copyleft/gpl.html
  11  */
  12
  13 #include <linux/linkage.h>
  14 #include <linux/init.h>
  15
  16 diag_reg_offset:
  17         .word   g_diag_reg - .
  18
  19         .macro  set_diag_reg
  20         adr     r0, diag_reg_offset
  21         ldr     r1, [r0]
  22         add     r1, r1, r0              @ r1 = physical &g_diag_reg
  23         ldr     r0, [r1]
  24         mcr     p15, 0, r0, c15, c0, 1  @ write diagnostic register
  25         .endm
  26
  27 ENTRY(v7_secondary_startup)
  28         bl      v7_invalidate_l1
  29         set_diag_reg
  30         b       secondary_startup
  31 ENDPROC(v7_secondary_startup)