Tegra186: implement `get_target_pwr_state` handler
This patch implements the `get_target_pwr_state` handler for Tegra186 SoCs. The SoC port uses this handler to find out the cluster/system state during CPU_SUSPEND, CPU_OFF and SYSTEM_SUSPEND calls. The MCE firmware controls the power state of the CPU/CLuster/System, so we query it to get the state and act accordingly. Change-Id: I86633d8d79aec7dcb405d2301ac69910f93110fe Signed-off-by: Varun Wadekar <vwadekar@nvidia.com>
This commit is contained in:
parent
87a1df7361
commit
f3a20c3224
|
@ -37,6 +37,7 @@
|
||||||
#include <debug.h>
|
#include <debug.h>
|
||||||
#include <denver.h>
|
#include <denver.h>
|
||||||
#include <mce.h>
|
#include <mce.h>
|
||||||
|
#include <platform.h>
|
||||||
#include <psci.h>
|
#include <psci.h>
|
||||||
#include <smmu.h>
|
#include <smmu.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
|
@ -71,12 +72,9 @@ int32_t tegra_soc_validate_power_state(unsigned int power_state,
|
||||||
psci_power_state_t *req_state)
|
psci_power_state_t *req_state)
|
||||||
{
|
{
|
||||||
int state_id = psci_get_pstate_id(power_state) & TEGRA186_STATE_ID_MASK;
|
int state_id = psci_get_pstate_id(power_state) & TEGRA186_STATE_ID_MASK;
|
||||||
int cpu = read_mpidr() & MPIDR_CPU_MASK;
|
int cpu = plat_my_core_pos();
|
||||||
int impl = (read_midr() >> MIDR_IMPL_SHIFT) & MIDR_IMPL_MASK;
|
|
||||||
|
|
||||||
if (impl == DENVER_IMPL)
|
|
||||||
cpu |= 0x4;
|
|
||||||
|
|
||||||
|
/* save the core wake time (us) */
|
||||||
wake_time[cpu] = (power_state >> TEGRA186_WAKE_TIME_SHIFT) &
|
wake_time[cpu] = (power_state >> TEGRA186_WAKE_TIME_SHIFT) &
|
||||||
TEGRA186_WAKE_TIME_MASK;
|
TEGRA186_WAKE_TIME_MASK;
|
||||||
|
|
||||||
|
@ -84,10 +82,10 @@ int32_t tegra_soc_validate_power_state(unsigned int power_state,
|
||||||
switch (state_id) {
|
switch (state_id) {
|
||||||
case PSTATE_ID_CORE_IDLE:
|
case PSTATE_ID_CORE_IDLE:
|
||||||
case PSTATE_ID_CORE_POWERDN:
|
case PSTATE_ID_CORE_POWERDN:
|
||||||
/*
|
|
||||||
* Core powerdown request only for afflvl 0
|
/* Core powerdown request */
|
||||||
*/
|
|
||||||
req_state->pwr_domain_state[MPIDR_AFFLVL0] = state_id;
|
req_state->pwr_domain_state[MPIDR_AFFLVL0] = state_id;
|
||||||
|
req_state->pwr_domain_state[MPIDR_AFFLVL1] = state_id;
|
||||||
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
@ -103,20 +101,12 @@ int tegra_soc_pwr_domain_suspend(const psci_power_state_t *target_state)
|
||||||
{
|
{
|
||||||
const plat_local_state_t *pwr_domain_state;
|
const plat_local_state_t *pwr_domain_state;
|
||||||
unsigned int stateid_afflvl0, stateid_afflvl2;
|
unsigned int stateid_afflvl0, stateid_afflvl2;
|
||||||
int cpu = read_mpidr() & MPIDR_CPU_MASK;
|
int cpu = plat_my_core_pos();
|
||||||
int impl = (read_midr() >> MIDR_IMPL_SHIFT) & MIDR_IMPL_MASK;
|
|
||||||
cpu_context_t *ctx = cm_get_context(NON_SECURE);
|
|
||||||
gp_regs_t *gp_regs = get_gpregs_ctx(ctx);
|
|
||||||
plat_params_from_bl2_t *params_from_bl2 = bl31_get_plat_params();
|
plat_params_from_bl2_t *params_from_bl2 = bl31_get_plat_params();
|
||||||
|
mce_cstate_info_t cstate_info = { 0 };
|
||||||
uint64_t smmu_ctx_base;
|
uint64_t smmu_ctx_base;
|
||||||
uint32_t val;
|
uint32_t val;
|
||||||
|
|
||||||
assert(ctx);
|
|
||||||
assert(gp_regs);
|
|
||||||
|
|
||||||
if (impl == DENVER_IMPL)
|
|
||||||
cpu |= 0x4;
|
|
||||||
|
|
||||||
/* get the state ID */
|
/* get the state ID */
|
||||||
pwr_domain_state = target_state->pwr_domain_state;
|
pwr_domain_state = target_state->pwr_domain_state;
|
||||||
stateid_afflvl0 = pwr_domain_state[MPIDR_AFFLVL0] &
|
stateid_afflvl0 = pwr_domain_state[MPIDR_AFFLVL0] &
|
||||||
|
@ -124,29 +114,14 @@ int tegra_soc_pwr_domain_suspend(const psci_power_state_t *target_state)
|
||||||
stateid_afflvl2 = pwr_domain_state[PLAT_MAX_PWR_LVL] &
|
stateid_afflvl2 = pwr_domain_state[PLAT_MAX_PWR_LVL] &
|
||||||
TEGRA186_STATE_ID_MASK;
|
TEGRA186_STATE_ID_MASK;
|
||||||
|
|
||||||
if (stateid_afflvl0 == PSTATE_ID_CORE_IDLE) {
|
if ((stateid_afflvl0 == PSTATE_ID_CORE_IDLE) ||
|
||||||
|
(stateid_afflvl0 == PSTATE_ID_CORE_POWERDN)) {
|
||||||
|
|
||||||
/* Program default wake mask */
|
/* Enter CPU idle/powerdown */
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X4, 0);
|
val = (stateid_afflvl0 == PSTATE_ID_CORE_IDLE) ?
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X5, TEGRA186_CORE_WAKE_MASK);
|
TEGRA_ARI_CORE_C6 : TEGRA_ARI_CORE_C7;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X6, 1);
|
(void)mce_command_handler(MCE_CMD_ENTER_CSTATE, val,
|
||||||
(void)mce_command_handler(MCE_CMD_UPDATE_CSTATE_INFO, 0, 0, 0);
|
wake_time[cpu], 0);
|
||||||
|
|
||||||
/* Prepare for cpu idle */
|
|
||||||
(void)mce_command_handler(MCE_CMD_ENTER_CSTATE,
|
|
||||||
TEGRA_ARI_CORE_C6, wake_time[cpu], 0);
|
|
||||||
|
|
||||||
} else if (stateid_afflvl0 == PSTATE_ID_CORE_POWERDN) {
|
|
||||||
|
|
||||||
/* Program default wake mask */
|
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X4, 0);
|
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X5, TEGRA186_CORE_WAKE_MASK);
|
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X6, 1);
|
|
||||||
(void)mce_command_handler(MCE_CMD_UPDATE_CSTATE_INFO, 0, 0, 0);
|
|
||||||
|
|
||||||
/* Prepare for cpu powerdn */
|
|
||||||
(void)mce_command_handler(MCE_CMD_ENTER_CSTATE,
|
|
||||||
TEGRA_ARI_CORE_C7, wake_time[cpu], 0);
|
|
||||||
|
|
||||||
} else if (stateid_afflvl2 == PSTATE_ID_SOC_POWERDN) {
|
} else if (stateid_afflvl2 == PSTATE_ID_SOC_POWERDN) {
|
||||||
|
|
||||||
|
@ -170,11 +145,11 @@ int tegra_soc_pwr_domain_suspend(const psci_power_state_t *target_state)
|
||||||
tegra_smmu_save_context((uintptr_t)smmu_ctx_base);
|
tegra_smmu_save_context((uintptr_t)smmu_ctx_base);
|
||||||
|
|
||||||
/* Prepare for system suspend */
|
/* Prepare for system suspend */
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X4, 1);
|
cstate_info.cluster = TEGRA_ARI_CLUSTER_CC7;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X5, 0);
|
cstate_info.system = TEGRA_ARI_SYSTEM_SC7;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X6, 1);
|
cstate_info.system_state_force = 1;
|
||||||
(void)mce_command_handler(MCE_CMD_UPDATE_CSTATE_INFO,
|
cstate_info.update_wake_mask = 1;
|
||||||
TEGRA_ARI_CLUSTER_CC7, 0, TEGRA_ARI_SYSTEM_SC7);
|
mce_update_cstate_info(&cstate_info);
|
||||||
|
|
||||||
/* Loop until system suspend is allowed */
|
/* Loop until system suspend is allowed */
|
||||||
do {
|
do {
|
||||||
|
@ -187,15 +162,84 @@ int tegra_soc_pwr_domain_suspend(const psci_power_state_t *target_state)
|
||||||
/* Instruct the MCE to enter system suspend state */
|
/* Instruct the MCE to enter system suspend state */
|
||||||
(void)mce_command_handler(MCE_CMD_ENTER_CSTATE,
|
(void)mce_command_handler(MCE_CMD_ENTER_CSTATE,
|
||||||
TEGRA_ARI_CORE_C7, MCE_CORE_SLEEP_TIME_INFINITE, 0);
|
TEGRA_ARI_CORE_C7, MCE_CORE_SLEEP_TIME_INFINITE, 0);
|
||||||
|
|
||||||
} else {
|
|
||||||
ERROR("%s: Unknown state id\n", __func__);
|
|
||||||
return PSCI_E_NOT_SUPPORTED;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return PSCI_E_SUCCESS;
|
return PSCI_E_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*******************************************************************************
|
||||||
|
* Platform handler to calculate the proper target power level at the
|
||||||
|
* specified affinity level
|
||||||
|
******************************************************************************/
|
||||||
|
plat_local_state_t tegra_soc_get_target_pwr_state(unsigned int lvl,
|
||||||
|
const plat_local_state_t *states,
|
||||||
|
unsigned int ncpu)
|
||||||
|
{
|
||||||
|
plat_local_state_t target = *states;
|
||||||
|
int cpu = plat_my_core_pos(), ret, cluster_powerdn = 1;
|
||||||
|
int core_pos = read_mpidr() & MPIDR_CPU_MASK;
|
||||||
|
mce_cstate_info_t cstate_info = { 0 };
|
||||||
|
|
||||||
|
/* get the current core's power state */
|
||||||
|
target = *(states + core_pos);
|
||||||
|
|
||||||
|
/* CPU suspend */
|
||||||
|
if (lvl == MPIDR_AFFLVL1 && target == PSTATE_ID_CORE_POWERDN) {
|
||||||
|
|
||||||
|
/* Program default wake mask */
|
||||||
|
cstate_info.wake_mask = TEGRA186_CORE_WAKE_MASK;
|
||||||
|
cstate_info.update_wake_mask = 1;
|
||||||
|
mce_update_cstate_info(&cstate_info);
|
||||||
|
|
||||||
|
/* Check if CCx state is allowed. */
|
||||||
|
ret = mce_command_handler(MCE_CMD_IS_CCX_ALLOWED,
|
||||||
|
TEGRA_ARI_CORE_C7, wake_time[cpu], 0);
|
||||||
|
if (ret)
|
||||||
|
return PSTATE_ID_CORE_POWERDN;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* CPU off */
|
||||||
|
if (lvl == MPIDR_AFFLVL1 && target == PLAT_MAX_OFF_STATE) {
|
||||||
|
|
||||||
|
/* find out the number of ON cpus in the cluster */
|
||||||
|
do {
|
||||||
|
target = *states++;
|
||||||
|
if (target != PLAT_MAX_OFF_STATE)
|
||||||
|
cluster_powerdn = 0;
|
||||||
|
} while (--ncpu);
|
||||||
|
|
||||||
|
/* Enable cluster powerdn from last CPU in the cluster */
|
||||||
|
if (cluster_powerdn) {
|
||||||
|
|
||||||
|
/* Enable CC7 state and turn off wake mask */
|
||||||
|
cstate_info.cluster = TEGRA_ARI_CLUSTER_CC7;
|
||||||
|
cstate_info.update_wake_mask = 1;
|
||||||
|
mce_update_cstate_info(&cstate_info);
|
||||||
|
|
||||||
|
/* Check if CCx state is allowed. */
|
||||||
|
ret = mce_command_handler(MCE_CMD_IS_CCX_ALLOWED,
|
||||||
|
TEGRA_ARI_CORE_C7,
|
||||||
|
MCE_CORE_SLEEP_TIME_INFINITE,
|
||||||
|
0);
|
||||||
|
if (ret)
|
||||||
|
return PSTATE_ID_CORE_POWERDN;
|
||||||
|
|
||||||
|
} else {
|
||||||
|
|
||||||
|
/* Turn off wake_mask */
|
||||||
|
cstate_info.update_wake_mask = 1;
|
||||||
|
mce_update_cstate_info(&cstate_info);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* System Suspend */
|
||||||
|
if ((lvl == MPIDR_AFFLVL2) || (target == PSTATE_ID_SOC_POWERDN))
|
||||||
|
return PSTATE_ID_SOC_POWERDN;
|
||||||
|
|
||||||
|
/* default state */
|
||||||
|
return PSCI_LOCAL_STATE_RUN;
|
||||||
|
}
|
||||||
|
|
||||||
int tegra_soc_pwr_domain_power_down_wfi(const psci_power_state_t *target_state)
|
int tegra_soc_pwr_domain_power_down_wfi(const psci_power_state_t *target_state)
|
||||||
{
|
{
|
||||||
const plat_local_state_t *pwr_domain_state =
|
const plat_local_state_t *pwr_domain_state =
|
||||||
|
@ -244,8 +288,7 @@ int tegra_soc_pwr_domain_on_finish(const psci_power_state_t *target_state)
|
||||||
{
|
{
|
||||||
int stateid_afflvl2 = target_state->pwr_domain_state[PLAT_MAX_PWR_LVL];
|
int stateid_afflvl2 = target_state->pwr_domain_state[PLAT_MAX_PWR_LVL];
|
||||||
int stateid_afflvl0 = target_state->pwr_domain_state[MPIDR_AFFLVL0];
|
int stateid_afflvl0 = target_state->pwr_domain_state[MPIDR_AFFLVL0];
|
||||||
cpu_context_t *ctx = cm_get_context(NON_SECURE);
|
mce_cstate_info_t cstate_info = { 0 };
|
||||||
gp_regs_t *gp_regs = get_gpregs_ctx(ctx);
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Reset power state info for CPUs when onlining, we set
|
* Reset power state info for CPUs when onlining, we set
|
||||||
|
@ -256,11 +299,9 @@ int tegra_soc_pwr_domain_on_finish(const psci_power_state_t *target_state)
|
||||||
*/
|
*/
|
||||||
if (stateid_afflvl0 == PLAT_MAX_OFF_STATE) {
|
if (stateid_afflvl0 == PLAT_MAX_OFF_STATE) {
|
||||||
|
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X4, 0);
|
cstate_info.cluster = TEGRA_ARI_CLUSTER_CC1;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X5, 0);
|
cstate_info.update_wake_mask = 1;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X6, 1);
|
mce_update_cstate_info(&cstate_info);
|
||||||
mce_command_handler(MCE_CMD_UPDATE_CSTATE_INFO,
|
|
||||||
TEGRA_ARI_CLUSTER_CC1, 0, 0);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -280,15 +321,15 @@ int tegra_soc_pwr_domain_on_finish(const psci_power_state_t *target_state)
|
||||||
tegra_smmu_init();
|
tegra_smmu_init();
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Reset power state info for the last core doing SC7 entry and exit,
|
* Reset power state info for the last core doing SC7
|
||||||
* we set deepest power state as CC7 and SC7 for SC7 entry which
|
* entry and exit, we set deepest power state as CC7
|
||||||
* may not be requested by non-secure SW which controls idle states.
|
* and SC7 for SC7 entry which may not be requested by
|
||||||
|
* non-secure SW which controls idle states.
|
||||||
*/
|
*/
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X4, 0);
|
cstate_info.cluster = TEGRA_ARI_CLUSTER_CC7;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X5, 0);
|
cstate_info.system = TEGRA_ARI_SYSTEM_SC1;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X6, 1);
|
cstate_info.update_wake_mask = 1;
|
||||||
(void)mce_command_handler(MCE_CMD_UPDATE_CSTATE_INFO,
|
mce_update_cstate_info(&cstate_info);
|
||||||
TEGRA_ARI_CLUSTER_CC7, 0, TEGRA_ARI_SYSTEM_SC1);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return PSCI_E_SUCCESS;
|
return PSCI_E_SUCCESS;
|
||||||
|
@ -296,33 +337,22 @@ int tegra_soc_pwr_domain_on_finish(const psci_power_state_t *target_state)
|
||||||
|
|
||||||
int tegra_soc_pwr_domain_off(const psci_power_state_t *target_state)
|
int tegra_soc_pwr_domain_off(const psci_power_state_t *target_state)
|
||||||
{
|
{
|
||||||
cpu_context_t *ctx = cm_get_context(NON_SECURE);
|
|
||||||
gp_regs_t *gp_regs = get_gpregs_ctx(ctx);
|
|
||||||
int impl = (read_midr() >> MIDR_IMPL_SHIFT) & MIDR_IMPL_MASK;
|
int impl = (read_midr() >> MIDR_IMPL_SHIFT) & MIDR_IMPL_MASK;
|
||||||
|
|
||||||
assert(ctx);
|
|
||||||
assert(gp_regs);
|
|
||||||
|
|
||||||
/* Turn off wake_mask */
|
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X4, 0);
|
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X5, 0);
|
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X6, 1);
|
|
||||||
mce_command_handler(MCE_CMD_UPDATE_CSTATE_INFO, TEGRA_ARI_CLUSTER_CC7,
|
|
||||||
0, 0);
|
|
||||||
|
|
||||||
/* Disable Denver's DCO operations */
|
/* Disable Denver's DCO operations */
|
||||||
if (impl == DENVER_IMPL)
|
if (impl == DENVER_IMPL)
|
||||||
denver_disable_dco();
|
denver_disable_dco();
|
||||||
|
|
||||||
/* Turn off CPU */
|
/* Turn off CPU */
|
||||||
return mce_command_handler(MCE_CMD_ENTER_CSTATE, TEGRA_ARI_CORE_C7,
|
(void)mce_command_handler(MCE_CMD_ENTER_CSTATE, TEGRA_ARI_CORE_C7,
|
||||||
MCE_CORE_SLEEP_TIME_INFINITE, 0);
|
MCE_CORE_SLEEP_TIME_INFINITE, 0);
|
||||||
|
|
||||||
|
return PSCI_E_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
__dead2 void tegra_soc_prepare_system_off(void)
|
__dead2 void tegra_soc_prepare_system_off(void)
|
||||||
{
|
{
|
||||||
cpu_context_t *ctx = cm_get_context(NON_SECURE);
|
mce_cstate_info_t cstate_info = { 0 };
|
||||||
gp_regs_t *gp_regs = get_gpregs_ctx(ctx);
|
|
||||||
uint32_t val;
|
uint32_t val;
|
||||||
|
|
||||||
if (tegra186_system_powerdn_state == TEGRA_ARI_MISC_CCPLEX_SHUTDOWN_POWER_OFF) {
|
if (tegra186_system_powerdn_state == TEGRA_ARI_MISC_CCPLEX_SHUTDOWN_POWER_OFF) {
|
||||||
|
@ -333,11 +363,11 @@ __dead2 void tegra_soc_prepare_system_off(void)
|
||||||
} else if (tegra186_system_powerdn_state == TEGRA_ARI_SYSTEM_SC8) {
|
} else if (tegra186_system_powerdn_state == TEGRA_ARI_SYSTEM_SC8) {
|
||||||
|
|
||||||
/* Prepare for quasi power down */
|
/* Prepare for quasi power down */
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X4, 1);
|
cstate_info.cluster = TEGRA_ARI_CLUSTER_CC7;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X5, 0);
|
cstate_info.system = TEGRA_ARI_SYSTEM_SC8;
|
||||||
write_ctx_reg(gp_regs, CTX_GPREG_X6, 1);
|
cstate_info.system_state_force = 1;
|
||||||
(void)mce_command_handler(MCE_CMD_UPDATE_CSTATE_INFO,
|
cstate_info.update_wake_mask = 1;
|
||||||
TEGRA_ARI_CLUSTER_CC7, 0, TEGRA_ARI_SYSTEM_SC8);
|
mce_update_cstate_info(&cstate_info);
|
||||||
|
|
||||||
/* loop until other CPUs power down */
|
/* loop until other CPUs power down */
|
||||||
do {
|
do {
|
||||||
|
@ -357,6 +387,9 @@ __dead2 void tegra_soc_prepare_system_off(void)
|
||||||
/* power down core */
|
/* power down core */
|
||||||
prepare_cpu_pwr_dwn();
|
prepare_cpu_pwr_dwn();
|
||||||
|
|
||||||
|
/* flush L1/L2 data caches */
|
||||||
|
dcsw_op_all(DCCISW);
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
ERROR("%s: unsupported power down state (%d)\n", __func__,
|
ERROR("%s: unsupported power down state (%d)\n", __func__,
|
||||||
tegra186_system_powerdn_state);
|
tegra186_system_powerdn_state);
|
||||||
|
|
Loading…
Reference in New Issue