![Johannes Berg](/assets/img/avatar_default.png)
Almost all users of pm_ops only support mem sleep, don't check in .valid and don't reject any others in .prepare so users can be confused if they check /sys/power/state, especially when new states are added (these would then result in s-t-r although they're supposed to be something different). This patch implements a generic pm_valid_only_mem function that is then exported for users and puts it to use in almost all existing pm_ops. Signed-off-by: Johannes Berg <johannes@sipsolutions.net> Cc: David Brownell <david-b@pacbell.net> Acked-by: Pavel Machek <pavel@ucw.cz> Cc: linux-pm@lists.linux-foundation.org Cc: Len Brown <lenb@kernel.org> Acked-by: Russell King <rmk@arm.linux.org.uk> Cc: Greg KH <greg@kroah.com> Cc: "Rafael J. Wysocki" <rjw@sisk.pl> Cc: Paul Mundt <lethal@linux-sh.org> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
154 lines
3.6 KiB
C
154 lines
3.6 KiB
C
/*
|
|
* arch/arm/mach-pnx4008/pm.c
|
|
*
|
|
* Power Management driver for PNX4008
|
|
*
|
|
* Authors: Vitaly Wool, Dmitry Chigirev <source@mvista.com>
|
|
*
|
|
* 2005 (c) MontaVista Software, Inc. This file is licensed under
|
|
* the terms of the GNU General Public License version 2. This program
|
|
* is licensed "as is" without any warranty of any kind, whether express
|
|
* or implied.
|
|
*/
|
|
|
|
#include <linux/pm.h>
|
|
#include <linux/rtc.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/clk.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/mach-types.h>
|
|
#include <asm/cacheflush.h>
|
|
#include <asm/arch/pm.h>
|
|
#include <asm/arch/clock.h>
|
|
|
|
#define SRAM_VA IO_ADDRESS(PNX4008_IRAM_BASE)
|
|
|
|
static void *saved_sram;
|
|
|
|
static struct clk *pll4_clk;
|
|
|
|
static inline void pnx4008_standby(void)
|
|
{
|
|
void (*pnx4008_cpu_standby_ptr) (void);
|
|
|
|
local_irq_disable();
|
|
local_fiq_disable();
|
|
|
|
clk_disable(pll4_clk);
|
|
|
|
/*saving portion of SRAM to be used by suspend function. */
|
|
memcpy(saved_sram, (void *)SRAM_VA, pnx4008_cpu_standby_sz);
|
|
|
|
/*make sure SRAM copy gets physically written into SDRAM.
|
|
SDRAM will be placed into self-refresh during power down */
|
|
flush_cache_all();
|
|
|
|
/*copy suspend function into SRAM */
|
|
memcpy((void *)SRAM_VA, pnx4008_cpu_standby, pnx4008_cpu_standby_sz);
|
|
|
|
/*do suspend */
|
|
pnx4008_cpu_standby_ptr = (void *)SRAM_VA;
|
|
pnx4008_cpu_standby_ptr();
|
|
|
|
/*restoring portion of SRAM that was used by suspend function */
|
|
memcpy((void *)SRAM_VA, saved_sram, pnx4008_cpu_standby_sz);
|
|
|
|
clk_enable(pll4_clk);
|
|
|
|
local_fiq_enable();
|
|
local_irq_enable();
|
|
}
|
|
|
|
static inline void pnx4008_suspend(void)
|
|
{
|
|
void (*pnx4008_cpu_suspend_ptr) (void);
|
|
|
|
local_irq_disable();
|
|
local_fiq_disable();
|
|
|
|
clk_disable(pll4_clk);
|
|
|
|
__raw_writel(0xffffffff, START_INT_RSR_REG(SE_PIN_BASE_INT));
|
|
__raw_writel(0xffffffff, START_INT_RSR_REG(SE_INT_BASE_INT));
|
|
|
|
/*saving portion of SRAM to be used by suspend function. */
|
|
memcpy(saved_sram, (void *)SRAM_VA, pnx4008_cpu_suspend_sz);
|
|
|
|
/*make sure SRAM copy gets physically written into SDRAM.
|
|
SDRAM will be placed into self-refresh during power down */
|
|
flush_cache_all();
|
|
|
|
/*copy suspend function into SRAM */
|
|
memcpy((void *)SRAM_VA, pnx4008_cpu_suspend, pnx4008_cpu_suspend_sz);
|
|
|
|
/*do suspend */
|
|
pnx4008_cpu_suspend_ptr = (void *)SRAM_VA;
|
|
pnx4008_cpu_suspend_ptr();
|
|
|
|
/*restoring portion of SRAM that was used by suspend function */
|
|
memcpy((void *)SRAM_VA, saved_sram, pnx4008_cpu_suspend_sz);
|
|
|
|
clk_enable(pll4_clk);
|
|
|
|
local_fiq_enable();
|
|
local_irq_enable();
|
|
}
|
|
|
|
static int pnx4008_pm_enter(suspend_state_t state)
|
|
{
|
|
switch (state) {
|
|
case PM_SUSPEND_STANDBY:
|
|
pnx4008_standby();
|
|
break;
|
|
case PM_SUSPEND_MEM:
|
|
pnx4008_suspend();
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int pnx4008_pm_valid(suspend_state_t state)
|
|
{
|
|
return (state == PM_SUSPEND_STANDBY) ||
|
|
(state == PM_SUSPEND_MEM);
|
|
}
|
|
|
|
static struct pm_ops pnx4008_pm_ops = {
|
|
.enter = pnx4008_pm_enter,
|
|
.valid = pnx4008_pm_valid,
|
|
};
|
|
|
|
static int __init pnx4008_pm_init(void)
|
|
{
|
|
u32 sram_size_to_allocate;
|
|
|
|
pll4_clk = clk_get(0, "ck_pll4");
|
|
if (IS_ERR(pll4_clk)) {
|
|
printk(KERN_ERR
|
|
"PM Suspend cannot acquire ARM(PLL4) clock control\n");
|
|
return PTR_ERR(pll4_clk);
|
|
}
|
|
|
|
if (pnx4008_cpu_standby_sz > pnx4008_cpu_suspend_sz)
|
|
sram_size_to_allocate = pnx4008_cpu_standby_sz;
|
|
else
|
|
sram_size_to_allocate = pnx4008_cpu_suspend_sz;
|
|
|
|
saved_sram = kmalloc(sram_size_to_allocate, GFP_ATOMIC);
|
|
if (!saved_sram) {
|
|
printk(KERN_ERR
|
|
"PM Suspend: cannot allocate memory to save portion of SRAM\n");
|
|
clk_put(pll4_clk);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
pm_set_ops(&pnx4008_pm_ops);
|
|
return 0;
|
|
}
|
|
|
|
late_initcall(pnx4008_pm_init);
|