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 <asm/cacheflush.h>
15#include <asm/smp_plat.h>
16#include "common.h"
 
 
 
 
 
 
 
17
18extern unsigned long shmobile_smp_fn[];
19extern unsigned long shmobile_smp_arg[];
20extern unsigned long shmobile_smp_mpidr[];
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
21
22void shmobile_smp_hook(unsigned int cpu, unsigned long fn, unsigned long arg)
23{
24	shmobile_smp_fn[cpu] = 0;
25	flush_cache_all();
 
 
 
26
27	shmobile_smp_mpidr[cpu] = cpu_logical_map(cpu);
28	shmobile_smp_fn[cpu] = fn;
29	shmobile_smp_arg[cpu] = arg;
30	flush_cache_all();
31}
32
33#ifdef CONFIG_HOTPLUG_CPU
34bool shmobile_smp_cpu_can_disable(unsigned int cpu)
35{
36	return true; /* Hotplug of any CPU is supported */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
37}
38#endif