Pileus Git - ~andy/linux/blob - 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/errno.h>
  15 #include <linux/delay.h>
  16 #include <linux/device.h>
  17 #include <linux/smp.h>
  18 #include <linux/io.h>
  19 #include <asm/hardware/gic.h>
  20 #include <asm/mach-types.h>
  21 #include <mach/common.h>
  22
  23 #define is_sh73a0() (machine_is_ag5evm() || machine_is_kota2())
  24 #define is_r8a7779() machine_is_marzen()
  25
  26 static unsigned int __init shmobile_smp_get_core_count(void)
  27 {
  28         if (is_sh73a0())
  29                 return sh73a0_get_core_count();
  30
  31         if (is_r8a7779())
  32                 return r8a7779_get_core_count();
  33
  34         return 1;
  35 }
  36
  37 static void __init shmobile_smp_prepare_cpus(void)
  38 {
  39         if (is_sh73a0())
  40                 sh73a0_smp_prepare_cpus();
  41
  42         if (is_r8a7779())
  43                 r8a7779_smp_prepare_cpus();
  44 }
  45
  46 int shmobile_platform_cpu_kill(unsigned int cpu)
  47 {
  48         if (is_r8a7779())
  49                 return r8a7779_platform_cpu_kill(cpu);
  50
  51         return 1;
  52 }
  53
  54 void __cpuinit platform_secondary_init(unsigned int cpu)
  55 {
  56         trace_hardirqs_off();
  57
  58         if (is_sh73a0())
  59                 sh73a0_secondary_init(cpu);
  60
  61         if (is_r8a7779())
  62                 r8a7779_secondary_init(cpu);
  63 }
  64
  65 int __cpuinit boot_secondary(unsigned int cpu, struct task_struct *idle)
  66 {
  67         if (is_sh73a0())
  68                 return sh73a0_boot_secondary(cpu);
  69
  70         if (is_r8a7779())
  71                 return r8a7779_boot_secondary(cpu);
  72
  73         return -ENOSYS;
  74 }
  75
  76 void __init smp_init_cpus(void)
  77 {
  78         unsigned int ncores = shmobile_smp_get_core_count();
  79         unsigned int i;
  80
  81         if (ncores > nr_cpu_ids) {
  82                 pr_warn("SMP: %u cores greater than maximum (%u), clipping\n",
  83                         ncores, nr_cpu_ids);
  84                 ncores = nr_cpu_ids;
  85         }
  86
  87         for (i = 0; i < ncores; i++)
  88                 set_cpu_possible(i, true);
  89
  90         set_smp_cross_call(gic_raise_softirq);
  91 }
  92
  93 void __init platform_smp_prepare_cpus(unsigned int max_cpus)
  94 {
  95         shmobile_smp_prepare_cpus();
  96 }