blob: 4a5d26e902525d4b80fe359e12228f4ce30ba30b [file] [log] [blame]
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +00001/*
Remi Pommareldb289172019-04-04 23:12:56 +02002 * Copyright (c) 2018-2019, ARM Limited and Contributors. All rights reserved.
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +00003 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7#include <arch_helpers.h>
8#include <assert.h>
9#include <drivers/console.h>
10#include <common/debug.h>
11#include <errno.h>
12#include <drivers/arm/gicv2.h>
13#include <lib/mmio.h>
14#include <plat/common/platform.h>
15#include <platform_def.h>
16#include <lib/psci/psci.h>
17
18#include "gxl_private.h"
19
20#define SCPI_POWER_ON 0
21#define SCPI_POWER_RETENTION 1
22#define SCPI_POWER_OFF 3
23
24#define SCPI_SYSTEM_SHUTDOWN 0
25#define SCPI_SYSTEM_REBOOT 1
26
27static uintptr_t gxbb_sec_entrypoint;
28static volatile uint32_t gxbb_cpu0_go;
29
Remi Pommareldb289172019-04-04 23:12:56 +020030static void gxl_pm_set_reset_addr(u_register_t mpidr, uint64_t value)
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000031{
32 unsigned int core = plat_gxbb_calc_core_pos(mpidr);
33 uintptr_t cpu_mailbox_addr = GXBB_PSCI_MAILBOX_BASE + (core << 4);
34
35 mmio_write_64(cpu_mailbox_addr, value);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000036}
37
Remi Pommareldb289172019-04-04 23:12:56 +020038static void gxl_pm_reset(u_register_t mpidr)
39{
40 unsigned int core = plat_gxbb_calc_core_pos(mpidr);
41 uintptr_t cpu_mailbox_addr = GXBB_PSCI_MAILBOX_BASE + (core << 4) + 8;
42
43 mmio_write_32(cpu_mailbox_addr, 0);
44}
45
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000046static void __dead2 gxbb_system_reset(void)
47{
48 INFO("BL31: PSCI_SYSTEM_RESET\n");
49
Remi Pommareldb289172019-04-04 23:12:56 +020050 u_register_t mpidr = read_mpidr_el1();
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000051 uint32_t status = mmio_read_32(GXBB_AO_RTI_STATUS_REG3);
Remi Pommareldb289172019-04-04 23:12:56 +020052 int ret;
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000053
54 NOTICE("BL31: Reboot reason: 0x%x\n", status);
55
56 status &= 0xFFFF0FF0;
57
58 console_flush();
59
60 mmio_write_32(GXBB_AO_RTI_STATUS_REG3, status);
61
Remi Pommareldb289172019-04-04 23:12:56 +020062 ret = scpi_sys_power_state(SCPI_SYSTEM_REBOOT);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000063
64 if (ret != 0) {
Remi Pommareldb289172019-04-04 23:12:56 +020065 ERROR("BL31: PSCI_SYSTEM_RESET: SCP error: %i\n", ret);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000066 panic();
67 }
68
Remi Pommareldb289172019-04-04 23:12:56 +020069 gxl_pm_reset(mpidr);
70
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000071 wfi();
72
73 ERROR("BL31: PSCI_SYSTEM_RESET: Operation not handled\n");
74 panic();
75}
76
77static void __dead2 gxbb_system_off(void)
78{
79 INFO("BL31: PSCI_SYSTEM_OFF\n");
80
Remi Pommareldb289172019-04-04 23:12:56 +020081 u_register_t mpidr = read_mpidr_el1();
82 int ret;
83
84 ret = scpi_sys_power_state(SCPI_SYSTEM_SHUTDOWN);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000085
86 if (ret != 0) {
Remi Pommareldb289172019-04-04 23:12:56 +020087 ERROR("BL31: PSCI_SYSTEM_OFF: SCP error %i\n", ret);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000088 panic();
89 }
90
Remi Pommareldb289172019-04-04 23:12:56 +020091 gxl_pm_set_reset_addr(mpidr, 0);
92 gxl_pm_reset(mpidr);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +000093
94 wfi();
95
96 ERROR("BL31: PSCI_SYSTEM_OFF: Operation not handled\n");
97 panic();
98}
99
100static int32_t gxbb_pwr_domain_on(u_register_t mpidr)
101{
102 unsigned int core = plat_gxbb_calc_core_pos(mpidr);
103
104 /* CPU0 can't be turned OFF, emulate it with a WFE loop */
105 if (core == GXBB_PRIMARY_CPU) {
106 VERBOSE("BL31: Releasing CPU0 from wait loop...\n");
107
108 gxbb_cpu0_go = 1;
109 flush_dcache_range((uintptr_t)&gxbb_cpu0_go,
110 sizeof(gxbb_cpu0_go));
111 dsb();
112 isb();
113
114 sev();
115
116 return PSCI_E_SUCCESS;
117 }
118
Remi Pommareldb289172019-04-04 23:12:56 +0200119 gxl_pm_set_reset_addr(mpidr, gxbb_sec_entrypoint);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +0000120 scpi_set_css_power_state(mpidr,
121 SCPI_POWER_ON, SCPI_POWER_ON, SCPI_POWER_ON);
122 dmbsy();
123 sev();
124
125 return PSCI_E_SUCCESS;
126}
127
128static void gxbb_pwr_domain_on_finish(const psci_power_state_t *target_state)
129{
130 unsigned int core = plat_gxbb_calc_core_pos(read_mpidr_el1());
131
132 assert(target_state->pwr_domain_state[MPIDR_AFFLVL0] ==
133 PLAT_LOCAL_STATE_OFF);
134
135 if (core == GXBB_PRIMARY_CPU) {
136 gxbb_cpu0_go = 0;
137 flush_dcache_range((uintptr_t)&gxbb_cpu0_go,
138 sizeof(gxbb_cpu0_go));
139 dsb();
140 isb();
141 }
142
143 gicv2_pcpu_distif_init();
144 gicv2_cpuif_enable();
145}
146
147static void gxbb_pwr_domain_off(const psci_power_state_t *target_state)
148{
149 u_register_t mpidr = read_mpidr_el1();
150 unsigned int core = plat_gxbb_calc_core_pos(mpidr);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +0000151
152 gicv2_cpuif_disable();
153
154 /* CPU0 can't be turned OFF, emulate it with a WFE loop */
155 if (core == GXBB_PRIMARY_CPU)
156 return;
157
158 scpi_set_css_power_state(mpidr,
159 SCPI_POWER_OFF, SCPI_POWER_ON, SCPI_POWER_ON);
160}
161
162static void __dead2 gxbb_pwr_domain_pwr_down_wfi(const psci_power_state_t
163 *target_state)
164{
Remi Pommarel3d50b432019-07-30 18:04:38 +0200165 u_register_t mpidr = read_mpidr_el1();
166 unsigned int core = plat_gxbb_calc_core_pos(mpidr);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +0000167
168 /* CPU0 can't be turned OFF, emulate it with a WFE loop */
169 if (core == GXBB_PRIMARY_CPU) {
170 VERBOSE("BL31: CPU0 entering wait loop...\n");
171
172 while (gxbb_cpu0_go == 0)
173 wfe();
174
175 VERBOSE("BL31: CPU0 resumed.\n");
176
Remi Pommarel3d50b432019-07-30 18:04:38 +0200177 /*
178 * Because setting CPU0's warm reset entrypoint through PSCI
179 * mailbox and/or mmio mapped RVBAR (0xda834650) does not seem
180 * to work, jump to it manually.
181 * In order to avoid an assert, mmu has to be disabled.
182 */
183 disable_mmu_el3();
184 ((void(*)(void))gxbb_sec_entrypoint)();
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +0000185 }
186
187 dsbsy();
Remi Pommarel3d50b432019-07-30 18:04:38 +0200188 gxl_pm_set_reset_addr(mpidr, 0);
189 gxl_pm_reset(mpidr);
Antonio Nino Diaz7298c1f2018-12-05 00:09:30 +0000190
191 for (;;)
192 wfi();
193}
194
195/*******************************************************************************
196 * Platform handlers and setup function.
197 ******************************************************************************/
198static const plat_psci_ops_t gxbb_ops = {
199 .pwr_domain_on = gxbb_pwr_domain_on,
200 .pwr_domain_on_finish = gxbb_pwr_domain_on_finish,
201 .pwr_domain_off = gxbb_pwr_domain_off,
202 .pwr_domain_pwr_down_wfi = gxbb_pwr_domain_pwr_down_wfi,
203 .system_off = gxbb_system_off,
204 .system_reset = gxbb_system_reset,
205};
206
207int plat_setup_psci_ops(uintptr_t sec_entrypoint,
208 const plat_psci_ops_t **psci_ops)
209{
210 gxbb_sec_entrypoint = sec_entrypoint;
211 *psci_ops = &gxbb_ops;
212 gxbb_cpu0_go = 0;
213 return 0;
214}