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 } 97