2 * Copyright (C) 2015 Linus Walleij
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
11 #include <linux/of_address.h>
12 #include <linux/regmap.h>
13 #include <linux/mfd/syscon.h>
15 #include <asm/cacheflush.h>
16 #include <asm/smp_plat.h>
17 #include <asm/smp_scu.h>
19 #include <plat/platsmp.h>
21 #define REALVIEW_SYS_FLAGSSET_OFFSET 0x30
23 static const struct of_device_id realview_scu_match[] = {
24 { .compatible = "arm,arm11mp-scu", },
25 { .compatible = "arm,cortex-a9-scu", },
26 { .compatible = "arm,cortex-a5-scu", },
30 static const struct of_device_id realview_syscon_match[] = {
31 { .compatible = "arm,core-module-integrator", },
32 { .compatible = "arm,realview-eb-syscon", },
33 { .compatible = "arm,realview-pb11mp-syscon", },
34 { .compatible = "arm,realview-pbx-syscon", },
38 static void __init realview_smp_prepare_cpus(unsigned int max_cpus)
40 struct device_node *np;
41 void __iomem *scu_base;
46 np = of_find_matching_node(NULL, realview_scu_match);
48 pr_err("PLATSMP: No SCU base address\n");
51 scu_base = of_iomap(np, 0);
54 pr_err("PLATSMP: No SCU remap\n");
59 ncores = scu_get_core_count(scu_base);
60 pr_info("SCU: %d cores detected\n", ncores);
61 for (i = 0; i < ncores; i++)
62 set_cpu_possible(i, true);
65 /* The syscon contains the magic SMP start address registers */
66 np = of_find_matching_node(NULL, realview_syscon_match);
68 pr_err("PLATSMP: No syscon match\n");
71 map = syscon_node_to_regmap(np);
73 pr_err("PLATSMP: No syscon regmap\n");
76 /* Put the boot address in this magic register */
77 regmap_write(map, REALVIEW_SYS_FLAGSSET_OFFSET,
78 __pa_symbol(versatile_secondary_startup));
81 #ifdef CONFIG_HOTPLUG_CPU
82 static void realview_cpu_die(unsigned int cpu)
84 return versatile_immitation_cpu_die(cpu, 0x20);
88 static const struct smp_operations realview_dt_smp_ops __initconst = {
89 .smp_prepare_cpus = realview_smp_prepare_cpus,
90 .smp_secondary_init = versatile_secondary_init,
91 .smp_boot_secondary = versatile_boot_secondary,
92 #ifdef CONFIG_HOTPLUG_CPU
93 .cpu_die = realview_cpu_die,
96 CPU_METHOD_OF_DECLARE(realview_smp, "arm,realview-smp", &realview_dt_smp_ops);