blob: 2038e87aed6bf590c605ceae0f6cf9e28abdd3f7 [file] [log] [blame]
Achin Gupta4f6ad662013-10-25 09:08:21 +01001/*
Dan Handleye83b0ca2014-01-14 18:17:09 +00002 * Copyright (c) 2013-2014, ARM Limited and Contributors. All rights reserved.
Achin Gupta4f6ad662013-10-25 09:08:21 +01003 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 *
7 * Redistributions of source code must retain the above copyright notice, this
8 * list of conditions and the following disclaimer.
9 *
10 * Redistributions in binary form must reproduce the above copyright notice,
11 * this list of conditions and the following disclaimer in the documentation
12 * and/or other materials provided with the distribution.
13 *
14 * Neither the name of ARM nor the names of its contributors may be used
15 * to endorse or promote products derived from this software without specific
16 * prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 * POSSIBILITY OF SUCH DAMAGE.
29 */
30
Achin Gupta4f6ad662013-10-25 09:08:21 +010031#include <arch_helpers.h>
Dan Handleyfb42b122014-06-20 09:43:15 +010032#include <arm_gic.h>
Dan Handley2bd4ef22014-04-09 13:14:54 +010033#include <assert.h>
Achin Gupta4f6ad662013-10-25 09:08:21 +010034#include <bakery_lock.h>
35#include <cci400.h>
Juan Castillo4dc4a472014-08-12 11:17:06 +010036#include <debug.h>
Dan Handley2bd4ef22014-04-09 13:14:54 +010037#include <mmio.h>
38#include <platform.h>
Dan Handley1c54d972014-06-20 12:02:01 +010039#include <plat_config.h>
Dan Handleyed6ff952014-05-14 17:44:19 +010040#include <platform_def.h>
Achin Gupta4f6ad662013-10-25 09:08:21 +010041#include <psci.h>
Achin Gupta85876392014-07-31 17:45:51 +010042#include <errno.h>
Dan Handley4d2e49d2014-04-11 11:52:12 +010043#include "drivers/pwrc/fvp_pwrc.h"
Dan Handleyed6ff952014-05-14 17:44:19 +010044#include "fvp_def.h"
45#include "fvp_private.h"
Achin Gupta4f6ad662013-10-25 09:08:21 +010046
47/*******************************************************************************
Achin Gupta85876392014-07-31 17:45:51 +010048 * Private FVP function to program the mailbox for a cpu before it is released
49 * from reset.
50 ******************************************************************************/
51static void fvp_program_mailbox(uint64_t mpidr, uint64_t address)
52{
53 uint64_t linear_id;
54 mailbox_t *fvp_mboxes;
55
56 linear_id = platform_get_core_pos(mpidr);
57 fvp_mboxes = (mailbox_t *)MBOX_BASE;
58 fvp_mboxes[linear_id].value = address;
59 flush_dcache_range((unsigned long) &fvp_mboxes[linear_id],
60 sizeof(unsigned long));
61}
62
63/*******************************************************************************
64 * Function which implements the common FVP specific operations to power down a
65 * cpu in response to a CPU_OFF or CPU_SUSPEND request.
66 ******************************************************************************/
67static void fvp_cpu_pwrdwn_common()
68{
Achin Gupta85876392014-07-31 17:45:51 +010069 /* Prevent interrupts from spuriously waking up this cpu */
70 arm_gic_cpuif_deactivate();
71
72 /* Program the power controller to power off this cpu. */
73 fvp_pwrc_write_ppoffr(read_mpidr_el1());
74}
75
76/*******************************************************************************
77 * Function which implements the common FVP specific operations to power down a
78 * cluster in response to a CPU_OFF or CPU_SUSPEND request.
79 ******************************************************************************/
80static void fvp_cluster_pwrdwn_common()
81{
82 uint64_t mpidr = read_mpidr_el1();
83
84 /* Disable coherency if this cluster is to be turned off */
85 if (get_plat_config()->flags & CONFIG_HAS_CCI)
86 cci_disable_cluster_coherency(mpidr);
87
88 /* Program the power controller to turn the cluster off */
89 fvp_pwrc_write_pcoffr(mpidr);
90}
91
92/*******************************************************************************
93 * Private FVP function which is used to determine if any platform actions
94 * should be performed for the specified affinity instance given its
95 * state. Nothing needs to be done if the 'state' is not off or if this is not
96 * the highest affinity level which will enter the 'state'.
97 ******************************************************************************/
98static int32_t fvp_do_plat_actions(unsigned int afflvl, unsigned int state)
99{
100 unsigned int max_phys_off_afflvl;
101
102 assert(afflvl <= MPIDR_AFFLVL1);
103
104 if (state != PSCI_STATE_OFF)
105 return -EAGAIN;
106
107 /*
108 * Find the highest affinity level which will be suspended and postpone
109 * all the platform specific actions until that level is hit.
110 */
111 max_phys_off_afflvl = psci_get_max_phys_off_afflvl();
112 assert(max_phys_off_afflvl != PSCI_INVALID_DATA);
113 if (afflvl != max_phys_off_afflvl)
114 return -EAGAIN;
115
116 return 0;
117}
118
119/*******************************************************************************
Vikram Kanigiri3b7c59b2014-03-21 11:57:10 +0000120 * FVP handler called when an affinity instance is about to enter standby.
121 ******************************************************************************/
122int fvp_affinst_standby(unsigned int power_state)
123{
124 unsigned int target_afflvl;
125
126 /* Sanity check the requested state */
127 target_afflvl = psci_get_pstate_afflvl(power_state);
128
129 /*
130 * It's possible to enter standby only on affinity level 0 i.e. a cpu
131 * on the FVP. Ignore any other affinity level.
132 */
133 if (target_afflvl != MPIDR_AFFLVL0)
134 return PSCI_E_INVALID_PARAMS;
135
Andrew Thoelke42e75a72014-04-28 12:28:39 +0100136 /*
137 * Enter standby state
138 * dsb is good practice before using wfi to enter low power states
139 */
140 dsb();
Vikram Kanigiri3b7c59b2014-03-21 11:57:10 +0000141 wfi();
142
143 return PSCI_E_SUCCESS;
144}
145
146/*******************************************************************************
Achin Gupta4f6ad662013-10-25 09:08:21 +0100147 * FVP handler called when an affinity instance is about to be turned on. The
148 * level and mpidr determine the affinity instance.
149 ******************************************************************************/
150int fvp_affinst_on(unsigned long mpidr,
151 unsigned long sec_entrypoint,
152 unsigned long ns_entrypoint,
153 unsigned int afflvl,
154 unsigned int state)
155{
156 int rc = PSCI_E_SUCCESS;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100157 unsigned int psysr;
158
Achin Gupta4f6ad662013-10-25 09:08:21 +0100159 /*
160 * It's possible to turn on only affinity level 0 i.e. a cpu
161 * on the FVP. Ignore any other affinity level.
162 */
163 if (afflvl != MPIDR_AFFLVL0)
Achin Gupta85876392014-07-31 17:45:51 +0100164 return rc;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100165
166 /*
167 * Ensure that we do not cancel an inflight power off request
168 * for the target cpu. That would leave it in a zombie wfi.
169 * Wait for it to power off, program the jump address for the
170 * target cpu and then program the power controller to turn
171 * that cpu on
172 */
173 do {
174 psysr = fvp_pwrc_read_psysr(mpidr);
175 } while (psysr & PSYSR_AFF_L0);
176
Achin Gupta85876392014-07-31 17:45:51 +0100177 fvp_program_mailbox(mpidr, sec_entrypoint);
Achin Gupta4f6ad662013-10-25 09:08:21 +0100178 fvp_pwrc_write_pponr(mpidr);
179
Achin Gupta4f6ad662013-10-25 09:08:21 +0100180 return rc;
181}
182
183/*******************************************************************************
184 * FVP handler called when an affinity instance is about to be turned off. The
185 * level and mpidr determine the affinity instance. The 'state' arg. allows the
186 * platform to decide whether the cluster is being turned off and take apt
187 * actions.
188 *
Achin Gupta9c60d802014-06-26 11:12:37 +0100189 * CAUTION: There is no guarantee that caches will remain turned on across calls
190 * to this function as each affinity level is dealt with. So do not write & read
191 * global variables across calls. It will be wise to do flush a write to the
192 * global to prevent unpredictable results.
Achin Gupta4f6ad662013-10-25 09:08:21 +0100193 ******************************************************************************/
194int fvp_affinst_off(unsigned long mpidr,
195 unsigned int afflvl,
196 unsigned int state)
197{
Achin Gupta85876392014-07-31 17:45:51 +0100198 /* Determine if any platform actions need to be executed */
199 if (fvp_do_plat_actions(afflvl, state) == -EAGAIN)
200 return PSCI_E_SUCCESS;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100201
Achin Gupta85876392014-07-31 17:45:51 +0100202 /*
203 * If execution reaches this stage then this affinity level will be
204 * suspended. Perform at least the cpu specific actions followed the
205 * cluster specific operations if applicable.
206 */
207 fvp_cpu_pwrdwn_common();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100208
Achin Gupta85876392014-07-31 17:45:51 +0100209 if (afflvl != MPIDR_AFFLVL0)
210 fvp_cluster_pwrdwn_common();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100211
Achin Gupta85876392014-07-31 17:45:51 +0100212 return PSCI_E_SUCCESS;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100213}
214
215/*******************************************************************************
216 * FVP handler called when an affinity instance is about to be suspended. The
217 * level and mpidr determine the affinity instance. The 'state' arg. allows the
218 * platform to decide whether the cluster is being turned off and take apt
219 * actions.
220 *
Achin Gupta9c60d802014-06-26 11:12:37 +0100221 * CAUTION: There is no guarantee that caches will remain turned on across calls
222 * to this function as each affinity level is dealt with. So do not write & read
223 * global variables across calls. It will be wise to do flush a write to the
224 * global to prevent unpredictable results.
Achin Gupta4f6ad662013-10-25 09:08:21 +0100225 ******************************************************************************/
226int fvp_affinst_suspend(unsigned long mpidr,
227 unsigned long sec_entrypoint,
228 unsigned long ns_entrypoint,
229 unsigned int afflvl,
230 unsigned int state)
231{
Achin Gupta85876392014-07-31 17:45:51 +0100232 /* Determine if any platform actions need to be executed. */
233 if (fvp_do_plat_actions(afflvl, state) == -EAGAIN)
234 return PSCI_E_SUCCESS;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100235
Achin Gupta85876392014-07-31 17:45:51 +0100236 /* Program the jump address for the target cpu */
237 fvp_program_mailbox(read_mpidr_el1(), sec_entrypoint);
Achin Gupta4f6ad662013-10-25 09:08:21 +0100238
Achin Gupta85876392014-07-31 17:45:51 +0100239 /* Program the power controller to enable wakeup interrupts. */
240 fvp_pwrc_set_wen(mpidr);
Achin Gupta4f6ad662013-10-25 09:08:21 +0100241
Achin Gupta85876392014-07-31 17:45:51 +0100242 /* Perform the common cpu specific operations */
243 fvp_cpu_pwrdwn_common();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100244
Achin Gupta85876392014-07-31 17:45:51 +0100245 /* Perform the common cluster specific operations */
246 if (afflvl != MPIDR_AFFLVL0)
247 fvp_cluster_pwrdwn_common();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100248
Achin Gupta85876392014-07-31 17:45:51 +0100249 return PSCI_E_SUCCESS;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100250}
251
252/*******************************************************************************
253 * FVP handler called when an affinity instance has just been powered on after
254 * being turned off earlier. The level and mpidr determine the affinity
255 * instance. The 'state' arg. allows the platform to decide whether the cluster
256 * was turned off prior to wakeup and do what's necessary to setup it up
257 * correctly.
258 ******************************************************************************/
259int fvp_affinst_on_finish(unsigned long mpidr,
260 unsigned int afflvl,
261 unsigned int state)
262{
263 int rc = PSCI_E_SUCCESS;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100264
Achin Gupta85876392014-07-31 17:45:51 +0100265 /* Determine if any platform actions need to be executed. */
266 if (fvp_do_plat_actions(afflvl, state) == -EAGAIN)
267 return PSCI_E_SUCCESS;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100268
Achin Gupta85876392014-07-31 17:45:51 +0100269 /* Perform the common cluster specific operations */
270 if (afflvl != MPIDR_AFFLVL0) {
Achin Gupta4f6ad662013-10-25 09:08:21 +0100271 /*
Achin Gupta85876392014-07-31 17:45:51 +0100272 * This CPU might have woken up whilst the cluster was
273 * attempting to power down. In this case the FVP power
274 * controller will have a pending cluster power off request
275 * which needs to be cleared by writing to the PPONR register.
276 * This prevents the power controller from interpreting a
277 * subsequent entry of this cpu into a simple wfi as a power
278 * down request.
Achin Gupta4f6ad662013-10-25 09:08:21 +0100279 */
Achin Gupta85876392014-07-31 17:45:51 +0100280 fvp_pwrc_write_pponr(mpidr);
Achin Gupta4f6ad662013-10-25 09:08:21 +0100281
Achin Gupta85876392014-07-31 17:45:51 +0100282 /* Enable coherency if this cluster was off */
283 fvp_cci_enable();
284 }
Achin Guptab127cdb2013-11-12 16:40:00 +0000285
Achin Gupta85876392014-07-31 17:45:51 +0100286 /*
Achin Gupta85876392014-07-31 17:45:51 +0100287 * Clear PWKUPR.WEN bit to ensure interrupts do not interfere
288 * with a cpu power down unless the bit is set again
289 */
290 fvp_pwrc_clr_wen(mpidr);
Achin Gupta4f6ad662013-10-25 09:08:21 +0100291
Achin Gupta85876392014-07-31 17:45:51 +0100292 /* Zero the jump address in the mailbox for this cpu */
293 fvp_program_mailbox(read_mpidr_el1(), 0);
Achin Gupta4f6ad662013-10-25 09:08:21 +0100294
Achin Gupta85876392014-07-31 17:45:51 +0100295 /* Enable the gic cpu interface */
296 arm_gic_cpuif_setup();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100297
Achin Gupta85876392014-07-31 17:45:51 +0100298 /* TODO: This setup is needed only after a cold boot */
299 arm_gic_pcpu_distif_setup();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100300
301 return rc;
302}
303
304/*******************************************************************************
305 * FVP handler called when an affinity instance has just been powered on after
306 * having been suspended earlier. The level and mpidr determine the affinity
307 * instance.
308 * TODO: At the moment we reuse the on finisher and reinitialize the secure
309 * context. Need to implement a separate suspend finisher.
310 ******************************************************************************/
311int fvp_affinst_suspend_finish(unsigned long mpidr,
312 unsigned int afflvl,
313 unsigned int state)
314{
315 return fvp_affinst_on_finish(mpidr, afflvl, state);
316}
317
Juan Castillo4dc4a472014-08-12 11:17:06 +0100318/*******************************************************************************
319 * FVP handlers to shutdown/reboot the system
320 ******************************************************************************/
321static void __dead2 fvp_system_off(void)
322{
323 /* Write the System Configuration Control Register */
324 mmio_write_32(VE_SYSREGS_BASE + V2M_SYS_CFGCTRL,
325 CFGCTRL_START | CFGCTRL_RW | CFGCTRL_FUNC(FUNC_SHUTDOWN));
326 wfi();
327 ERROR("FVP System Off: operation not handled.\n");
328 panic();
329}
330
331static void __dead2 fvp_system_reset(void)
332{
333 /* Write the System Configuration Control Register */
334 mmio_write_32(VE_SYSREGS_BASE + V2M_SYS_CFGCTRL,
335 CFGCTRL_START | CFGCTRL_RW | CFGCTRL_FUNC(FUNC_REBOOT));
336 wfi();
337 ERROR("FVP System Reset: operation not handled.\n");
338 panic();
339}
Achin Gupta4f6ad662013-10-25 09:08:21 +0100340
341/*******************************************************************************
342 * Export the platform handlers to enable psci to invoke them
343 ******************************************************************************/
Dan Handleya4cb68e2014-04-23 13:47:06 +0100344static const plat_pm_ops_t fvp_plat_pm_ops = {
Juan Castillo4dc4a472014-08-12 11:17:06 +0100345 .affinst_standby = fvp_affinst_standby,
346 .affinst_on = fvp_affinst_on,
347 .affinst_off = fvp_affinst_off,
348 .affinst_suspend = fvp_affinst_suspend,
349 .affinst_on_finish = fvp_affinst_on_finish,
350 .affinst_suspend_finish = fvp_affinst_suspend_finish,
351 .system_off = fvp_system_off,
352 .system_reset = fvp_system_reset
Achin Gupta4f6ad662013-10-25 09:08:21 +0100353};
354
355/*******************************************************************************
356 * Export the platform specific power ops & initialize the fvp power controller
357 ******************************************************************************/
Dan Handleya4cb68e2014-04-23 13:47:06 +0100358int platform_setup_pm(const plat_pm_ops_t **plat_ops)
Achin Gupta4f6ad662013-10-25 09:08:21 +0100359{
360 *plat_ops = &fvp_plat_pm_ops;
361 return 0;
362}