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>
23 #define REALVIEW_SYS_FLAGSSET_OFFSET 0x30
25 static const struct of_device_id realview_scu_match
[] = {
26 { .compatible
= "arm,arm11mp-scu", },
27 { .compatible
= "arm,cortex-a9-scu", },
28 { .compatible
= "arm,cortex-a5-scu", },
32 static const struct of_device_id realview_syscon_match
[] = {
33 { .compatible
= "arm,core-module-integrator", },
34 { .compatible
= "arm,realview-eb-syscon", },
35 { .compatible
= "arm,realview-pb11mp-syscon", },
36 { .compatible
= "arm,realview-pbx-syscon", },
40 static void __init
realview_smp_prepare_cpus(unsigned int max_cpus
)
42 struct device_node
*np
;
43 void __iomem
*scu_base
;
48 np
= of_find_matching_node(NULL
, realview_scu_match
);
50 pr_err("PLATSMP: No SCU base address\n");
53 scu_base
= of_iomap(np
, 0);
56 pr_err("PLATSMP: No SCU remap\n");
61 ncores
= scu_get_core_count(scu_base
);
62 pr_info("SCU: %d cores detected\n", ncores
);
63 for (i
= 0; i
< ncores
; i
++)
64 set_cpu_possible(i
, true);
67 /* The syscon contains the magic SMP start address registers */
68 np
= of_find_matching_node(NULL
, realview_syscon_match
);
70 pr_err("PLATSMP: No syscon match\n");
73 map
= syscon_node_to_regmap(np
);
75 pr_err("PLATSMP: No syscon regmap\n");
78 /* Put the boot address in this magic register */
79 regmap_write(map
, REALVIEW_SYS_FLAGSSET_OFFSET
,
80 virt_to_phys(versatile_secondary_startup
));
83 static const struct smp_operations realview_dt_smp_ops __initconst
= {
84 .smp_prepare_cpus
= realview_smp_prepare_cpus
,
85 .smp_secondary_init
= versatile_secondary_init
,
86 .smp_boot_secondary
= versatile_boot_secondary
,
87 #ifdef CONFIG_HOTPLUG_CPU
88 .cpu_die
= realview_cpu_die
,
91 CPU_METHOD_OF_DECLARE(realview_smp
, "arm,realview-smp", &realview_dt_smp_ops
);