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// SPDX-License-Identifier: GPL-2.0
 2/*
 3 * SMP support for R-Mobile / SH-Mobile
 4 *
 5 * Copyright (C) 2010  Magnus Damm
 6 * Copyright (C) 2011  Paul Mundt
 7 *
 8 * Based on vexpress, Copyright (C) 2002 ARM Ltd, All Rights Reserved
 
 
 
 
 9 */
10#include <linux/init.h>
11#include <asm/cacheflush.h>
12#include <asm/smp_plat.h>
13#include "common.h"
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
14
15extern unsigned long shmobile_smp_fn[];
16extern unsigned long shmobile_smp_arg[];
17extern unsigned long shmobile_smp_mpidr[];
18
19void shmobile_smp_hook(unsigned int cpu, unsigned long fn, unsigned long arg)
 
 
 
 
 
 
20{
21	shmobile_smp_fn[cpu] = 0;
22	flush_cache_all();
 
 
 
 
 
 
23
24	shmobile_smp_mpidr[cpu] = cpu_logical_map(cpu);
25	shmobile_smp_fn[cpu] = fn;
26	shmobile_smp_arg[cpu] = arg;
27	flush_cache_all();
28}
29
30#ifdef CONFIG_HOTPLUG_CPU
31bool shmobile_smp_cpu_can_disable(unsigned int cpu)
32{
33	return true; /* Hotplug of any CPU is supported */
34}
35#endif