xref: /openbmc/linux/arch/arm/mach-actions/platsmp.c (revision 4c8c3c7f)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Actions Semi Leopard
4  *
5  * This file is based on arm realview smp platform.
6  *
7  * Copyright 2012 Actions Semi Inc.
8  * Author: Actions Semi, Inc.
9  *
10  * Copyright (c) 2017 Andreas Färber
11  */
12 
13 #include <linux/delay.h>
14 #include <linux/io.h>
15 #include <linux/of.h>
16 #include <linux/of_address.h>
17 #include <linux/smp.h>
18 #include <linux/soc/actions/owl-sps.h>
19 #include <asm/cacheflush.h>
20 #include <asm/smp_plat.h>
21 #include <asm/smp_scu.h>
22 
23 #include <trace/events/ipi.h>
24 
25 #define OWL_CPU1_ADDR	0x50
26 #define OWL_CPU1_FLAG	0x5c
27 
28 #define OWL_CPUx_FLAG_BOOT	0x55aa
29 
30 #define OWL_SPS_PG_CTL_PWR_CPU2	BIT(5)
31 #define OWL_SPS_PG_CTL_PWR_CPU3	BIT(6)
32 #define OWL_SPS_PG_CTL_ACK_CPU2	BIT(21)
33 #define OWL_SPS_PG_CTL_ACK_CPU3	BIT(22)
34 
35 static void __iomem *scu_base_addr;
36 static void __iomem *sps_base_addr;
37 static void __iomem *timer_base_addr;
38 static int ncores;
39 
s500_wakeup_secondary(unsigned int cpu)40 static int s500_wakeup_secondary(unsigned int cpu)
41 {
42 	int ret;
43 
44 	if (cpu > 3)
45 		return -EINVAL;
46 
47 	/* The generic PM domain driver is not available this early. */
48 	switch (cpu) {
49 	case 2:
50 		ret = owl_sps_set_pg(sps_base_addr,
51 		                     OWL_SPS_PG_CTL_PWR_CPU2,
52 				     OWL_SPS_PG_CTL_ACK_CPU2, true);
53 		if (ret)
54 			return ret;
55 		break;
56 	case 3:
57 		ret = owl_sps_set_pg(sps_base_addr,
58 		                     OWL_SPS_PG_CTL_PWR_CPU3,
59 				     OWL_SPS_PG_CTL_ACK_CPU3, true);
60 		if (ret)
61 			return ret;
62 		break;
63 	}
64 
65 	/* wait for CPUx to run to WFE instruction */
66 	udelay(200);
67 
68 	writel(__pa_symbol(secondary_startup),
69 	       timer_base_addr + OWL_CPU1_ADDR + (cpu - 1) * 4);
70 	writel(OWL_CPUx_FLAG_BOOT,
71 	       timer_base_addr + OWL_CPU1_FLAG + (cpu - 1) * 4);
72 
73 	dsb_sev();
74 	mb();
75 
76 	return 0;
77 }
78 
s500_smp_boot_secondary(unsigned int cpu,struct task_struct * idle)79 static int s500_smp_boot_secondary(unsigned int cpu, struct task_struct *idle)
80 {
81 	int ret;
82 
83 	ret = s500_wakeup_secondary(cpu);
84 	if (ret)
85 		return ret;
86 
87 	udelay(10);
88 
89 	smp_send_reschedule(cpu);
90 
91 	writel(0, timer_base_addr + OWL_CPU1_ADDR + (cpu - 1) * 4);
92 	writel(0, timer_base_addr + OWL_CPU1_FLAG + (cpu - 1) * 4);
93 
94 	return 0;
95 }
96 
s500_smp_prepare_cpus(unsigned int max_cpus)97 static void __init s500_smp_prepare_cpus(unsigned int max_cpus)
98 {
99 	struct device_node *node;
100 
101 	node = of_find_compatible_node(NULL, NULL, "actions,s500-timer");
102 	if (!node) {
103 		pr_err("%s: missing timer\n", __func__);
104 		return;
105 	}
106 
107 	timer_base_addr = of_iomap(node, 0);
108 	if (!timer_base_addr) {
109 		pr_err("%s: could not map timer registers\n", __func__);
110 		return;
111 	}
112 
113 	node = of_find_compatible_node(NULL, NULL, "actions,s500-sps");
114 	if (!node) {
115 		pr_err("%s: missing sps\n", __func__);
116 		return;
117 	}
118 
119 	sps_base_addr = of_iomap(node, 0);
120 	if (!sps_base_addr) {
121 		pr_err("%s: could not map sps registers\n", __func__);
122 		return;
123 	}
124 
125 	if (read_cpuid_part() == ARM_CPU_PART_CORTEX_A9) {
126 		node = of_find_compatible_node(NULL, NULL, "arm,cortex-a9-scu");
127 		if (!node) {
128 			pr_err("%s: missing scu\n", __func__);
129 			return;
130 		}
131 
132 		scu_base_addr = of_iomap(node, 0);
133 		if (!scu_base_addr) {
134 			pr_err("%s: could not map scu registers\n", __func__);
135 			return;
136 		}
137 
138 		/*
139 		 * While the number of cpus is gathered from dt, also get the
140 		 * number of cores from the scu to verify this value when
141 		 * booting the cores.
142 		 */
143 		ncores = scu_get_core_count(scu_base_addr);
144 		pr_debug("%s: ncores %d\n", __func__, ncores);
145 
146 		scu_enable(scu_base_addr);
147 	}
148 }
149 
150 static const struct smp_operations s500_smp_ops __initconst = {
151 	.smp_prepare_cpus = s500_smp_prepare_cpus,
152 	.smp_boot_secondary = s500_smp_boot_secondary,
153 };
154 CPU_METHOD_OF_DECLARE(s500_smp, "actions,s500-smp", &s500_smp_ops);
155