xref: /rk3399_ARM-atf/plat/arm/common/arm_pm.c (revision 38dce70f51fb83b27958ba3e2ad15f5635cb1061)
1b4315306SDan Handley /*
2b4315306SDan Handley  * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved.
3b4315306SDan Handley  *
4b4315306SDan Handley  * Redistribution and use in source and binary forms, with or without
5b4315306SDan Handley  * modification, are permitted provided that the following conditions are met:
6b4315306SDan Handley  *
7b4315306SDan Handley  * Redistributions of source code must retain the above copyright notice, this
8b4315306SDan Handley  * list of conditions and the following disclaimer.
9b4315306SDan Handley  *
10b4315306SDan Handley  * Redistributions in binary form must reproduce the above copyright notice,
11b4315306SDan Handley  * this list of conditions and the following disclaimer in the documentation
12b4315306SDan Handley  * and/or other materials provided with the distribution.
13b4315306SDan Handley  *
14b4315306SDan Handley  * Neither the name of ARM nor the names of its contributors may be used
15b4315306SDan Handley  * to endorse or promote products derived from this software without specific
16b4315306SDan Handley  * prior written permission.
17b4315306SDan Handley  *
18b4315306SDan Handley  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19b4315306SDan Handley  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20b4315306SDan Handley  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21b4315306SDan Handley  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22b4315306SDan Handley  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23b4315306SDan Handley  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24b4315306SDan Handley  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25b4315306SDan Handley  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26b4315306SDan Handley  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27b4315306SDan Handley  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28b4315306SDan Handley  * POSSIBILITY OF SUCH DAMAGE.
29b4315306SDan Handley  */
30b4315306SDan Handley 
31b4315306SDan Handley #include <arch_helpers.h>
32b4315306SDan Handley #include <assert.h>
33b4315306SDan Handley #include <errno.h>
34b4315306SDan Handley #include <psci.h>
35b4315306SDan Handley 
36b4315306SDan Handley /*******************************************************************************
37b4315306SDan Handley  * ARM standard platform handler called to check the validity of the power state
38b4315306SDan Handley  * parameter.
39b4315306SDan Handley  ******************************************************************************/
40*38dce70fSSoby Mathew int arm_validate_power_state(unsigned int power_state,
41*38dce70fSSoby Mathew 			    psci_power_state_t *req_state)
42b4315306SDan Handley {
43*38dce70fSSoby Mathew 	int pstate = psci_get_pstate_type(power_state);
44*38dce70fSSoby Mathew 	int pwr_lvl = psci_get_pstate_pwrlvl(power_state);
45*38dce70fSSoby Mathew 	int i;
46*38dce70fSSoby Mathew 
47*38dce70fSSoby Mathew 	assert(req_state);
48*38dce70fSSoby Mathew 
49*38dce70fSSoby Mathew 	if (pwr_lvl > PLAT_MAX_PWR_LVL)
50b4315306SDan Handley 		return PSCI_E_INVALID_PARAMS;
51*38dce70fSSoby Mathew 
52*38dce70fSSoby Mathew 	/* Sanity check the requested state */
53*38dce70fSSoby Mathew 	if (pstate == PSTATE_TYPE_STANDBY) {
54*38dce70fSSoby Mathew 		/*
55*38dce70fSSoby Mathew 		 * It's possible to enter standby only on power level 0
56*38dce70fSSoby Mathew 		 * Ignore any other power level.
57*38dce70fSSoby Mathew 		 */
58*38dce70fSSoby Mathew 		if (pwr_lvl != ARM_PWR_LVL0)
59*38dce70fSSoby Mathew 			return PSCI_E_INVALID_PARAMS;
60*38dce70fSSoby Mathew 
61*38dce70fSSoby Mathew 		req_state->pwr_domain_state[ARM_PWR_LVL0] =
62*38dce70fSSoby Mathew 					ARM_LOCAL_STATE_RET;
63*38dce70fSSoby Mathew 	} else {
64*38dce70fSSoby Mathew 		for (i = ARM_PWR_LVL0; i <= pwr_lvl; i++)
65*38dce70fSSoby Mathew 			req_state->pwr_domain_state[i] =
66*38dce70fSSoby Mathew 					ARM_LOCAL_STATE_OFF;
67b4315306SDan Handley 	}
68b4315306SDan Handley 
69b4315306SDan Handley 	/*
70b4315306SDan Handley 	 * We expect the 'state id' to be zero.
71b4315306SDan Handley 	 */
72b4315306SDan Handley 	if (psci_get_pstate_id(power_state))
73b4315306SDan Handley 		return PSCI_E_INVALID_PARAMS;
74b4315306SDan Handley 
75b4315306SDan Handley 	return PSCI_E_SUCCESS;
76b4315306SDan Handley }
77