2 files changed, 234 insertions, 1 deletions

diff --git a/arch/arm/mach-pxa/Makefile b/arch/arm/mach-pxa/Makefile
index eecc5c199678..c83092e298a7 100644
--- a/arch/arm/mach-pxa/Makefile
+++ b/arch/arm/mach-pxa/Makefile
@@ -12,7 +12,7 @@ obj-$(CONFIG_ARCH_LUBBOCK) += lubbock.o
 obj-$(CONFIG_MACH_MAINSTONE) += mainstone.o
 obj-$(CONFIG_ARCH_PXA_IDP) += idp.o
 obj-$(CONFIG_PXA_SHARP_C7xx)    += corgi.o corgi_ssp.o corgi_lcd.o sharpsl_pm.o corgi_pm.o
-obj-$(CONFIG_PXA_SHARP_Cxx00)   += spitz.o corgi_ssp.o corgi_lcd.o
+obj-$(CONFIG_PXA_SHARP_Cxx00)   += spitz.o corgi_ssp.o corgi_lcd.o sharpsl_pm.o spitz_pm.o
 obj-$(CONFIG_MACH_POODLE)       += poodle.o
 obj-$(CONFIG_MACH_TOSA)         += tosa.o
 
diff --git a/arch/arm/mach-pxa/spitz_pm.c b/arch/arm/mach-pxa/spitz_pm.c
new file mode 100644
index 000000000000..3ce7486daa51
--- /dev/null
+++ b/arch/arm/mach-pxa/spitz_pm.c
@@ -0,0 +1,233 @@
+/*
+ * Battery and Power Management code for the Sharp SL-Cxx00
+ *
+ * Copyright (c) 2005 Richard Purdie
+ *
+ * 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/module.h>
+#include <linux/stat.h>
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/platform_device.h>
+#include <asm/apm.h>
+#include <asm/irq.h>
+#include <asm/mach-types.h>
+#include <asm/hardware.h>
+#include <asm/hardware/scoop.h>
+
+#include <asm/arch/sharpsl.h>
+#include <asm/arch/spitz.h>
+#include <asm/arch/pxa-regs.h>
+#include "sharpsl.h"
+
+static int spitz_last_ac_status;
+
+static void spitz_charger_init(void)
+{
+        pxa_gpio_mode(SPITZ_GPIO_KEY_INT | GPIO_IN);
+        pxa_gpio_mode(SPITZ_GPIO_SYNC | GPIO_IN);
+}
+
+static void spitz_charge_led(int val)
+{
+        if (val == SHARPSL_LED_ERROR) {
+                dev_dbg(sharpsl_pm.dev, "Charge LED Error\n");
+        } else if (val == SHARPSL_LED_ON) {
+                dev_dbg(sharpsl_pm.dev, "Charge LED On\n");
+                set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_ORANGE);
+        } else {
+                dev_dbg(sharpsl_pm.dev, "Charge LED Off\n");
+                reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_ORANGE);
+        }
+}
+
+static void spitz_measure_temp(int on)
+{
+        if (on)
+                set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_ADC_TEMP_ON);
+        else
+                reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_ADC_TEMP_ON);
+}
+
+static void spitz_charge(int on)
+{
+        if (on) {
+                if (sharpsl_pm.flags & SHARPSL_SUSPENDED) {
+                        set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_JK_B);
+                        reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_CHRG_ON);
+                } else {
+                        reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_JK_B);
+                        reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_CHRG_ON);
+                }
+        } else {
+                reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_JK_B);
+                set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_CHRG_ON);
+        }
+}
+
+static void spitz_discharge(int on)
+{
+        if (on)
+                set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_JK_A);
+        else
+                reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_JK_A);
+}
+
+/* HACK - For unknown reasons, accurate voltage readings are only made with a load
+   on the power bus which the green led on spitz provides */
+static void spitz_discharge1(int on)
+{
+        if (on)
+                set_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_GREEN);
+        else
+                reset_scoop_gpio(&spitzscoop_device.dev, SPITZ_SCP_LED_GREEN);
+}
+
+static void spitz_presuspend(void)
+{
+        spitz_last_ac_status = STATUS_AC_IN();
+
+        /* GPIO Sleep Register */
+        PGSR0 = 0x00144018;
+        PGSR1 = 0x00EF0000;
+        if (machine_is_akita()) {
+                PGSR2 = 0x2121C000;
+                PGSR3 = 0x00600400;
+        } else {
+                PGSR2 = 0x0121C000;
+                PGSR3 = 0x00600000;
+        }
+
+        PGSR0 &= ~SPITZ_GPIO_G0_STROBE_BIT;
+        PGSR1 &= ~SPITZ_GPIO_G1_STROBE_BIT;
+        PGSR2 &= ~SPITZ_GPIO_G2_STROBE_BIT;
+        PGSR3 &= ~SPITZ_GPIO_G3_STROBE_BIT;
+        PGSR2 |= GPIO_bit(SPITZ_GPIO_KEY_STROBE0);
+
+        pxa_gpio_mode(GPIO18_RDY|GPIO_OUT | GPIO_DFLT_HIGH);
+
+        PRER = GPIO_bit(SPITZ_GPIO_KEY_INT);
+        PFER = GPIO_bit(SPITZ_GPIO_KEY_INT) | GPIO_bit(SPITZ_GPIO_RESET);
+        PWER = GPIO_bit(SPITZ_GPIO_KEY_INT) | GPIO_bit(SPITZ_GPIO_RESET) | PWER_RTC;
+        PKWR = GPIO_bit(SPITZ_GPIO_SYNC) | GPIO_bit(SPITZ_GPIO_KEY_INT) | GPIO_bit(SPITZ_GPIO_RESET);
+        PKSR = 0xffffffff; // clear
+
+        /* nRESET_OUT Disable */
+        PSLR |= PSLR_SL_ROD;
+
+        /* Clear reset status */
+        RCSR = RCSR_HWR | RCSR_WDR | RCSR_SMR | RCSR_GPR;
+
+        /* Stop 3.6MHz and drive HIGH to PCMCIA and CS */
+        PCFR = PCFR_GPR_EN | PCFR_OPDE;
+}
+
+static void spitz_postsuspend(void)
+{
+        pxa_gpio_mode(GPIO18_RDY_MD);
+        pxa_gpio_mode(10 | GPIO_IN);
+}
+
+static int spitz_should_wakeup(unsigned int resume_on_alarm)
+{
+        int is_resume = 0;
+        int acin = STATUS_AC_IN();
+
+        if (spitz_last_ac_status != acin) {
+                if (acin) {
+                        /* charge on */
+                        sharpsl_pm.flags |= SHARPSL_DO_OFFLINE_CHRG;
+                        dev_dbg(sharpsl_pm.dev, "AC Inserted\n");
+                } else {
+                        /* charge off */
+                        dev_dbg(sharpsl_pm.dev, "AC Removed\n");
+                        CHARGE_LED_OFF();
+                        CHARGE_OFF();
+                        sharpsl_pm.charge_mode = CHRG_OFF;
+                }
+                spitz_last_ac_status = acin;
+                /* Return to suspend as this must be what we were woken for */
+                return 0;
+        }
+
+        if (PEDR & GPIO_bit(SPITZ_GPIO_KEY_INT))
+                is_resume |= GPIO_bit(SPITZ_GPIO_KEY_INT);
+
+        if (PKSR & GPIO_bit(SPITZ_GPIO_SYNC))
+                is_resume |= GPIO_bit(SPITZ_GPIO_SYNC);
+
+        if (resume_on_alarm && (PEDR & PWER_RTC))
+                is_resume |= PWER_RTC;
+
+        dev_dbg(sharpsl_pm.dev, "is_resume: %x\n",is_resume);
+        return is_resume;
+}
+
+static unsigned long spitz_charger_wakeup(void)
+{
+        return (~GPLR0 & GPIO_bit(SPITZ_GPIO_KEY_INT)) | (GPLR0 & GPIO_bit(SPITZ_GPIO_SYNC));
+}
+
+static int spitz_acin_status(void)
+{
+        return (((~GPLR(SPITZ_GPIO_AC_IN)) & GPIO_bit(SPITZ_GPIO_AC_IN)) != 0);
+}
+
+struct sharpsl_charger_machinfo spitz_pm_machinfo = {
+        .init             = spitz_charger_init,
+        .gpio_batlock     = SPITZ_GPIO_BAT_COVER,
+        .gpio_acin        = SPITZ_GPIO_AC_IN,
+        .gpio_batfull     = SPITZ_GPIO_CHRG_FULL,
+        .gpio_fatal       = SPITZ_GPIO_FATAL_BAT,
+        .status_acin      = spitz_acin_status,
+        .discharge        = spitz_discharge,
+        .discharge1       = spitz_discharge1,
+        .charge           = spitz_charge,
+        .chargeled        = spitz_charge_led,
+        .measure_temp     = spitz_measure_temp,
+        .presuspend       = spitz_presuspend,
+        .postsuspend      = spitz_postsuspend,
+        .charger_wakeup   = spitz_charger_wakeup,
+        .should_wakeup    = spitz_should_wakeup,
+        .bat_levels       = 40,
+        .bat_levels_noac  = spitz_battery_levels_noac,
+        .bat_levels_acin  = spitz_battery_levels_acin,
+        .status_high_acin = 188,
+        .status_low_acin  = 178,
+        .status_high_noac = 185,
+        .status_low_noac  = 175,
+};
+
+static struct platform_device *spitzpm_device;
+
+static int __devinit spitzpm_init(void)
+{
+        int ret;
+
+        spitzpm_device = platform_device_alloc("sharpsl-pm", -1);
+        if (!spitzpm_device)
+                return -ENOMEM;
+
+        spitzpm_device->dev.platform_data = &spitz_pm_machinfo;
+        ret = platform_device_add(spitzpm_device);
+
+        if (ret)
+                platform_device_put(spitzpm_device);
+
+        return ret;
+}
+
+static void spitzpm_exit(void)
+{
+        platform_device_unregister(spitzpm_device);
+}
+
+module_init(spitzpm_init);
+module_exit(spitzpm_exit);