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/localtimer.h>
20 #include <asm/mach-types.h>
21 #include <mach/common.h>
22 
shmobile_smp_get_core_count(void)23 static unsigned int __init shmobile_smp_get_core_count(void)
24 {
25 	if (machine_is_ag5evm())
26 		return sh73a0_get_core_count();
27 
28 	return 1;
29 }
30 
shmobile_smp_prepare_cpus(void)31 static void __init shmobile_smp_prepare_cpus(void)
32 {
33 	if (machine_is_ag5evm())
34 		sh73a0_smp_prepare_cpus();
35 }
36 
platform_secondary_init(unsigned int cpu)37 void __cpuinit platform_secondary_init(unsigned int cpu)
38 {
39 	trace_hardirqs_off();
40 
41 	if (machine_is_ag5evm())
42 		sh73a0_secondary_init(cpu);
43 }
44 
boot_secondary(unsigned int cpu,struct task_struct * idle)45 int __cpuinit boot_secondary(unsigned int cpu, struct task_struct *idle)
46 {
47 	if (machine_is_ag5evm())
48 		return sh73a0_boot_secondary(cpu);
49 
50 	return -ENOSYS;
51 }
52 
smp_init_cpus(void)53 void __init smp_init_cpus(void)
54 {
55 	unsigned int ncores = shmobile_smp_get_core_count();
56 	unsigned int i;
57 
58 	for (i = 0; i < ncores; i++)
59 		set_cpu_possible(i, true);
60 }
61 
platform_smp_prepare_cpus(unsigned int max_cpus)62 void __init platform_smp_prepare_cpus(unsigned int max_cpus)
63 {
64 	int i;
65 
66 	for (i = 0; i < max_cpus; i++)
67 		set_cpu_present(i, true);
68 
69 	shmobile_smp_prepare_cpus();
70 }
71