arch/arm/mach-shmobile/platsmp.c

   1 /*
   2  * SMP support for R-Mobile / SH-Mobile
   3  *
   4  * Copyright (C) 2010  Magnus Damm
   5  * Copyright (C) 2011  Paul Mundt
   6  *
   7  * Based on vexpress, Copyright (C) 2002 ARM Ltd, All Rights Reserved
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License version 2 as
  11  * published by the Free Software Foundation.
  12  */
  13 #include <linux/init.h>
  14 #include <linux/smp.h>
  15 #include <asm/cacheflush.h>
  16 #include <asm/smp_plat.h>
  17 #include <mach/common.h>
  18
  19 void __init shmobile_smp_init_cpus(unsigned int ncores)
  20 {
  21         unsigned int i;
  22
  23         if (ncores > nr_cpu_ids) {
  24                 pr_warn("SMP: %u cores greater than maximum (%u), clipping\n",
  25                         ncores, nr_cpu_ids);
  26                 ncores = nr_cpu_ids;
  27         }
  28
  29         for (i = 0; i < ncores; i++)
  30                 set_cpu_possible(i, true);
  31 }
  32
  33 extern unsigned long shmobile_smp_fn[];
  34 extern unsigned long shmobile_smp_arg[];
  35 extern unsigned long shmobile_smp_mpidr[];
  36
  37 void shmobile_smp_hook(unsigned int cpu, unsigned long fn, unsigned long arg)
  38 {
  39         shmobile_smp_fn[cpu] = 0;
  40         flush_cache_all();
  41
  42         shmobile_smp_mpidr[cpu] = cpu_logical_map(cpu);
  43         shmobile_smp_fn[cpu] = fn;
  44         shmobile_smp_arg[cpu] = arg;
  45         flush_cache_all();
  46 }