arch/arm/mach-shmobile/headsmp-scu.S

   1 /*
   2  * Shared SCU setup for mach-shmobile
   3  *
   4  * Copyright (C) 2012 Bastian Hecht
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License as
   8  * published by the Free Software Foundation; either version 2 of
   9  * the License, or (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR /PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  */
  16
  17 #include <linux/linkage.h>
  18 #include <linux/init.h>
  19 #include <asm/memory.h>
  20
  21 /*
  22  * Boot code for secondary CPUs.
  23  *
  24  * First we turn on L1 cache coherency for our CPU. Then we jump to
  25  * shmobile_invalidate_start that invalidates the cache and hands over control
  26  * to the common ARM startup code.
  27  */
  28 ENTRY(shmobile_boot_scu)
  29                                         @ r0 = SCU base address
  30         mrc     p15, 0, r1, c0, c0, 5   @ read MIPDR
  31         and     r1, r1, #3              @ mask out cpu ID
  32         lsl     r1, r1, #3              @ we will shift by cpu_id * 8 bits
  33         ldr     r2, [r0, #8]            @ SCU Power Status Register
  34         mov     r3, #3
  35         lsl     r3, r3, r1
  36         bic     r2, r2, r3              @ Clear bits of our CPU (Run Mode)
  37         str     r2, [r0, #8]            @ write back
  38
  39         b       shmobile_invalidate_start
  40 ENDPROC(shmobile_boot_scu)
  41
  42         .text
  43         .align  2
  44         .globl  shmobile_scu_base
  45 shmobile_scu_base:
  46         .space  4