1 files changed, 33 insertions, 12 deletions

diff --git a/arch/arm/plat-omap/gpio.c b/arch/arm/plat-omap/gpio.c
index cd7f973fb286..f55f99ae58ae 100644
--- a/arch/arm/plat-omap/gpio.c
+++ b/arch/arm/plat-omap/gpio.c
@@ -94,6 +94,8 @@
 #define OMAP24XX_GPIO_SYSCONFIG         0x0010
 #define OMAP24XX_GPIO_SYSSTATUS         0x0014
 #define OMAP24XX_GPIO_IRQSTATUS1        0x0018
+#define OMAP24XX_GPIO_IRQSTATUS2        0x0028
+#define OMAP24XX_GPIO_IRQENABLE2        0x002c
 #define OMAP24XX_GPIO_IRQENABLE1        0x001c
 #define OMAP24XX_GPIO_CTRL              0x0030
 #define OMAP24XX_GPIO_OE                0x0034
@@ -110,8 +112,6 @@
 #define OMAP24XX_GPIO_CLEARDATAOUT      0x0090
 #define OMAP24XX_GPIO_SETDATAOUT        0x0094
 
-#define OMAP_MPUIO_MASK         (~OMAP_MAX_GPIO_LINES & 0xff)
-
 struct gpio_bank {
         void __iomem *base;
         u16 irq;
@@ -216,11 +216,13 @@ static inline int gpio_valid(int gpio)
 {
         if (gpio < 0)
                 return -1;
+#ifndef CONFIG_ARCH_OMAP24XX
         if (OMAP_GPIO_IS_MPUIO(gpio)) {
-                if ((gpio & OMAP_MPUIO_MASK) > 16)
+                if (gpio >= OMAP_MAX_GPIO_LINES + 16)
                         return -1;
                 return 0;
         }
+#endif
 #ifdef CONFIG_ARCH_OMAP15XX
         if (cpu_is_omap15xx() && gpio < 16)
                 return 0;
@@ -529,6 +531,10 @@ static void _clear_gpio_irqbank(struct gpio_bank *bank, int gpio_mask)
                 return;
         }
         __raw_writel(gpio_mask, reg);
+
+        /* Workaround for clearing DSP GPIO interrupts to allow retention */
+        if (cpu_is_omap2420())
+                __raw_writel(gpio_mask, bank->base + OMAP24XX_GPIO_IRQSTATUS2);
 }
 
 static inline void _clear_gpio_irqstatus(struct gpio_bank *bank, int gpio)
@@ -662,6 +668,14 @@ static int _set_gpio_wakeup(struct gpio_bank *bank, int gpio, int enable)
         }
 }
 
+static void _reset_gpio(struct gpio_bank *bank, int gpio)
+{
+        _set_gpio_direction(bank, get_gpio_index(gpio), 1);
+        _set_gpio_irqenable(bank, gpio, 0);
+        _clear_gpio_irqstatus(bank, gpio);
+        _set_gpio_triggering(bank, get_gpio_index(gpio), IRQT_NOEDGE);
+}
+
 /* Use disable_irq_wake() and enable_irq_wake() functions from drivers */
 static int gpio_wake_enable(unsigned int irq, unsigned int enable)
 {
@@ -672,9 +686,7 @@ static int gpio_wake_enable(unsigned int irq, unsigned int enable)
         if (check_gpio(gpio) < 0)
                 return -ENODEV;
         bank = get_gpio_bank(gpio);
-        spin_lock(&bank->lock);
         retval = _set_gpio_wakeup(bank, get_gpio_index(gpio), enable);
-        spin_unlock(&bank->lock);
 
         return retval;
 }
@@ -696,7 +708,9 @@ int omap_request_gpio(int gpio)
         }
         bank->reserved_map |= (1 << get_gpio_index(gpio));
 
-        /* Set trigger to none. You need to enable the trigger after request_irq */
+        /* Set trigger to none. You need to enable the desired trigger with
+         * request_irq() or set_irq_type().
+         */
         _set_gpio_triggering(bank, get_gpio_index(gpio), IRQT_NOEDGE);
 
 #ifdef CONFIG_ARCH_OMAP15XX
@@ -756,9 +770,7 @@ void omap_free_gpio(int gpio)
         }
 #endif
         bank->reserved_map &= ~(1 << get_gpio_index(gpio));
-        _set_gpio_direction(bank, get_gpio_index(gpio), 1);
-        _set_gpio_irqenable(bank, gpio, 0);
-        _clear_gpio_irqstatus(bank, gpio);
+        _reset_gpio(bank, gpio);
         spin_unlock(&bank->lock);
 }
 
@@ -898,6 +910,14 @@ static void gpio_irq_handler(unsigned int irq, struct irqdesc *desc,
 
 }
 
+static void gpio_irq_shutdown(unsigned int irq)
+{
+        unsigned int gpio = irq - IH_GPIO_BASE;
+        struct gpio_bank *bank = get_gpio_bank(gpio);
+
+        _reset_gpio(bank, gpio);
+}
+
 static void gpio_ack_irq(unsigned int irq)
 {
         unsigned int gpio = irq - IH_GPIO_BASE;
@@ -946,6 +966,7 @@ static void mpuio_unmask_irq(unsigned int irq)
 
 static struct irq_chip gpio_irq_chip = {
         .name           = "GPIO",
+        .shutdown       = gpio_irq_shutdown,
         .ack            = gpio_ack_irq,
         .mask           = gpio_mask_irq,
         .unmask         = gpio_unmask_irq,
@@ -985,7 +1006,7 @@ static int __init _omap_gpio_init(void)
                 else
                         clk_enable(gpio_ick);
                 gpio_fck = clk_get(NULL, "gpios_fck");
-                if (IS_ERR(gpio_ick))
+                if (IS_ERR(gpio_fck))
                         printk("Could not get gpios_fck\n");
                 else
                         clk_enable(gpio_fck);
@@ -1144,8 +1165,8 @@ static int omap_gpio_resume(struct sys_device *dev)
                         wake_set = bank->base + OMAP1610_GPIO_SET_WAKEUPENA;
                         break;
                 case METHOD_GPIO_24XX:
-                        wake_clear = bank->base + OMAP1610_GPIO_CLEAR_WAKEUPENA;
-                        wake_set = bank->base + OMAP1610_GPIO_SET_WAKEUPENA;
+                        wake_clear = bank->base + OMAP24XX_GPIO_CLEARWKUENA;
+                        wake_set = bank->base + OMAP24XX_GPIO_SETWKUENA;
                         break;
                 default:
                         continue;