1 /* 2 * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved. 3 * 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 31 #include <arch_helpers.h> 32 #include <arm_def.h> 33 #include <assert.h> 34 #include <errno.h> 35 #include <plat_arm.h> 36 #include <psci.h> 37 38 #if ARM_RECOM_STATE_ID_ENC 39 extern unsigned int arm_pm_idle_states[]; 40 #endif /* __ARM_RECOM_STATE_ID_ENC__ */ 41 42 43 #if !ARM_RECOM_STATE_ID_ENC 44 /******************************************************************************* 45 * ARM standard platform handler called to check the validity of the power state 46 * parameter. 47 ******************************************************************************/ 48 int arm_validate_power_state(unsigned int power_state, 49 psci_power_state_t *req_state) 50 { 51 int pstate = psci_get_pstate_type(power_state); 52 int pwr_lvl = psci_get_pstate_pwrlvl(power_state); 53 int i; 54 55 assert(req_state); 56 57 if (pwr_lvl > PLAT_MAX_PWR_LVL) 58 return PSCI_E_INVALID_PARAMS; 59 60 /* Sanity check the requested state */ 61 if (pstate == PSTATE_TYPE_STANDBY) { 62 /* 63 * It's possible to enter standby only on power level 0 64 * Ignore any other power level. 65 */ 66 if (pwr_lvl != ARM_PWR_LVL0) 67 return PSCI_E_INVALID_PARAMS; 68 69 req_state->pwr_domain_state[ARM_PWR_LVL0] = 70 ARM_LOCAL_STATE_RET; 71 } else { 72 for (i = ARM_PWR_LVL0; i <= pwr_lvl; i++) 73 req_state->pwr_domain_state[i] = 74 ARM_LOCAL_STATE_OFF; 75 } 76 77 /* 78 * We expect the 'state id' to be zero. 79 */ 80 if (psci_get_pstate_id(power_state)) 81 return PSCI_E_INVALID_PARAMS; 82 83 return PSCI_E_SUCCESS; 84 } 85 86 #else 87 /******************************************************************************* 88 * ARM standard platform handler called to check the validity of the power 89 * state parameter. The power state parameter has to be a composite power 90 * state. 91 ******************************************************************************/ 92 int arm_validate_power_state(unsigned int power_state, 93 psci_power_state_t *req_state) 94 { 95 unsigned int state_id; 96 int i; 97 98 assert(req_state); 99 100 /* 101 * Currently we are using a linear search for finding the matching 102 * entry in the idle power state array. This can be made a binary 103 * search if the number of entries justify the additional complexity. 104 */ 105 for (i = 0; !!arm_pm_idle_states[i]; i++) { 106 if (power_state == arm_pm_idle_states[i]) 107 break; 108 } 109 110 /* Return error if entry not found in the idle state array */ 111 if (!arm_pm_idle_states[i]) 112 return PSCI_E_INVALID_PARAMS; 113 114 i = 0; 115 state_id = psci_get_pstate_id(power_state); 116 117 /* Parse the State ID and populate the state info parameter */ 118 while (state_id) { 119 req_state->pwr_domain_state[i++] = state_id & 120 ARM_LOCAL_PSTATE_MASK; 121 state_id >>= ARM_LOCAL_PSTATE_WIDTH; 122 } 123 124 return PSCI_E_SUCCESS; 125 } 126 #endif /* __ARM_RECOM_STATE_ID_ENC__ */ 127 128 /******************************************************************************* 129 * ARM standard platform handler called to check the validity of the non secure 130 * entrypoint. 131 ******************************************************************************/ 132 int arm_validate_ns_entrypoint(uintptr_t entrypoint) 133 { 134 /* 135 * Check if the non secure entrypoint lies within the non 136 * secure DRAM. 137 */ 138 if ((entrypoint >= ARM_NS_DRAM1_BASE) && (entrypoint < 139 (ARM_NS_DRAM1_BASE + ARM_NS_DRAM1_SIZE))) 140 return PSCI_E_SUCCESS; 141 if ((entrypoint >= ARM_DRAM2_BASE) && (entrypoint < 142 (ARM_DRAM2_BASE + ARM_DRAM2_SIZE))) 143 return PSCI_E_SUCCESS; 144 145 return PSCI_E_INVALID_ADDRESS; 146 } 147