Implement suspend/resume for "mpc10x" compatible fsl host PCI controllers, use it for linkstation standby. Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@xxxxxx> --- This requires patches from Scott Wood from this thread: http://ozlabs.org/pipermail/linuxppc-dev/2007-July/039109.html and my recent patch to implement wakeup from serial ports. Thanks Guennadi arch/powerpc/platforms/embedded6xx/linkstation.c | 57 +++++++++++++++++++++++ arch/powerpc/sysdev/fsl_soc.c | 44 +++++++++++++++++ arch/powerpc/sysdev/fsl_soc.h | 6 ++ include/asm-powerpc/mpc6xx.h | 2 4 files changed, 108 insertions(+), 1 deletion(-) diff --git a/arch/powerpc/platforms/embedded6xx/linkstation.c b/arch/powerpc/platforms/embedded6xx/linkstation.c index ab9e3f9..8ee0f0b 100644 --- a/arch/powerpc/platforms/embedded6xx/linkstation.c +++ b/arch/powerpc/platforms/embedded6xx/linkstation.c @@ -197,3 +197,60 @@ define_machine(linkstation){ .halt = linkstation_halt, .calibrate_decr = generic_calibrate_decr, }; + +#ifdef CONFIG_PM + +#include <sysdev/fsl_soc.h> +#include <asm/mpc6xx.h> + +static int ls_pm_valid(suspend_state_t state) +{ + switch (state) { + case PM_SUSPEND_STANDBY: + return 1; + default: + return 0; + } +} + +static int ls_pm_enter(suspend_state_t state) +{ + char ier; + int ret = 0; + u64 tb; + + if ((ret = mpc10x_suspend(state)) < 0) + return ret; + + /* Get timebase */ + tb = get_tb(); + + /* put CPU to sleep, re-enabling interrupts */ + mpc6xx_enter_sleep(); + + local_irq_disable(); + + set_tb(tb >> 32, tb & 0xfffffffful); + +fail: + mpc10x_resume(state); + + return ret; +} + +static struct pm_ops ls_pm_ops = { + .valid = ls_pm_valid, + .enter = ls_pm_enter, +}; + +static int __init ls_pm_init(void) +{ + if (!machine_is(linkstation)) + return 0; + + pm_set_ops(&ls_pm_ops); + return 0; +} + +device_initcall(ls_pm_init); +#endif diff --git a/arch/powerpc/sysdev/fsl_soc.c b/arch/powerpc/sysdev/fsl_soc.c index 727453d..c0d66df 100644 --- a/arch/powerpc/sysdev/fsl_soc.c +++ b/arch/powerpc/sysdev/fsl_soc.c @@ -1186,3 +1186,47 @@ err: arch_initcall(cpm_smc_uart_of_init); #endif /* CONFIG_8xx */ + +#ifdef CONFIG_PM +#include <linux/pci.h> +#include <asm/pci-bridge.h> + +#define MPC10X_LP_REF_EN (1<<12) +#define MPC10X_PM (1<<7) +#define MPC10X_DOZE (1<<5) +#define MPC10X_NAP (1<<4) +#define MPC10X_SLEEP (1<<3) + +int mpc10x_suspend(suspend_state_t state) +{ + struct pci_dev *bridge; + u16 pmcr1; + + bridge = pci_find_slot(0, 0); + if (!bridge) + return -ENODEV; + + pci_read_config_word(bridge, 0x70, &pmcr1); + pmcr1 &= ~(MPC10X_DOZE | MPC10X_NAP); + pmcr1 |= MPC10X_PM | MPC10X_SLEEP | MPC10X_LP_REF_EN; + pci_write_config_word(bridge, 0x70, pmcr1); + + return 0; +} + +int mpc10x_resume(suspend_state_t state) +{ + struct pci_dev *bridge; + u16 pmcr1; + + bridge = pci_find_slot(0, 0); + if (!bridge) + return -ENODEV; + + pci_read_config_word(bridge, 0x70, &pmcr1); + pmcr1 &= ~(MPC10X_PM | MPC10X_DOZE | MPC10X_SLEEP | MPC10X_NAP | MPC10X_LP_REF_EN); + pci_write_config_word(bridge, 0x70, pmcr1); + + return 0; +} +#endif diff --git a/arch/powerpc/sysdev/fsl_soc.h b/arch/powerpc/sysdev/fsl_soc.h index 04e145b..bcb96cf 100644 --- a/arch/powerpc/sysdev/fsl_soc.h +++ b/arch/powerpc/sysdev/fsl_soc.h @@ -8,5 +8,11 @@ extern phys_addr_t get_immrbase(void); extern u32 get_brgfreq(void); extern u32 get_baudrate(void); +#ifdef CONFIG_PM +#include <linux/pm.h> +extern int mpc10x_suspend(suspend_state_t state); +extern int mpc10x_resume(suspend_state_t state); +#endif + #endif #endif diff --git a/include/asm-powerpc/mpc6xx.h b/include/asm-powerpc/mpc6xx.h index 01a33ed..be86967 100644 --- a/include/asm-powerpc/mpc6xx.h +++ b/include/asm-powerpc/mpc6xx.h @@ -1,6 +1,6 @@ #ifndef __ASM_POWERPC_MPC6xx_H #define __ASM_POWERPC_MPC6xx_H -void mpc6xx_enter_sleep(void); +extern void mpc6xx_enter_sleep(void); #endif _______________________________________________ linux-pm mailing list linux-pm@xxxxxxxxxxxxxxxxxxxxxxxxxx https://lists.linux-foundation.org/mailman/listinfo/linux-pm
