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/localtimer.h> 21 #include <asm/mach-types.h> 22 #include <mach/common.h> 23 24 #define is_sh73a0() (machine_is_ag5evm() || machine_is_kota2()) 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 return 1; 32 } 33 34 static void __init shmobile_smp_prepare_cpus(void) 35 { 36 if (is_sh73a0()) 37 sh73a0_smp_prepare_cpus(); 38 } 39 40 void __cpuinit platform_secondary_init(unsigned int cpu) 41 { 42 trace_hardirqs_off(); 43 44 if (is_sh73a0()) 45 sh73a0_secondary_init(cpu); 46 } 47 48 int __cpuinit boot_secondary(unsigned int cpu, struct task_struct *idle) 49 { 50 if (is_sh73a0()) 51 return sh73a0_boot_secondary(cpu); 52 53 return -ENOSYS; 54 } 55 56 void __init smp_init_cpus(void) 57 { 58 unsigned int ncores = shmobile_smp_get_core_count(); 59 unsigned int i; 60 61 if (ncores > nr_cpu_ids) { 62 pr_warn("SMP: %u cores greater than maximum (%u), clipping\n", 63 ncores, nr_cpu_ids); 64 ncores = nr_cpu_ids; 65 } 66 67 for (i = 0; i < ncores; i++) 68 set_cpu_possible(i, true); 69 70 set_smp_cross_call(gic_raise_softirq); 71 } 72 73 void __init platform_smp_prepare_cpus(unsigned int max_cpus) 74 { 75 shmobile_smp_prepare_cpus(); 76 } 77