ARM: mvebu: make the snoop disabling optional in mvebu_v7_pmsu_idle_prepare()
On some mvebu v7 SoCs (the ones using a Cortex-A9 core and not a PJ4B core), the snoop disabling feature does not exist as the hardware coherency is handled in a different way. Therefore, in preparation to the introduction of the cpuidle support for those SoCs, this commit modifies the mvebu_v7_psmu_idle_prepare() function to take several flags, which allow to decide whether snooping should be disabled, and whether we should use the deep idle mode or not. Signed-off-by: Gregory CLEMENT <gregory.clement@free-electrons.com> Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com> Link: https://lkml.kernel.org/r/1406120453-29291-9-git-send-email-thomas.petazzoni@free-electrons.com Signed-off-by: Jason Cooper <jason@lakedaemon.net>
This commit is contained in:
parent
752a993776
commit
5da964e0fa
@ -191,8 +191,14 @@ static void mvebu_v7_pmsu_enable_l2_powerdown_onidle(void)
|
|||||||
writel(reg, pmsu_mp_base + L2C_NFABRIC_PM_CTL);
|
writel(reg, pmsu_mp_base + L2C_NFABRIC_PM_CTL);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
enum pmsu_idle_prepare_flags {
|
||||||
|
PMSU_PREPARE_NORMAL = 0,
|
||||||
|
PMSU_PREPARE_DEEP_IDLE = BIT(0),
|
||||||
|
PMSU_PREPARE_SNOOP_DISABLE = BIT(1),
|
||||||
|
};
|
||||||
|
|
||||||
/* No locking is needed because we only access per-CPU registers */
|
/* No locking is needed because we only access per-CPU registers */
|
||||||
static int mvebu_v7_pmsu_idle_prepare(bool deepidle)
|
static int mvebu_v7_pmsu_idle_prepare(unsigned long flags)
|
||||||
{
|
{
|
||||||
unsigned int hw_cpu = cpu_logical_map(smp_processor_id());
|
unsigned int hw_cpu = cpu_logical_map(smp_processor_id());
|
||||||
u32 reg;
|
u32 reg;
|
||||||
@ -216,26 +222,32 @@ static int mvebu_v7_pmsu_idle_prepare(bool deepidle)
|
|||||||
|
|
||||||
reg = readl(pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
reg = readl(pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
||||||
/* ask HW to power down the L2 Cache if needed */
|
/* ask HW to power down the L2 Cache if needed */
|
||||||
if (deepidle)
|
if (flags & PMSU_PREPARE_DEEP_IDLE)
|
||||||
reg |= PMSU_CONTROL_AND_CONFIG_L2_PWDDN;
|
reg |= PMSU_CONTROL_AND_CONFIG_L2_PWDDN;
|
||||||
|
|
||||||
/* request power down */
|
/* request power down */
|
||||||
reg |= PMSU_CONTROL_AND_CONFIG_PWDDN_REQ;
|
reg |= PMSU_CONTROL_AND_CONFIG_PWDDN_REQ;
|
||||||
writel(reg, pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
writel(reg, pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
||||||
|
|
||||||
/* Disable snoop disable by HW - SW is taking care of it */
|
if (flags & PMSU_PREPARE_SNOOP_DISABLE) {
|
||||||
reg = readl(pmsu_mp_base + PMSU_CPU_POWER_DOWN_CONTROL(hw_cpu));
|
/* Disable snoop disable by HW - SW is taking care of it */
|
||||||
reg |= PMSU_CPU_POWER_DOWN_DIS_SNP_Q_SKIP;
|
reg = readl(pmsu_mp_base + PMSU_CPU_POWER_DOWN_CONTROL(hw_cpu));
|
||||||
writel(reg, pmsu_mp_base + PMSU_CPU_POWER_DOWN_CONTROL(hw_cpu));
|
reg |= PMSU_CPU_POWER_DOWN_DIS_SNP_Q_SKIP;
|
||||||
|
writel(reg, pmsu_mp_base + PMSU_CPU_POWER_DOWN_CONTROL(hw_cpu));
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int armada_370_xp_pmsu_idle_enter(unsigned long deepidle)
|
int armada_370_xp_pmsu_idle_enter(unsigned long deepidle)
|
||||||
{
|
{
|
||||||
|
unsigned long flags = PMSU_PREPARE_SNOOP_DISABLE;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
ret = mvebu_v7_pmsu_idle_prepare(deepidle);
|
if (deepidle)
|
||||||
|
flags |= PMSU_PREPARE_DEEP_IDLE;
|
||||||
|
|
||||||
|
ret = mvebu_v7_pmsu_idle_prepare(flags);
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user