This patch adds suspend (standby, not suspend-to-ram) support for MPC86xx
processors.
In standby mode MPC86xx is able to wakeup only upon external interrupts
(including sreset).
Signed-off-by: Scott Wood <[EMAIL PROTECTED]>
Signed-off-by: Jason Jin <[EMAIL PROTECTED]>
Signed-off-by: Anton Vorontsov <[EMAIL PROTECTED]>
---
arch/powerpc/Kconfig | 2 +-
arch/powerpc/platforms/86xx/Makefile | 1 +
arch/powerpc/platforms/86xx/mpc86xx_suspend.c | 92 +++++++++++++++++++++++++
3 files changed, 94 insertions(+), 1 deletions(-)
create mode 100644 arch/powerpc/platforms/86xx/mpc86xx_suspend.c
diff --git a/arch/powerpc/Kconfig b/arch/powerpc/Kconfig
index 2cde4e3..c45c71e 100644
--- a/arch/powerpc/Kconfig
+++ b/arch/powerpc/Kconfig
@@ -192,7 +192,7 @@ config ARCH_HIBERNATION_POSSIBLE
config ARCH_SUSPEND_POSSIBLE
def_bool y
- depends on ADB_PMU || PPC_EFIKA || PPC_LITE5200
+ depends on ADB_PMU || PPC_EFIKA || PPC_LITE5200 || PPC_86xx
config PPC_DCR_NATIVE
bool
diff --git a/arch/powerpc/platforms/86xx/Makefile
b/arch/powerpc/platforms/86xx/Makefile
index 1b9b4a9..a8557df 100644
--- a/arch/powerpc/platforms/86xx/Makefile
+++ b/arch/powerpc/platforms/86xx/Makefile
@@ -3,6 +3,7 @@
#
obj-$(CONFIG_SMP) += mpc86xx_smp.o
+obj-$(CONFIG_SUSPEND) += mpc86xx_suspend.o
obj-$(CONFIG_MPC8641_HPCN) += mpc86xx_hpcn.o
obj-$(CONFIG_SBC8641D) += sbc8641d.o
obj-$(CONFIG_MPC8610_HPCD) += mpc8610_hpcd.o
diff --git a/arch/powerpc/platforms/86xx/mpc86xx_suspend.c
b/arch/powerpc/platforms/86xx/mpc86xx_suspend.c
new file mode 100644
index 0000000..ce13e4c
--- /dev/null
+++ b/arch/powerpc/platforms/86xx/mpc86xx_suspend.c
@@ -0,0 +1,92 @@
+/*
+ * MPC86xx suspend (standby) support
+ *
+ * Copyright (C) 2008 Freescale Semiconductor, Inc. All rights reserved.
+ *
+ * Author: Jason Jin <[EMAIL PROTECTED]>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published
+ * by the Free Software Foundation.
+ */
+
+#include <linux/init.h>
+#include <linux/types.h>
+#include <linux/suspend.h>
+#include <linux/of.h>
+#include <linux/io.h>
+#include <asm/prom.h>
+#include <asm/reg.h>
+#include <asm/mpc6xx.h>
+
+#define PMCSR_DEVSLEEP 0x00020000
+
+struct mpc86xx_pmc {
+ __be32 devdisr;
+ __be32 devdisr2;
+ __be32 reserve1;
+ __be32 reserve2;
+ __be32 powmgtcsr;
+};
+
+static struct mpc86xx_pmc __iomem *pmc_regs_86xx;
+
+static int mpc86xx_suspend_enter(suspend_state_t state)
+{
+ u32 tmp;
+
+ /* Disable power management. */
+ tmp = mfmsr();
+ mtmsr(tmp & ~MSR_POW);
+
+ /* Enable sleep mode, disable others. */
+ tmp = mfspr(SPRN_HID0);
+ mtspr(SPRN_HID0, (tmp & ~(HID0_DOZE | HID0_NAP)) | HID0_SLEEP);
+ asm("sync");
+
+ /* Device power down. */
+ setbits32(&pmc_regs_86xx->powmgtcsr, PMCSR_DEVSLEEP);
+
+ /* 86xx did not support deep sleep, let it enter standby mode. */
+ mpc6xx_enter_standby();
+
+ clrbits32(&pmc_regs_86xx->powmgtcsr, PMCSR_DEVSLEEP);
+
+ return 0;
+}
+
+static int mpc86xx_suspend_valid(suspend_state_t state)
+{
+ if (state == PM_SUSPEND_STANDBY)
+ return 1;
+ return 0;
+}
+
+static struct platform_suspend_ops mpc86xx_suspend_ops = {
+ .valid = mpc86xx_suspend_valid,
+ .enter = mpc86xx_suspend_enter,
+};
+
+static int __init mpc86xx_pmc_init(void)
+{
+ void __iomem *guts;
+ struct device_node *np;
+
+ np = of_find_compatible_node(NULL, NULL, "fsl,mpc8610-guts");
+ if (!np) {
+ np = of_find_compatible_node(NULL, NULL, "fsl,mpc8641-guts");
+ if (!np)
+ return -ENODEV;
+ }
+
+ guts = of_iomap(np, 0);
+ of_node_put(np);
+ if (!guts)
+ return -ENOMEM;
+
+ pmc_regs_86xx = guts + 0x70;
+
+ suspend_set_ops(&mpc86xx_suspend_ops);
+ return 0;
+}
+module_init(mpc86xx_pmc_init);
--
1.5.5.1
_______________________________________________
Linuxppc-dev mailing list
Linuxppc-dev@ozlabs.org
https://ozlabs.org/mailman/listinfo/linuxppc-dev
