1532ed618SSoby Mathew /* 29fb8af33SRoberto Vargas * Copyright (c) 2013-2018, ARM Limited and Contributors. All rights reserved. 3532ed618SSoby Mathew * 482cb2c1aSdp-arm * SPDX-License-Identifier: BSD-3-Clause 5532ed618SSoby Mathew */ 6532ed618SSoby Mathew 797373c33SAntonio Nino Diaz #ifndef PSCI_PRIVATE_H 897373c33SAntonio Nino Diaz #define PSCI_PRIVATE_H 9532ed618SSoby Mathew 10532ed618SSoby Mathew #include <arch.h> 114829df83SAntonio Nino Diaz #include <arch_helpers.h> 12532ed618SSoby Mathew #include <bakery_lock.h> 13532ed618SSoby Mathew #include <bl_common.h> 14532ed618SSoby Mathew #include <cpu_data.h> 15532ed618SSoby Mathew #include <psci.h> 16532ed618SSoby Mathew #include <spinlock.h> 17*362030bfSAntonio Nino Diaz #include <stdbool.h> 18532ed618SSoby Mathew 19532ed618SSoby Mathew /* 20532ed618SSoby Mathew * The PSCI capability which are provided by the generic code but does not 21532ed618SSoby Mathew * depend on the platform or spd capabilities. 22532ed618SSoby Mathew */ 23532ed618SSoby Mathew #define PSCI_GENERIC_CAP \ 24532ed618SSoby Mathew (define_psci_cap(PSCI_VERSION) | \ 25532ed618SSoby Mathew define_psci_cap(PSCI_AFFINITY_INFO_AARCH64) | \ 26532ed618SSoby Mathew define_psci_cap(PSCI_FEATURES)) 27532ed618SSoby Mathew 28532ed618SSoby Mathew /* 29532ed618SSoby Mathew * The PSCI capabilities mask for 64 bit functions. 30532ed618SSoby Mathew */ 31532ed618SSoby Mathew #define PSCI_CAP_64BIT_MASK \ 32532ed618SSoby Mathew (define_psci_cap(PSCI_CPU_SUSPEND_AARCH64) | \ 33532ed618SSoby Mathew define_psci_cap(PSCI_CPU_ON_AARCH64) | \ 34532ed618SSoby Mathew define_psci_cap(PSCI_AFFINITY_INFO_AARCH64) | \ 35532ed618SSoby Mathew define_psci_cap(PSCI_MIG_AARCH64) | \ 36532ed618SSoby Mathew define_psci_cap(PSCI_MIG_INFO_UP_CPU_AARCH64) | \ 3728d3d614SJeenu Viswambharan define_psci_cap(PSCI_NODE_HW_STATE_AARCH64) | \ 38532ed618SSoby Mathew define_psci_cap(PSCI_SYSTEM_SUSPEND_AARCH64) | \ 39532ed618SSoby Mathew define_psci_cap(PSCI_STAT_RESIDENCY_AARCH64) | \ 4036a8f8fdSRoberto Vargas define_psci_cap(PSCI_STAT_COUNT_AARCH64) | \ 414ce9b8eaSRoberto Vargas define_psci_cap(PSCI_SYSTEM_RESET2_AARCH64) | \ 424ce9b8eaSRoberto Vargas define_psci_cap(PSCI_MEM_CHK_RANGE_AARCH64)) 43532ed618SSoby Mathew 44532ed618SSoby Mathew /* 4597373c33SAntonio Nino Diaz * Helper functions to get/set the fields of PSCI per-cpu data. 46532ed618SSoby Mathew */ 4797373c33SAntonio Nino Diaz static inline void psci_set_aff_info_state(aff_info_state_t aff_state) 4897373c33SAntonio Nino Diaz { 4997373c33SAntonio Nino Diaz set_cpu_data(psci_svc_cpu_data.aff_info_state, aff_state); 5097373c33SAntonio Nino Diaz } 51532ed618SSoby Mathew 5297373c33SAntonio Nino Diaz static inline aff_info_state_t psci_get_aff_info_state(void) 5397373c33SAntonio Nino Diaz { 5497373c33SAntonio Nino Diaz return get_cpu_data(psci_svc_cpu_data.aff_info_state); 5597373c33SAntonio Nino Diaz } 56532ed618SSoby Mathew 5797373c33SAntonio Nino Diaz static inline aff_info_state_t psci_get_aff_info_state_by_idx(int idx) 5897373c33SAntonio Nino Diaz { 5997373c33SAntonio Nino Diaz return get_cpu_data_by_index((unsigned int)idx, 6097373c33SAntonio Nino Diaz psci_svc_cpu_data.aff_info_state); 6197373c33SAntonio Nino Diaz } 6297373c33SAntonio Nino Diaz 6397373c33SAntonio Nino Diaz static inline void psci_set_aff_info_state_by_idx(int idx, 6497373c33SAntonio Nino Diaz aff_info_state_t aff_state) 6597373c33SAntonio Nino Diaz { 6697373c33SAntonio Nino Diaz set_cpu_data_by_index((unsigned int)idx, 6797373c33SAntonio Nino Diaz psci_svc_cpu_data.aff_info_state, aff_state); 6897373c33SAntonio Nino Diaz } 6997373c33SAntonio Nino Diaz 7097373c33SAntonio Nino Diaz static inline unsigned int psci_get_suspend_pwrlvl(void) 7197373c33SAntonio Nino Diaz { 7297373c33SAntonio Nino Diaz return get_cpu_data(psci_svc_cpu_data.target_pwrlvl); 7397373c33SAntonio Nino Diaz } 7497373c33SAntonio Nino Diaz 7597373c33SAntonio Nino Diaz static inline void psci_set_suspend_pwrlvl(unsigned int target_lvl) 7697373c33SAntonio Nino Diaz { 7797373c33SAntonio Nino Diaz set_cpu_data(psci_svc_cpu_data.target_pwrlvl, target_lvl); 7897373c33SAntonio Nino Diaz } 7997373c33SAntonio Nino Diaz 8097373c33SAntonio Nino Diaz static inline void psci_set_cpu_local_state(plat_local_state_t state) 8197373c33SAntonio Nino Diaz { 8297373c33SAntonio Nino Diaz set_cpu_data(psci_svc_cpu_data.local_state, state); 8397373c33SAntonio Nino Diaz } 8497373c33SAntonio Nino Diaz 8597373c33SAntonio Nino Diaz static inline plat_local_state_t psci_get_cpu_local_state(void) 8697373c33SAntonio Nino Diaz { 8797373c33SAntonio Nino Diaz return get_cpu_data(psci_svc_cpu_data.local_state); 8897373c33SAntonio Nino Diaz } 8997373c33SAntonio Nino Diaz 9097373c33SAntonio Nino Diaz static inline plat_local_state_t psci_get_cpu_local_state_by_idx(int idx) 9197373c33SAntonio Nino Diaz { 9297373c33SAntonio Nino Diaz return get_cpu_data_by_index((unsigned int)idx, 9397373c33SAntonio Nino Diaz psci_svc_cpu_data.local_state); 9497373c33SAntonio Nino Diaz } 9597373c33SAntonio Nino Diaz 9697373c33SAntonio Nino Diaz /* Helper function to identify a CPU standby request in PSCI Suspend call */ 97*362030bfSAntonio Nino Diaz static inline bool is_cpu_standby_req(unsigned int is_power_down_state, 9897373c33SAntonio Nino Diaz unsigned int retn_lvl) 9997373c33SAntonio Nino Diaz { 100*362030bfSAntonio Nino Diaz return (is_power_down_state == 0U) && (retn_lvl == 0U); 10197373c33SAntonio Nino Diaz } 102532ed618SSoby Mathew 103532ed618SSoby Mathew /******************************************************************************* 104532ed618SSoby Mathew * The following two data structures implement the power domain tree. The tree 105532ed618SSoby Mathew * is used to track the state of all the nodes i.e. power domain instances 106532ed618SSoby Mathew * described by the platform. The tree consists of nodes that describe CPU power 107532ed618SSoby Mathew * domains i.e. leaf nodes and all other power domains which are parents of a 108532ed618SSoby Mathew * CPU power domain i.e. non-leaf nodes. 109532ed618SSoby Mathew ******************************************************************************/ 110532ed618SSoby Mathew typedef struct non_cpu_pwr_domain_node { 111532ed618SSoby Mathew /* 112532ed618SSoby Mathew * Index of the first CPU power domain node level 0 which has this node 113532ed618SSoby Mathew * as its parent. 114532ed618SSoby Mathew */ 1151083b2b3SAntonio Nino Diaz int cpu_start_idx; 116532ed618SSoby Mathew 117532ed618SSoby Mathew /* 118532ed618SSoby Mathew * Number of CPU power domains which are siblings of the domain indexed 119532ed618SSoby Mathew * by 'cpu_start_idx' i.e. all the domains in the range 'cpu_start_idx 120532ed618SSoby Mathew * -> cpu_start_idx + ncpus' have this node as their parent. 121532ed618SSoby Mathew */ 122532ed618SSoby Mathew unsigned int ncpus; 123532ed618SSoby Mathew 124532ed618SSoby Mathew /* 125532ed618SSoby Mathew * Index of the parent power domain node. 126532ed618SSoby Mathew * TODO: Figure out whether to whether using pointer is more efficient. 127532ed618SSoby Mathew */ 128532ed618SSoby Mathew unsigned int parent_node; 129532ed618SSoby Mathew 130532ed618SSoby Mathew plat_local_state_t local_state; 131532ed618SSoby Mathew 132532ed618SSoby Mathew unsigned char level; 133532ed618SSoby Mathew 134532ed618SSoby Mathew /* For indexing the psci_lock array*/ 135532ed618SSoby Mathew unsigned char lock_index; 136532ed618SSoby Mathew } non_cpu_pd_node_t; 137532ed618SSoby Mathew 138532ed618SSoby Mathew typedef struct cpu_pwr_domain_node { 139532ed618SSoby Mathew u_register_t mpidr; 140532ed618SSoby Mathew 141532ed618SSoby Mathew /* 142532ed618SSoby Mathew * Index of the parent power domain node. 143532ed618SSoby Mathew * TODO: Figure out whether to whether using pointer is more efficient. 144532ed618SSoby Mathew */ 145532ed618SSoby Mathew unsigned int parent_node; 146532ed618SSoby Mathew 147532ed618SSoby Mathew /* 148532ed618SSoby Mathew * A CPU power domain does not require state coordination like its 149532ed618SSoby Mathew * parent power domains. Hence this node does not include a bakery 150532ed618SSoby Mathew * lock. A spinlock is required by the CPU_ON handler to prevent a race 151532ed618SSoby Mathew * when multiple CPUs try to turn ON the same target CPU. 152532ed618SSoby Mathew */ 153532ed618SSoby Mathew spinlock_t cpu_lock; 154532ed618SSoby Mathew } cpu_pd_node_t; 155532ed618SSoby Mathew 156532ed618SSoby Mathew /******************************************************************************* 1574829df83SAntonio Nino Diaz * The following are helpers and declarations of locks. 1584829df83SAntonio Nino Diaz ******************************************************************************/ 1594829df83SAntonio Nino Diaz #if HW_ASSISTED_COHERENCY 1604829df83SAntonio Nino Diaz /* 1614829df83SAntonio Nino Diaz * On systems where participant CPUs are cache-coherent, we can use spinlocks 1624829df83SAntonio Nino Diaz * instead of bakery locks. 1634829df83SAntonio Nino Diaz */ 1644829df83SAntonio Nino Diaz #define DEFINE_PSCI_LOCK(_name) spinlock_t _name 1654829df83SAntonio Nino Diaz #define DECLARE_PSCI_LOCK(_name) extern DEFINE_PSCI_LOCK(_name) 1664829df83SAntonio Nino Diaz 1674829df83SAntonio Nino Diaz /* One lock is required per non-CPU power domain node */ 1684829df83SAntonio Nino Diaz DECLARE_PSCI_LOCK(psci_locks[PSCI_NUM_NON_CPU_PWR_DOMAINS]); 1694829df83SAntonio Nino Diaz 1704829df83SAntonio Nino Diaz /* 1714829df83SAntonio Nino Diaz * On systems with hardware-assisted coherency, make PSCI cache operations NOP, 1724829df83SAntonio Nino Diaz * as PSCI participants are cache-coherent, and there's no need for explicit 1734829df83SAntonio Nino Diaz * cache maintenance operations or barriers to coordinate their state. 1744829df83SAntonio Nino Diaz */ 1754829df83SAntonio Nino Diaz static inline void psci_flush_dcache_range(uintptr_t __unused addr, 1764829df83SAntonio Nino Diaz size_t __unused size) 1774829df83SAntonio Nino Diaz { 1784829df83SAntonio Nino Diaz /* Empty */ 1794829df83SAntonio Nino Diaz } 1804829df83SAntonio Nino Diaz 1814829df83SAntonio Nino Diaz #define psci_flush_cpu_data(member) 1824829df83SAntonio Nino Diaz #define psci_inv_cpu_data(member) 1834829df83SAntonio Nino Diaz 1844829df83SAntonio Nino Diaz static inline void psci_dsbish(void) 1854829df83SAntonio Nino Diaz { 1864829df83SAntonio Nino Diaz /* Empty */ 1874829df83SAntonio Nino Diaz } 1884829df83SAntonio Nino Diaz 1894829df83SAntonio Nino Diaz static inline void psci_lock_get(non_cpu_pd_node_t *non_cpu_pd_node) 1904829df83SAntonio Nino Diaz { 1914829df83SAntonio Nino Diaz spin_lock(&psci_locks[non_cpu_pd_node->lock_index]); 1924829df83SAntonio Nino Diaz } 1934829df83SAntonio Nino Diaz 1944829df83SAntonio Nino Diaz static inline void psci_lock_release(non_cpu_pd_node_t *non_cpu_pd_node) 1954829df83SAntonio Nino Diaz { 1964829df83SAntonio Nino Diaz spin_unlock(&psci_locks[non_cpu_pd_node->lock_index]); 1974829df83SAntonio Nino Diaz } 1984829df83SAntonio Nino Diaz 1994829df83SAntonio Nino Diaz #else /* if HW_ASSISTED_COHERENCY == 0 */ 2004829df83SAntonio Nino Diaz /* 2014829df83SAntonio Nino Diaz * Use bakery locks for state coordination as not all PSCI participants are 2024829df83SAntonio Nino Diaz * cache coherent. 2034829df83SAntonio Nino Diaz */ 2044829df83SAntonio Nino Diaz #define DEFINE_PSCI_LOCK(_name) DEFINE_BAKERY_LOCK(_name) 2054829df83SAntonio Nino Diaz #define DECLARE_PSCI_LOCK(_name) DECLARE_BAKERY_LOCK(_name) 2064829df83SAntonio Nino Diaz 2074829df83SAntonio Nino Diaz /* One lock is required per non-CPU power domain node */ 2084829df83SAntonio Nino Diaz DECLARE_PSCI_LOCK(psci_locks[PSCI_NUM_NON_CPU_PWR_DOMAINS]); 2094829df83SAntonio Nino Diaz 2104829df83SAntonio Nino Diaz /* 2114829df83SAntonio Nino Diaz * If not all PSCI participants are cache-coherent, perform cache maintenance 2124829df83SAntonio Nino Diaz * and issue barriers wherever required to coordinate state. 2134829df83SAntonio Nino Diaz */ 2144829df83SAntonio Nino Diaz static inline void psci_flush_dcache_range(uintptr_t addr, size_t size) 2154829df83SAntonio Nino Diaz { 2164829df83SAntonio Nino Diaz flush_dcache_range(addr, size); 2174829df83SAntonio Nino Diaz } 2184829df83SAntonio Nino Diaz 2194829df83SAntonio Nino Diaz #define psci_flush_cpu_data(member) flush_cpu_data(member) 2204829df83SAntonio Nino Diaz #define psci_inv_cpu_data(member) inv_cpu_data(member) 2214829df83SAntonio Nino Diaz 2224829df83SAntonio Nino Diaz static inline void psci_dsbish(void) 2234829df83SAntonio Nino Diaz { 2244829df83SAntonio Nino Diaz dsbish(); 2254829df83SAntonio Nino Diaz } 2264829df83SAntonio Nino Diaz 2274829df83SAntonio Nino Diaz static inline void psci_lock_get(non_cpu_pd_node_t *non_cpu_pd_node) 2284829df83SAntonio Nino Diaz { 2294829df83SAntonio Nino Diaz bakery_lock_get(&psci_locks[non_cpu_pd_node->lock_index]); 2304829df83SAntonio Nino Diaz } 2314829df83SAntonio Nino Diaz 2324829df83SAntonio Nino Diaz static inline void psci_lock_release(non_cpu_pd_node_t *non_cpu_pd_node) 2334829df83SAntonio Nino Diaz { 2344829df83SAntonio Nino Diaz bakery_lock_release(&psci_locks[non_cpu_pd_node->lock_index]); 2354829df83SAntonio Nino Diaz } 2364829df83SAntonio Nino Diaz 2374829df83SAntonio Nino Diaz #endif /* HW_ASSISTED_COHERENCY */ 2384829df83SAntonio Nino Diaz 2394829df83SAntonio Nino Diaz static inline void psci_lock_init(non_cpu_pd_node_t *non_cpu_pd_node, 2404829df83SAntonio Nino Diaz unsigned char idx) 2414829df83SAntonio Nino Diaz { 2424829df83SAntonio Nino Diaz non_cpu_pd_node[idx].lock_index = idx; 2434829df83SAntonio Nino Diaz } 2444829df83SAntonio Nino Diaz 2454829df83SAntonio Nino Diaz /******************************************************************************* 246532ed618SSoby Mathew * Data prototypes 247532ed618SSoby Mathew ******************************************************************************/ 248532ed618SSoby Mathew extern const plat_psci_ops_t *psci_plat_pm_ops; 249532ed618SSoby Mathew extern non_cpu_pd_node_t psci_non_cpu_pd_nodes[PSCI_NUM_NON_CPU_PWR_DOMAINS]; 250532ed618SSoby Mathew extern cpu_pd_node_t psci_cpu_pd_nodes[PLATFORM_CORE_COUNT]; 251532ed618SSoby Mathew extern unsigned int psci_caps; 252532ed618SSoby Mathew 253532ed618SSoby Mathew /******************************************************************************* 254532ed618SSoby Mathew * SPD's power management hooks registered with PSCI 255532ed618SSoby Mathew ******************************************************************************/ 256532ed618SSoby Mathew extern const spd_pm_ops_t *psci_spd_pm; 257532ed618SSoby Mathew 258532ed618SSoby Mathew /******************************************************************************* 259532ed618SSoby Mathew * Function prototypes 260532ed618SSoby Mathew ******************************************************************************/ 261532ed618SSoby Mathew /* Private exported functions from psci_common.c */ 262532ed618SSoby Mathew int psci_validate_power_state(unsigned int power_state, 263532ed618SSoby Mathew psci_power_state_t *state_info); 264532ed618SSoby Mathew void psci_query_sys_suspend_pwrstate(psci_power_state_t *state_info); 265532ed618SSoby Mathew int psci_validate_mpidr(u_register_t mpidr); 266532ed618SSoby Mathew void psci_init_req_local_pwr_states(void); 26761eae524SAchin Gupta void psci_get_target_local_pwr_states(unsigned int end_pwrlvl, 26861eae524SAchin Gupta psci_power_state_t *target_state); 269532ed618SSoby Mathew int psci_validate_entry_point(entry_point_info_t *ep, 270532ed618SSoby Mathew uintptr_t entrypoint, u_register_t context_id); 2716b7b0f36SAntonio Nino Diaz void psci_get_parent_pwr_domain_nodes(int cpu_idx, 272532ed618SSoby Mathew unsigned int end_lvl, 2736b7b0f36SAntonio Nino Diaz unsigned int *node_index); 274532ed618SSoby Mathew void psci_do_state_coordination(unsigned int end_pwrlvl, 275532ed618SSoby Mathew psci_power_state_t *state_info); 2766b7b0f36SAntonio Nino Diaz void psci_acquire_pwr_domain_locks(unsigned int end_pwrlvl, int cpu_idx); 2776b7b0f36SAntonio Nino Diaz void psci_release_pwr_domain_locks(unsigned int end_pwrlvl, int cpu_idx); 278532ed618SSoby Mathew int psci_validate_suspend_req(const psci_power_state_t *state_info, 2799fb8af33SRoberto Vargas unsigned int is_power_down_state); 280532ed618SSoby Mathew unsigned int psci_find_max_off_lvl(const psci_power_state_t *state_info); 281532ed618SSoby Mathew unsigned int psci_find_target_suspend_lvl(const psci_power_state_t *state_info); 282532ed618SSoby Mathew void psci_set_pwr_domains_to_run(unsigned int end_pwrlvl); 283532ed618SSoby Mathew void psci_print_power_domain_map(void); 284532ed618SSoby Mathew unsigned int psci_is_last_on_cpu(void); 285532ed618SSoby Mathew int psci_spd_migrate_info(u_register_t *mpidr); 286b0408e87SJeenu Viswambharan void psci_do_pwrdown_sequence(unsigned int power_level); 287b0408e87SJeenu Viswambharan 288b0408e87SJeenu Viswambharan /* 289b0408e87SJeenu Viswambharan * CPU power down is directly called only when HW_ASSISTED_COHERENCY is 290b0408e87SJeenu Viswambharan * available. Otherwise, this needs post-call stack maintenance, which is 291b0408e87SJeenu Viswambharan * handled in assembly. 292b0408e87SJeenu Viswambharan */ 293b0408e87SJeenu Viswambharan void prepare_cpu_pwr_dwn(unsigned int power_level); 294532ed618SSoby Mathew 295532ed618SSoby Mathew /* Private exported functions from psci_on.c */ 296532ed618SSoby Mathew int psci_cpu_on_start(u_register_t target_cpu, 297621d64f8SAntonio Nino Diaz const entry_point_info_t *ep); 298532ed618SSoby Mathew 299621d64f8SAntonio Nino Diaz void psci_cpu_on_finish(int cpu_idx, const psci_power_state_t *state_info); 300532ed618SSoby Mathew 301532ed618SSoby Mathew /* Private exported functions from psci_off.c */ 302532ed618SSoby Mathew int psci_do_cpu_off(unsigned int end_pwrlvl); 303532ed618SSoby Mathew 304532ed618SSoby Mathew /* Private exported functions from psci_suspend.c */ 305621d64f8SAntonio Nino Diaz void psci_cpu_suspend_start(const entry_point_info_t *ep, 306532ed618SSoby Mathew unsigned int end_pwrlvl, 307532ed618SSoby Mathew psci_power_state_t *state_info, 3089fb8af33SRoberto Vargas unsigned int is_power_down_state); 309532ed618SSoby Mathew 310621d64f8SAntonio Nino Diaz void psci_cpu_suspend_finish(int cpu_idx, const psci_power_state_t *state_info); 311532ed618SSoby Mathew 312532ed618SSoby Mathew /* Private exported functions from psci_helpers.S */ 313532ed618SSoby Mathew void psci_do_pwrdown_cache_maintenance(unsigned int pwr_level); 314532ed618SSoby Mathew void psci_do_pwrup_cache_maintenance(void); 315532ed618SSoby Mathew 316532ed618SSoby Mathew /* Private exported functions from psci_system_off.c */ 317532ed618SSoby Mathew void __dead2 psci_system_off(void); 318532ed618SSoby Mathew void __dead2 psci_system_reset(void); 319621d64f8SAntonio Nino Diaz u_register_t psci_system_reset2(uint32_t reset_type, u_register_t cookie); 320532ed618SSoby Mathew 321532ed618SSoby Mathew /* Private exported functions from psci_stat.c */ 322532ed618SSoby Mathew void psci_stats_update_pwr_down(unsigned int end_pwrlvl, 323532ed618SSoby Mathew const psci_power_state_t *state_info); 324532ed618SSoby Mathew void psci_stats_update_pwr_up(unsigned int end_pwrlvl, 32504c1db1eSdp-arm const psci_power_state_t *state_info); 326532ed618SSoby Mathew u_register_t psci_stat_residency(u_register_t target_cpu, 327532ed618SSoby Mathew unsigned int power_state); 328532ed618SSoby Mathew u_register_t psci_stat_count(u_register_t target_cpu, 329532ed618SSoby Mathew unsigned int power_state); 330532ed618SSoby Mathew 331d4c596beSRoberto Vargas /* Private exported functions from psci_mem_protect.c */ 3328c20c3c9SAntonio Nino Diaz u_register_t psci_mem_protect(unsigned int enable); 3338c20c3c9SAntonio Nino Diaz u_register_t psci_mem_chk_range(uintptr_t base, u_register_t length); 334d4c596beSRoberto Vargas 33597373c33SAntonio Nino Diaz #endif /* PSCI_PRIVATE_H */ 336