cpuidle: calxeda: add support to use PSCI calls
This updates the Calxeda cpuidle driver to use PSCI calls to powergate cores. This also enables cpuidle for the ECX-2000. This could possibly become a generic PSCI driver, but there are no other PSCI users in the kernel other than mach-virt. Signed-off-by: Rob Herring <rob.herring@calxeda.com> Cc: "Rafael J. Wysocki" <rjw@sisk.pl> Acked-by: Daniel Lezcano <daniel.lezcano@linaro.org> Cc: linux-pm@vger.kernel.org
This commit is contained in:
@@ -23,44 +23,18 @@
|
||||
#include <linux/cpuidle.h>
|
||||
#include <linux/cpu_pm.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/time.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/suspend.h>
|
||||
#include <linux/mm.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <asm/cpuidle.h>
|
||||
#include <asm/proc-fns.h>
|
||||
#include <asm/smp_scu.h>
|
||||
#include <asm/suspend.h>
|
||||
#include <asm/cacheflush.h>
|
||||
#include <asm/cp15.h>
|
||||
|
||||
extern void highbank_set_cpu_jump(int cpu, void *jump_addr);
|
||||
extern void __iomem *scu_base_addr;
|
||||
|
||||
static noinline void calxeda_idle_restore(void)
|
||||
{
|
||||
set_cr(get_cr() | CR_C);
|
||||
set_auxcr(get_auxcr() | 0x40);
|
||||
scu_power_mode(scu_base_addr, SCU_PM_NORMAL);
|
||||
}
|
||||
#include <asm/psci.h>
|
||||
|
||||
static int calxeda_idle_finish(unsigned long val)
|
||||
{
|
||||
/* Already flushed cache, but do it again as the outer cache functions
|
||||
* dirty the cache with spinlocks */
|
||||
flush_cache_all();
|
||||
|
||||
set_auxcr(get_auxcr() & ~0x40);
|
||||
set_cr(get_cr() & ~CR_C);
|
||||
|
||||
scu_power_mode(scu_base_addr, SCU_PM_DORMANT);
|
||||
|
||||
cpu_do_idle();
|
||||
|
||||
/* Restore things if we didn't enter power-gating */
|
||||
calxeda_idle_restore();
|
||||
return 1;
|
||||
const struct psci_power_state ps = {
|
||||
.type = PSCI_POWER_STATE_TYPE_POWER_DOWN,
|
||||
};
|
||||
return psci_ops.cpu_suspend(ps, __pa(cpu_resume));
|
||||
}
|
||||
|
||||
static int calxeda_pwrdown_idle(struct cpuidle_device *dev,
|
||||
@@ -68,7 +42,6 @@ static int calxeda_pwrdown_idle(struct cpuidle_device *dev,
|
||||
int index)
|
||||
{
|
||||
cpu_pm_enter();
|
||||
highbank_set_cpu_jump(smp_processor_id(), cpu_resume);
|
||||
cpu_suspend(0, calxeda_idle_finish);
|
||||
cpu_pm_exit();
|
||||
|
||||
|
Referens i nytt ärende
Block a user