dc38e2ad53
Related to d3930614e6.
RCSR is only present on PXA2xx CPUs, not on PXA3xx CPUs. Therefore,
we should not be unconditionally writing to RCSR from generic code.
Since we now clear the RCSR status from the SoC specific PXA PM code
and before reset in the arch_reset() function, the duplication in
the corgi, poodle, spitz and tosa code can be removed.
Acked-by: Richard Purdie <rpurdie@rpsys.net>
Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
112 lines
2.5 KiB
C
112 lines
2.5 KiB
C
/*
|
|
* PXA250/210 Power Management Routines
|
|
*
|
|
* Original code for the SA11x0:
|
|
* Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
|
|
*
|
|
* Modified for the PXA250 by Nicolas Pitre:
|
|
* Copyright (c) 2002 Monta Vista Software, Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License.
|
|
*/
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/suspend.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/time.h>
|
|
|
|
#include <asm/hardware.h>
|
|
#include <asm/memory.h>
|
|
#include <asm/system.h>
|
|
#include <asm/arch/pm.h>
|
|
#include <asm/arch/pxa-regs.h>
|
|
#include <asm/arch/lubbock.h>
|
|
#include <asm/mach/time.h>
|
|
|
|
struct pxa_cpu_pm_fns *pxa_cpu_pm_fns;
|
|
static unsigned long *sleep_save;
|
|
|
|
int pxa_pm_enter(suspend_state_t state)
|
|
{
|
|
unsigned long sleep_save_checksum = 0, checksum = 0;
|
|
int i;
|
|
|
|
#ifdef CONFIG_IWMMXT
|
|
/* force any iWMMXt context to ram **/
|
|
if (elf_hwcap & HWCAP_IWMMXT)
|
|
iwmmxt_task_disable(NULL);
|
|
#endif
|
|
|
|
/* skip registers saving for standby */
|
|
if (state != PM_SUSPEND_STANDBY) {
|
|
pxa_cpu_pm_fns->save(sleep_save);
|
|
/* before sleeping, calculate and save a checksum */
|
|
for (i = 0; i < pxa_cpu_pm_fns->save_count - 1; i++)
|
|
sleep_save_checksum += sleep_save[i];
|
|
}
|
|
|
|
/* *** go zzz *** */
|
|
pxa_cpu_pm_fns->enter(state);
|
|
cpu_init();
|
|
|
|
if (state != PM_SUSPEND_STANDBY) {
|
|
/* after sleeping, validate the checksum */
|
|
for (i = 0; i < pxa_cpu_pm_fns->save_count - 1; i++)
|
|
checksum += sleep_save[i];
|
|
|
|
/* if invalid, display message and wait for a hardware reset */
|
|
if (checksum != sleep_save_checksum) {
|
|
#ifdef CONFIG_ARCH_LUBBOCK
|
|
LUB_HEXLED = 0xbadbadc5;
|
|
#endif
|
|
while (1)
|
|
pxa_cpu_pm_fns->enter(state);
|
|
}
|
|
pxa_cpu_pm_fns->restore(sleep_save);
|
|
}
|
|
|
|
pr_debug("*** made it back from resume\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(pxa_pm_enter);
|
|
|
|
unsigned long sleep_phys_sp(void *sp)
|
|
{
|
|
return virt_to_phys(sp);
|
|
}
|
|
|
|
static int pxa_pm_valid(suspend_state_t state)
|
|
{
|
|
if (pxa_cpu_pm_fns)
|
|
return pxa_cpu_pm_fns->valid(state);
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static struct platform_suspend_ops pxa_pm_ops = {
|
|
.valid = pxa_pm_valid,
|
|
.enter = pxa_pm_enter,
|
|
};
|
|
|
|
static int __init pxa_pm_init(void)
|
|
{
|
|
if (!pxa_cpu_pm_fns) {
|
|
printk(KERN_ERR "no valid pxa_cpu_pm_fns defined\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
sleep_save = kmalloc(pxa_cpu_pm_fns->save_count * sizeof(unsigned long),
|
|
GFP_KERNEL);
|
|
if (!sleep_save) {
|
|
printk(KERN_ERR "failed to alloc memory for pm save\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
suspend_set_ops(&pxa_pm_ops);
|
|
return 0;
|
|
}
|
|
|
|
device_initcall(pxa_pm_init);
|