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 <linux/of.h>
 20#include <asm/hardware/gic.h>
 
 21#include <asm/mach-types.h>
 22#include <mach/common.h>
 23#include <mach/emev2.h>
 24
 25#ifdef CONFIG_ARCH_SH73A0
 26#define is_sh73a0() (machine_is_ag5evm() || machine_is_kota2() || \
 27			of_machine_is_compatible("renesas,sh73a0"))
 28#else
 29#define is_sh73a0() (0)
 30#endif
 31
 32#define is_r8a7779() machine_is_marzen()
 33
 34#ifdef CONFIG_ARCH_EMEV2
 35#define is_emev2() of_machine_is_compatible("renesas,emev2")
 36#else
 37#define is_emev2() (0)
 38#endif
 39
 40static unsigned int __init shmobile_smp_get_core_count(void)
 41{
 42	if (is_sh73a0())
 43		return sh73a0_get_core_count();
 44
 45	if (is_r8a7779())
 46		return r8a7779_get_core_count();
 47
 48	if (is_emev2())
 49		return emev2_get_core_count();
 50
 51	return 1;
 52}
 53
 54static void __init shmobile_smp_prepare_cpus(void)
 55{
 56	if (is_sh73a0())
 57		sh73a0_smp_prepare_cpus();
 58
 59	if (is_r8a7779())
 60		r8a7779_smp_prepare_cpus();
 61
 62	if (is_emev2())
 63		emev2_smp_prepare_cpus();
 64}
 65
 66int shmobile_platform_cpu_kill(unsigned int cpu)
 67{
 68	if (is_r8a7779())
 69		return r8a7779_platform_cpu_kill(cpu);
 70
 71	if (is_emev2())
 72		return emev2_platform_cpu_kill(cpu);
 73
 74	return 1;
 75}
 76
 77void __cpuinit platform_secondary_init(unsigned int cpu)
 78{
 79	trace_hardirqs_off();
 80
 81	if (is_sh73a0())
 82		sh73a0_secondary_init(cpu);
 83
 84	if (is_r8a7779())
 85		r8a7779_secondary_init(cpu);
 86
 87	if (is_emev2())
 88		emev2_secondary_init(cpu);
 89}
 90
 91int __cpuinit boot_secondary(unsigned int cpu, struct task_struct *idle)
 92{
 93	if (is_sh73a0())
 94		return sh73a0_boot_secondary(cpu);
 95
 96	if (is_r8a7779())
 97		return r8a7779_boot_secondary(cpu);
 98
 99	if (is_emev2())
100		return emev2_boot_secondary(cpu);
101
102	return -ENOSYS;
103}
104
105void __init smp_init_cpus(void)
106{
107	unsigned int ncores = shmobile_smp_get_core_count();
108	unsigned int i;
109
110	if (ncores > nr_cpu_ids) {
111		pr_warn("SMP: %u cores greater than maximum (%u), clipping\n",
112			ncores, nr_cpu_ids);
113		ncores = nr_cpu_ids;
114	}
115
116	for (i = 0; i < ncores; i++)
117		set_cpu_possible(i, true);
118
119	set_smp_cross_call(gic_raise_softirq);
120}
121
122void __init platform_smp_prepare_cpus(unsigned int max_cpus)
123{
124	shmobile_smp_prepare_cpus();
125}

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