1 files changed, 113 insertions, 12 deletions

diff --git a/arch/arm/common/locomo.c b/arch/arm/common/locomo.c
index 41f12658c8b4..2786f7c34b3f 100644
--- a/arch/arm/common/locomo.c
+++ b/arch/arm/common/locomo.c
@@ -177,7 +177,7 @@ static void locomo_handler(unsigned int irq, struct irqdesc *desc,
                 d = irq_desc + irq;
                 for (i = 0; i <= 3; i++, d++, irq++) {
                         if (req & (0x0100 << i)) {
-                                d->handle(irq, d, regs);
+                                desc_handle_irq(irq, d, regs);
                         }
 
                 }
@@ -220,7 +220,7 @@ static void locomo_key_handler(unsigned int irq, struct irqdesc *desc,
 
         if (locomo_readl(mapbase + LOCOMO_KEYBOARD + LOCOMO_KIC) & 0x0001) {
                 d = irq_desc + LOCOMO_IRQ_KEY_START;
-                d->handle(LOCOMO_IRQ_KEY_START, d, regs);
+                desc_handle_irq(LOCOMO_IRQ_KEY_START, d, regs);
         }
 }
 
@@ -273,7 +273,7 @@ static void locomo_gpio_handler(unsigned int irq, struct irqdesc *desc,
                 d = irq_desc + LOCOMO_IRQ_GPIO_START;
                 for (i = 0; i <= 15; i++, irq++, d++) {
                         if (req & (0x0001 << i)) {
-                                d->handle(irq, d, regs);
+                                desc_handle_irq(irq, d, regs);
                         }
                 }
         }
@@ -328,7 +328,7 @@ static void locomo_lt_handler(unsigned int irq, struct irqdesc *desc,
 
         if (locomo_readl(mapbase + LOCOMO_LTINT) & 0x0001) {
                 d = irq_desc + LOCOMO_IRQ_LT_START;
-                d->handle(LOCOMO_IRQ_LT_START, d, regs);
+                desc_handle_irq(LOCOMO_IRQ_LT_START, d, regs);
         }
 }
 
@@ -379,7 +379,7 @@ static void locomo_spi_handler(unsigned int irq, struct irqdesc *desc,
 
                 for (i = 0; i <= 3; i++, irq++, d++) {
                         if (req & (0x0001 << i)) {
-                                d->handle(irq, d, regs);
+                                desc_handle_irq(irq, d, regs);
                         }
                 }
         }
@@ -541,6 +541,103 @@ locomo_init_one_child(struct locomo *lchip, struct locomo_dev_info *info)
         return ret;
 }
 
+#ifdef CONFIG_PM
+
+struct locomo_save_data {
+        u16     LCM_GPO;
+        u16     LCM_SPICT;
+        u16     LCM_GPE;
+        u16     LCM_ASD;
+        u16     LCM_SPIMD;
+};
+
+static int locomo_suspend(struct device *dev, u32 pm_message_t, u32 level)
+{
+        struct locomo *lchip = dev_get_drvdata(dev);
+        struct locomo_save_data *save;
+        unsigned long flags;
+
+        if (level != SUSPEND_DISABLE)
+                return 0;
+
+        save = kmalloc(sizeof(struct locomo_save_data), GFP_KERNEL);
+        if (!save)
+                return -ENOMEM;
+
+        dev->power.saved_state = (void *) save;
+
+        spin_lock_irqsave(&lchip->lock, flags);
+
+        save->LCM_GPO     = locomo_readl(lchip->base + LOCOMO_GPO);     /* GPIO */
+        locomo_writel(0x00, lchip->base + LOCOMO_GPO);
+        save->LCM_SPICT   = locomo_readl(lchip->base + LOCOMO_SPICT);   /* SPI */
+        locomo_writel(0x40, lchip->base + LOCOMO_SPICT);
+        save->LCM_GPE     = locomo_readl(lchip->base + LOCOMO_GPE);     /* GPIO */
+        locomo_writel(0x00, lchip->base + LOCOMO_GPE);
+        save->LCM_ASD     = locomo_readl(lchip->base + LOCOMO_ASD);     /* ADSTART */
+        locomo_writel(0x00, lchip->base + LOCOMO_ASD);
+        save->LCM_SPIMD   = locomo_readl(lchip->base + LOCOMO_SPIMD);   /* SPI */
+        locomo_writel(0x3C14, lchip->base + LOCOMO_SPIMD);
+
+        locomo_writel(0x00, lchip->base + LOCOMO_PAIF);
+        locomo_writel(0x00, lchip->base + LOCOMO_DAC);
+        locomo_writel(0x00, lchip->base + LOCOMO_BACKLIGHT + LOCOMO_TC);
+
+        if ( (locomo_readl(lchip->base + LOCOMO_LED + LOCOMO_LPT0) & 0x88) && (locomo_readl(lchip->base + LOCOMO_LED + LOCOMO_LPT1) & 0x88) )
+                locomo_writel(0x00, lchip->base + LOCOMO_C32K);         /* CLK32 off */
+        else
+                /* 18MHz already enabled, so no wait */
+                locomo_writel(0xc1, lchip->base + LOCOMO_C32K);         /* CLK32 on */
+
+        locomo_writel(0x00, lchip->base + LOCOMO_TADC);         /* 18MHz clock off*/
+        locomo_writel(0x00, lchip->base + LOCOMO_AUDIO + LOCOMO_ACC);                   /* 22MHz/24MHz clock off */
+        locomo_writel(0x00, lchip->base + LOCOMO_FRONTLIGHT + LOCOMO_ALS);                      /* FL */
+
+        spin_unlock_irqrestore(&lchip->lock, flags);
+
+        return 0;
+}
+
+static int locomo_resume(struct device *dev, u32 level)
+{
+        struct locomo *lchip = dev_get_drvdata(dev);
+        struct locomo_save_data *save;
+        unsigned long r;
+        unsigned long flags;
+        
+        if (level != RESUME_ENABLE)
+                return 0;
+
+        save = (struct locomo_save_data *) dev->power.saved_state;
+        if (!save)
+                return 0;
+
+        spin_lock_irqsave(&lchip->lock, flags);
+
+        locomo_writel(save->LCM_GPO, lchip->base + LOCOMO_GPO);
+        locomo_writel(save->LCM_SPICT, lchip->base + LOCOMO_SPICT);
+        locomo_writel(save->LCM_GPE, lchip->base + LOCOMO_GPE);
+        locomo_writel(save->LCM_ASD, lchip->base + LOCOMO_ASD);
+        locomo_writel(save->LCM_SPIMD, lchip->base + LOCOMO_SPIMD);
+
+        locomo_writel(0x00, lchip->base + LOCOMO_C32K);
+        locomo_writel(0x90, lchip->base + LOCOMO_TADC);
+
+        locomo_writel(0, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KSC);
+        r = locomo_readl(lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC);
+        r &= 0xFEFF;
+        locomo_writel(r, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KIC);
+        locomo_writel(0x1, lchip->base + LOCOMO_KEYBOARD + LOCOMO_KCMD);
+
+        spin_unlock_irqrestore(&lchip->lock, flags);
+
+        dev->power.saved_state = NULL;
+        kfree(save);
+
+        return 0;
+}
+#endif
+
 /**
  *      locomo_probe - probe for a single LoCoMo chip.
  *      @phys_addr: physical address of device.
@@ -651,15 +748,15 @@ __locomo_probe(struct device *me, struct resource *mem, int irq)
         return ret;
 }
 
-static void __locomo_remove(struct locomo *lchip)
+static int locomo_remove_child(struct device *dev, void *data)
 {
-        struct list_head *l, *n;
-
-        list_for_each_safe(l, n, &lchip->dev->children) {
-                struct device *d = list_to_dev(l);
+        device_unregister(dev);
+        return 0;
+} 
 
-                device_unregister(d);
-        }
+static void __locomo_remove(struct locomo *lchip)
+{
+        device_for_each_child(lchip->dev, NULL, locomo_remove_child);
 
         if (lchip->irq != NO_IRQ) {
                 set_irq_chained_handler(lchip->irq, NULL);
@@ -707,6 +804,10 @@ static struct device_driver locomo_device_driver = {
         .bus            = &platform_bus_type,
         .probe          = locomo_probe,
         .remove         = locomo_remove,
+#ifdef CONFIG_PM
+        .suspend        = locomo_suspend,
+        .resume         = locomo_resume,
+#endif
 };
 
 /*