blob: 1f5443044ccadcbaa5e4c60b8438959c94168d55 [file] [log] [blame]
Soren Brinkmann76fcae32016-03-06 20:16:27 -08001/*
Jolly Shah16fe5ab2019-01-08 11:16:16 -08002 * Copyright (c) 2013-2018, ARM Limited and Contributors. All rights reserved.
Soren Brinkmann76fcae32016-03-06 20:16:27 -08003 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
Soren Brinkmann76fcae32016-03-06 20:16:27 -08005 */
6
7/*
8 * APU specific definition of processors in the subsystem as well as functions
9 * for getting information about and changing state of the APU.
10 */
11
Filip Drazic4c0765a2016-07-26 12:11:33 +020012#include <assert.h>
Filip Drazic4c0765a2016-07-26 12:11:33 +020013#include <string.h>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +000014
15#include <common/bl_common.h>
16#include <drivers/arm/gic_common.h>
17#include <drivers/arm/gicv2.h>
18#include <lib/bakery_lock.h>
19#include <lib/mmio.h>
20#include <lib/utils.h>
21
Jolly Shah259afe52019-01-09 12:37:57 -080022#include <plat_ipi.h>
Jolly Shah16fe5ab2019-01-08 11:16:16 -080023#include <zynqmp_def.h>
Soren Brinkmann76fcae32016-03-06 20:16:27 -080024#include "pm_api_sys.h"
25#include "pm_client.h"
26#include "pm_ipi.h"
Soren Brinkmann76fcae32016-03-06 20:16:27 -080027
Filip Drazic4c0765a2016-07-26 12:11:33 +020028#define IRQ_MAX 84
29#define NUM_GICD_ISENABLER ((IRQ_MAX >> 5) + 1)
Soren Brinkmann76fcae32016-03-06 20:16:27 -080030#define UNDEFINED_CPUID (~0)
Filip Drazic0bd9d0c2016-07-20 17:17:39 +020031
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +053032#define PM_SUSPEND_MODE_STD 0
33#define PM_SUSPEND_MODE_POWER_OFF 1
34
Stefan Krsmanovic2b783662016-05-20 15:51:09 +020035DEFINE_BAKERY_LOCK(pm_client_secure_lock);
Soren Brinkmann76fcae32016-03-06 20:16:27 -080036
Soren Brinkmann76fcae32016-03-06 20:16:27 -080037extern const struct pm_ipi apu_ipi;
38
Jolly Shah259afe52019-01-09 12:37:57 -080039const struct pm_ipi apu_ipi = {
40 .local_ipi_id = IPI_ID_APU,
41 .remote_ipi_id = IPI_ID_PMU0,
42 .buffer_base = IPI_BUFFER_APU_BASE,
43};
44
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +053045static uint32_t suspend_mode = PM_SUSPEND_MODE_STD;
46
Soren Brinkmann76fcae32016-03-06 20:16:27 -080047/* Order in pm_procs_all array must match cpu ids */
Soren Brinkmann4ae19c42017-07-01 20:24:47 -070048static const struct pm_proc pm_procs_all[] = {
Soren Brinkmann76fcae32016-03-06 20:16:27 -080049 {
50 .node_id = NODE_APU_0,
51 .pwrdn_mask = APU_0_PWRCTL_CPUPWRDWNREQ_MASK,
52 .ipi = &apu_ipi,
53 },
54 {
55 .node_id = NODE_APU_1,
56 .pwrdn_mask = APU_1_PWRCTL_CPUPWRDWNREQ_MASK,
57 .ipi = &apu_ipi,
58 },
59 {
60 .node_id = NODE_APU_2,
61 .pwrdn_mask = APU_2_PWRCTL_CPUPWRDWNREQ_MASK,
62 .ipi = &apu_ipi,
63 },
64 {
65 .node_id = NODE_APU_3,
66 .pwrdn_mask = APU_3_PWRCTL_CPUPWRDWNREQ_MASK,
67 .ipi = &apu_ipi,
68 },
69};
70
Filip Drazic4c0765a2016-07-26 12:11:33 +020071/* Interrupt to PM node ID map */
72static enum pm_node_id irq_node_map[IRQ_MAX + 1] = {
73 NODE_UNKNOWN,
74 NODE_UNKNOWN,
75 NODE_UNKNOWN,
76 NODE_UNKNOWN, /* 3 */
77 NODE_UNKNOWN,
78 NODE_UNKNOWN,
79 NODE_UNKNOWN,
80 NODE_UNKNOWN, /* 7 */
81 NODE_UNKNOWN,
82 NODE_UNKNOWN,
83 NODE_UNKNOWN,
84 NODE_UNKNOWN, /* 11 */
85 NODE_UNKNOWN,
86 NODE_UNKNOWN,
87 NODE_NAND,
88 NODE_QSPI, /* 15 */
89 NODE_GPIO,
90 NODE_I2C_0,
91 NODE_I2C_1,
92 NODE_SPI_0, /* 19 */
93 NODE_SPI_1,
94 NODE_UART_0,
95 NODE_UART_1,
96 NODE_CAN_0, /* 23 */
97 NODE_CAN_1,
98 NODE_UNKNOWN,
99 NODE_RTC,
100 NODE_RTC, /* 27 */
101 NODE_UNKNOWN,
102 NODE_UNKNOWN,
103 NODE_UNKNOWN,
104 NODE_UNKNOWN, /* 31 */
105 NODE_UNKNOWN,
106 NODE_UNKNOWN,
107 NODE_UNKNOWN,
108 NODE_UNKNOWN, /* 35, NODE_IPI_APU */
109 NODE_TTC_0,
110 NODE_TTC_0,
111 NODE_TTC_0,
112 NODE_TTC_1, /* 39 */
113 NODE_TTC_1,
114 NODE_TTC_1,
115 NODE_TTC_2,
116 NODE_TTC_2, /* 43 */
117 NODE_TTC_2,
118 NODE_TTC_3,
119 NODE_TTC_3,
120 NODE_TTC_3, /* 47 */
121 NODE_SD_0,
122 NODE_SD_1,
123 NODE_SD_0,
124 NODE_SD_1, /* 51 */
125 NODE_UNKNOWN,
126 NODE_UNKNOWN,
127 NODE_UNKNOWN,
128 NODE_UNKNOWN, /* 55 */
129 NODE_UNKNOWN,
130 NODE_ETH_0,
131 NODE_ETH_0,
132 NODE_ETH_1, /* 59 */
133 NODE_ETH_1,
134 NODE_ETH_2,
135 NODE_ETH_2,
136 NODE_ETH_3, /* 63 */
137 NODE_ETH_3,
138 NODE_USB_0,
139 NODE_USB_0,
140 NODE_USB_0, /* 67 */
141 NODE_USB_0,
142 NODE_USB_0,
143 NODE_USB_1,
144 NODE_USB_1, /* 71 */
145 NODE_USB_1,
146 NODE_USB_1,
147 NODE_USB_1,
148 NODE_USB_0, /* 75 */
149 NODE_USB_0,
150 NODE_ADMA,
151 NODE_ADMA,
152 NODE_ADMA, /* 79 */
153 NODE_ADMA,
154 NODE_ADMA,
155 NODE_ADMA,
156 NODE_ADMA, /* 83 */
157 NODE_ADMA,
158};
159
160/**
161 * irq_to_pm_node - Get PM node ID corresponding to the interrupt number
162 * @irq: Interrupt number
163 *
164 * Return: PM node ID corresponding to the specified interrupt
165 */
166static enum pm_node_id irq_to_pm_node(unsigned int irq)
167{
168 assert(irq <= IRQ_MAX);
169 return irq_node_map[irq];
170}
171
172/**
173 * pm_client_set_wakeup_sources - Set all slaves with enabled interrupts as wake
174 * sources in the PMU firmware
175 */
176static void pm_client_set_wakeup_sources(void)
177{
178 uint32_t reg_num;
179 uint8_t pm_wakeup_nodes_set[NODE_MAX];
180 uintptr_t isenabler1 = BASE_GICD_BASE + GICD_ISENABLER + 4;
181
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +0530182 /* In case of power-off suspend, only NODE_EXTERN must be set */
183 if (suspend_mode == PM_SUSPEND_MODE_POWER_OFF) {
184 enum pm_ret_status ret;
185
186 ret = pm_set_wakeup_source(NODE_APU, NODE_EXTERN, 1);
187 /**
188 * If NODE_EXTERN could not be set as wake source, proceed with
189 * standard suspend (no one will wake the system otherwise)
190 */
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530191 if (ret == PM_RET_SUCCESS) {
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +0530192 return;
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530193 }
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +0530194 }
195
Douglas Raillarda8954fc2017-01-26 15:54:44 +0000196 zeromem(&pm_wakeup_nodes_set, sizeof(pm_wakeup_nodes_set));
Filip Drazic4c0765a2016-07-26 12:11:33 +0200197
198 for (reg_num = 0; reg_num < NUM_GICD_ISENABLER; reg_num++) {
199 uint32_t base_irq = reg_num << ISENABLER_SHIFT;
200 uint32_t reg = mmio_read_32(isenabler1 + (reg_num << 2));
201
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530202 if (!reg) {
Filip Drazic4c0765a2016-07-26 12:11:33 +0200203 continue;
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530204 }
Filip Drazic4c0765a2016-07-26 12:11:33 +0200205
206 while (reg) {
207 enum pm_node_id node;
208 uint32_t idx, ret, irq, lowest_set = reg & (-reg);
209
210 idx = __builtin_ctz(lowest_set);
211 irq = base_irq + idx;
212
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530213 if (irq > IRQ_MAX) {
Filip Drazic4c0765a2016-07-26 12:11:33 +0200214 break;
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530215 }
Filip Drazic4c0765a2016-07-26 12:11:33 +0200216
217 node = irq_to_pm_node(irq);
218 reg &= ~lowest_set;
219
220 if ((node != NODE_UNKNOWN) &&
221 (!pm_wakeup_nodes_set[node])) {
222 ret = pm_set_wakeup_source(NODE_APU, node, 1);
223 pm_wakeup_nodes_set[node] = !ret;
224 }
225 }
226 }
227}
228
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800229/**
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800230 * pm_get_proc() - returns pointer to the proc structure
231 * @cpuid: id of the cpu whose proc struct pointer should be returned
232 *
233 * Return: pointer to a proc structure if proc is found, otherwise NULL
234 */
235const struct pm_proc *pm_get_proc(unsigned int cpuid)
236{
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530237 if (cpuid < ARRAY_SIZE(pm_procs_all)) {
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800238 return &pm_procs_all[cpuid];
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530239 }
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800240
241 return NULL;
242}
243
244/**
245 * pm_get_proc_by_node() - returns pointer to the proc structure
246 * @nid: node id of the processor
247 *
248 * Return: pointer to a proc structure if proc is found, otherwise NULL
249 */
250const struct pm_proc *pm_get_proc_by_node(enum pm_node_id nid)
251{
252 for (size_t i = 0; i < ARRAY_SIZE(pm_procs_all); i++) {
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530253 if (nid == pm_procs_all[i].node_id) {
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800254 return &pm_procs_all[i];
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530255 }
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800256 }
257 return NULL;
258}
259
260/**
261 * pm_get_cpuid() - get the local cpu ID for a global node ID
262 * @nid: node id of the processor
263 *
264 * Return: the cpu ID (starting from 0) for the subsystem
265 */
266static unsigned int pm_get_cpuid(enum pm_node_id nid)
267{
268 for (size_t i = 0; i < ARRAY_SIZE(pm_procs_all); i++) {
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530269 if (pm_procs_all[i].node_id == nid) {
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800270 return i;
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530271 }
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800272 }
273 return UNDEFINED_CPUID;
274}
275
276const struct pm_proc *primary_proc = &pm_procs_all[0];
277
278/**
279 * pm_client_suspend() - Client-specific suspend actions
280 *
281 * This function should contain any PU-specific actions
282 * required prior to sending suspend request to PMU
Filip Drazic4c0765a2016-07-26 12:11:33 +0200283 * Actions taken depend on the state system is suspending to.
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800284 */
Filip Drazic4c0765a2016-07-26 12:11:33 +0200285void pm_client_suspend(const struct pm_proc *proc, unsigned int state)
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800286{
Stefan Krsmanovic2b783662016-05-20 15:51:09 +0200287 bakery_lock_get(&pm_client_secure_lock);
288
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530289 if (state == PM_STATE_SUSPEND_TO_RAM) {
Filip Drazic4c0765a2016-07-26 12:11:33 +0200290 pm_client_set_wakeup_sources();
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530291 }
Filip Drazic4c0765a2016-07-26 12:11:33 +0200292
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800293 /* Set powerdown request */
294 mmio_write_32(APU_PWRCTL, mmio_read_32(APU_PWRCTL) | proc->pwrdn_mask);
Stefan Krsmanovic2b783662016-05-20 15:51:09 +0200295
296 bakery_lock_release(&pm_client_secure_lock);
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800297}
298
299
300/**
301 * pm_client_abort_suspend() - Client-specific abort-suspend actions
302 *
303 * This function should contain any PU-specific actions
304 * required for aborting a prior suspend request
305 */
306void pm_client_abort_suspend(void)
307{
308 /* Enable interrupts at processor level (for current cpu) */
309 gicv2_cpuif_enable();
Stefan Krsmanovic2b783662016-05-20 15:51:09 +0200310
311 bakery_lock_get(&pm_client_secure_lock);
312
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800313 /* Clear powerdown request */
314 mmio_write_32(APU_PWRCTL,
315 mmio_read_32(APU_PWRCTL) & ~primary_proc->pwrdn_mask);
Stefan Krsmanovic2b783662016-05-20 15:51:09 +0200316
317 bakery_lock_release(&pm_client_secure_lock);
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800318}
319
320/**
321 * pm_client_wakeup() - Client-specific wakeup actions
322 *
323 * This function should contain any PU-specific actions
324 * required for waking up another APU core
325 */
326void pm_client_wakeup(const struct pm_proc *proc)
327{
328 unsigned int cpuid = pm_get_cpuid(proc->node_id);
329
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530330 if (cpuid == UNDEFINED_CPUID) {
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800331 return;
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530332 }
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800333
Stefan Krsmanovic2b783662016-05-20 15:51:09 +0200334 bakery_lock_get(&pm_client_secure_lock);
335
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800336 /* clear powerdown bit for affected cpu */
337 uint32_t val = mmio_read_32(APU_PWRCTL);
338 val &= ~(proc->pwrdn_mask);
339 mmio_write_32(APU_PWRCTL, val);
Stefan Krsmanovic2b783662016-05-20 15:51:09 +0200340
341 bakery_lock_release(&pm_client_secure_lock);
Soren Brinkmann76fcae32016-03-06 20:16:27 -0800342}
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +0530343
344enum pm_ret_status pm_set_suspend_mode(uint32_t mode)
345{
346 if ((mode != PM_SUSPEND_MODE_STD) &&
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530347 (mode != PM_SUSPEND_MODE_POWER_OFF)) {
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +0530348 return PM_RET_ERROR_ARGS;
Venkatesh Yadav Abbarapu987fad32022-04-29 13:52:00 +0530349 }
Siva Durga Prasad Paladugu43b23a32018-04-27 16:26:47 +0530350
351 suspend_mode = mode;
352 return PM_RET_SUCCESS;
353}