blob: 65e879bab4dc527d876552407bc19eb2b8770283 [file] [log] [blame]
Magnus Damm1c51ed42010-12-14 16:56:55 +09001/*
2 * SMP support for R-Mobile / SH-Mobile
3 *
4 * Copyright (C) 2010 Magnus Damm
Paul Mundtc4135212011-01-07 12:03:22 +09005 * Copyright (C) 2011 Paul Mundt
Magnus Damm1c51ed42010-12-14 16:56:55 +09006 *
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>
Magnus Damm72f4d572010-12-14 16:57:11 +090020#include <asm/mach-types.h>
21#include <mach/common.h>
Magnus Damm1c51ed42010-12-14 16:56:55 +090022
23static unsigned int __init shmobile_smp_get_core_count(void)
24{
Magnus Damm72f4d572010-12-14 16:57:11 +090025 if (machine_is_ag5evm())
26 return sh73a0_get_core_count();
27
Magnus Damm1c51ed42010-12-14 16:56:55 +090028 return 1;
29}
30
31static void __init shmobile_smp_prepare_cpus(void)
32{
Magnus Damm72f4d572010-12-14 16:57:11 +090033 if (machine_is_ag5evm())
34 sh73a0_smp_prepare_cpus();
Magnus Damm1c51ed42010-12-14 16:56:55 +090035}
36
Magnus Damm1c51ed42010-12-14 16:56:55 +090037void __cpuinit platform_secondary_init(unsigned int cpu)
38{
39 trace_hardirqs_off();
Magnus Damm72f4d572010-12-14 16:57:11 +090040
41 if (machine_is_ag5evm())
42 sh73a0_secondary_init(cpu);
Magnus Damm1c51ed42010-12-14 16:56:55 +090043}
44
45int __cpuinit boot_secondary(unsigned int cpu, struct task_struct *idle)
46{
Magnus Damm72f4d572010-12-14 16:57:11 +090047 if (machine_is_ag5evm())
48 return sh73a0_boot_secondary(cpu);
49
Magnus Damm1c51ed42010-12-14 16:56:55 +090050 return -ENOSYS;
51}
52
53void __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
Paul Mundtc4135212011-01-07 12:03:22 +090062void __init platform_smp_prepare_cpus(unsigned int max_cpus)
Magnus Damm1c51ed42010-12-14 16:56:55 +090063{
Magnus Damm1c51ed42010-12-14 16:56:55 +090064 int i;
65
Magnus Damm1c51ed42010-12-14 16:56:55 +090066 for (i = 0; i < max_cpus; i++)
67 set_cpu_present(i, true);
68
Paul Mundtc4135212011-01-07 12:03:22 +090069 shmobile_smp_prepare_cpus();
Magnus Damm1c51ed42010-12-14 16:56:55 +090070}