[ARM] 4560/1: pxa: move processor specific set_wake logic out of irq.c

a function pxa_init_irq_set_wake() was introduced, so that
processor specific code could install their own version

code setting PFER and PRER registers within pxa_gpio_irq_type
are removed, and the edge configuration is postponed to the
(*set_wake) and copies the GRER and GFER register, which will
always be set up correctly by pxa_gpio_irq_type()

Signed-off-by: eric miao <eric.y.miao@gmail.com>
Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>

diff --git a/arch/arm/mach-pxa/generic.h b/arch/arm/mach-pxa/generic.h
index 25bd9bf727b6481ed95968059b21069128ea5005..2c4fe617cfc0b27ba94bef17d84c1cb75254aadd 100644 (file)
--- a/arch/arm/mach-pxa/generic.h
+++ b/arch/arm/mach-pxa/generic.h
@@ -15,6 +15,7 @@ extern struct sys_timer pxa_timer;
 extern void __init pxa_init_irq_low(void);
 extern void __init pxa_init_irq_high(void);
 extern void __init pxa_init_irq_gpio(int gpio_nr);
+extern void __init pxa_init_irq_set_wake(int (*set_wake)(unsigned int, unsigned int));
 extern void __init pxa25x_init_irq(void);
 extern void __init pxa27x_init_irq(void);
 extern void __init pxa_map_io(void);

diff --git a/arch/arm/mach-pxa/irq.c b/arch/arm/mach-pxa/irq.c
index 3d95442d4168b0de8d9e70adae496a010c48c433..294cc6758d5567fe6c94d06ed861179de6ed87e6 100644 (file)
--- a/arch/arm/mach-pxa/irq.c
+++ b/arch/arm/mach-pxa/irq.c
@@ -38,33 +38,11 @@ static void pxa_unmask_low_irq(unsigned int irq)
        ICMR |= (1 << irq);
 }
 
-static int pxa_set_wake(unsigned int irq, unsigned int on)
-{
-       u32     mask;
-
-       switch (irq) {
-       case IRQ_RTCAlrm:
-               mask = PWER_RTC;
-               break;
-#ifdef CONFIG_PXA27x
-       /* REVISIT can handle USBH1, USBH2, USB, MSL, USIM, ... */
-#endif
-       default:
-               return -EINVAL;
-       }
-       if (on)
-               PWER |= mask;
-       else
-               PWER &= ~mask;
-       return 0;
-}
-
 static struct irq_chip pxa_internal_chip_low = {
        .name           = "SC",
        .ack            = pxa_mask_low_irq,
        .mask           = pxa_mask_low_irq,
        .unmask         = pxa_unmask_low_irq,
-       .set_wake       = pxa_set_wake,
 };
 
 void __init pxa_init_irq_low(void)
@@ -125,26 +103,6 @@ void __init pxa_init_irq_high(void)
 }
 #endif
 
-/* Note that if an input/irq line ever gets changed to an output during
- * suspend, the relevant PWER, PRER, and PFER bits should be cleared.
- */
-#ifdef CONFIG_PXA27x
-
-/* PXA27x:  Various gpios can issue wakeup events.  This logic only
- * handles the simple cases, not the WEMUX2 and WEMUX3 options
- */
-#define PXA27x_GPIO_NOWAKE_MASK \
-       ((1 << 8) | (1 << 7) | (1 << 6) | (1 << 5) | (1 << 2))
-#define        WAKEMASK(gpio) \
-       (((gpio) <= 15) \
-               ? ((1 << (gpio)) & ~PXA27x_GPIO_NOWAKE_MASK) \
-               : ((gpio == 35) ? (1 << 24) : 0))
-#else
-
-/* pxa 210, 250, 255, 26x:  gpios 0..15 can issue wakeups */
-#define        WAKEMASK(gpio) (((gpio) <= 15) ? (1 << (gpio)) : 0)
-#endif
-
 /*
  * PXA GPIO edge detection for IRQs:
  * IRQs are generated on Falling-Edge, Rising-Edge, or both.
@@ -158,11 +116,9 @@ static long GPIO_IRQ_mask[4];
 static int pxa_gpio_irq_type(unsigned int irq, unsigned int type)
 {
        int gpio, idx;
-       u32 mask;
 
        gpio = IRQ_TO_GPIO(irq);
        idx = gpio >> 5;
-       mask = WAKEMASK(gpio);
 
        if (type == IRQT_PROBE) {
            /* Don't mess with enabled GPIOs using preconfigured edges or
@@ -182,19 +138,15 @@ static int pxa_gpio_irq_type(unsigned int irq, unsigned int type)
        if (type & __IRQT_RISEDGE) {
                /* printk("rising "); */
                __set_bit (gpio, GPIO_IRQ_rising_edge);
-               PRER |= mask;
        } else {
                __clear_bit (gpio, GPIO_IRQ_rising_edge);
-               PRER &= ~mask;
        }
 
        if (type & __IRQT_FALEDGE) {
                /* printk("falling "); */
                __set_bit (gpio, GPIO_IRQ_falling_edge);
-               PFER |= mask;
        } else {
                __clear_bit (gpio, GPIO_IRQ_falling_edge);
-               PFER &= ~mask;
        }
 
        /* printk("edges\n"); */
@@ -213,29 +165,12 @@ static void pxa_ack_low_gpio(unsigned int irq)
        GEDR0 = (1 << (irq - IRQ_GPIO0));
 }
 
-static int pxa_set_gpio_wake(unsigned int irq, unsigned int on)
-{
-       int     gpio = IRQ_TO_GPIO(irq);
-       u32     mask = WAKEMASK(gpio);
-
-       if (!mask)
-               return -EINVAL;
-
-       if (on)
-               PWER |= mask;
-       else
-               PWER &= ~mask;
-       return 0;
-}
-
-
 static struct irq_chip pxa_low_gpio_chip = {
        .name           = "GPIO-l",
        .ack            = pxa_ack_low_gpio,
        .mask           = pxa_mask_low_irq,
        .unmask         = pxa_unmask_low_irq,
        .set_type       = pxa_gpio_irq_type,
-       .set_wake       = pxa_set_gpio_wake,
 };
 
 /*
@@ -342,7 +277,6 @@ static struct irq_chip pxa_muxed_gpio_chip = {
        .mask           = pxa_mask_muxed_gpio,
        .unmask         = pxa_unmask_muxed_gpio,
        .set_type       = pxa_gpio_irq_type,
-       .set_wake       = pxa_set_gpio_wake,
 };
 
 void __init pxa_init_irq_gpio(int gpio_nr)
@@ -377,3 +311,13 @@ void __init pxa_init_irq_gpio(int gpio_nr)
        set_irq_chip(IRQ_GPIO_2_x, &pxa_internal_chip_low);
        set_irq_chained_handler(IRQ_GPIO_2_x, pxa_gpio_demux_handler);
 }
+
+void __init pxa_init_irq_set_wake(int (*set_wake)(unsigned int, unsigned int))
+{
+       pxa_internal_chip_low.set_wake = set_wake;
+#ifdef CONFIG_PXA27x
+       pxa_internal_chip_high.set_wake = set_wake;
+#endif
+       pxa_low_gpio_chip.set_wake = set_wake;
+       pxa_muxed_gpio_chip.set_wake = set_wake;
+}

diff --git a/arch/arm/mach-pxa/pxa25x.c b/arch/arm/mach-pxa/pxa25x.c
index ef40c049d9e2ae80fcf4804a69765092fb26d48b..0d6a72504caa2cf67e97a0365bffd870d94404c9 100644 (file)
--- a/arch/arm/mach-pxa/pxa25x.c
+++ b/arch/arm/mach-pxa/pxa25x.c
@@ -227,10 +227,52 @@ static void __init pxa25x_init_pm(void)
 }
 #endif
 
+/* PXA25x: supports wakeup from GPIO0..GPIO15 and RTC alarm
+ */
+
+static int pxa25x_set_wake(unsigned int irq, unsigned int on)
+{
+       int gpio = IRQ_TO_GPIO(irq);
+       uint32_t gpio_bit, mask = 0;
+
+       if (gpio >= 0 && gpio <= 15) {
+               gpio_bit = GPIO_bit(gpio);
+               mask = gpio_bit;
+               if (on) {
+                       if (GRER(gpio) | gpio_bit)
+                               PRER |= gpio_bit;
+                       else
+                               PRER &= ~gpio_bit;
+
+                       if (GFER(gpio) | gpio_bit)
+                               PFER |= gpio_bit;
+                       else
+                               PFER &= ~gpio_bit;
+               }
+               goto set_pwer;
+       }
+
+       if (irq == IRQ_RTCAlrm) {
+               mask = PWER_RTC;
+               goto set_pwer;
+       }
+
+       return -EINVAL;
+
+set_pwer:
+       if (on)
+               PWER |= mask;
+       else
+               PWER &=~mask;
+
+       return 0;
+}
+
 void __init pxa25x_init_irq(void)
 {
        pxa_init_irq_low();
        pxa_init_irq_gpio(85);
+       pxa_init_irq_set_wake(pxa25x_set_wake);
 }
 
 static struct platform_device *pxa25x_devices[] __initdata = {

diff --git a/arch/arm/mach-pxa/pxa27x.c b/arch/arm/mach-pxa/pxa27x.c
index d193755afb2b4cab1585ec8f1a072c1f78702d81..2d7fc39732e444a7aa981dd63f0a8de3a3aed5bd 100644 (file)
--- a/arch/arm/mach-pxa/pxa27x.c
+++ b/arch/arm/mach-pxa/pxa27x.c
@@ -306,6 +306,69 @@ static void __init pxa27x_init_pm(void)
 }
 #endif
 
+/* PXA27x:  Various gpios can issue wakeup events.  This logic only
+ * handles the simple cases, not the WEMUX2 and WEMUX3 options
+ */
+#define PXA27x_GPIO_NOWAKE_MASK \
+        ((1 << 8) | (1 << 7) | (1 << 6) | (1 << 5) | (1 << 2))
+#define WAKEMASK(gpio) \
+        (((gpio) <= 15) \
+                 ? ((1 << (gpio)) & ~PXA27x_GPIO_NOWAKE_MASK) \
+                 : ((gpio == 35) ? (1 << 24) : 0))
+
+static int pxa27x_set_wake(unsigned int irq, unsigned int on)
+{
+       int gpio = IRQ_TO_GPIO(irq);
+       uint32_t mask;
+
+       if ((gpio >= 0 && gpio <= 15) || (gpio == 35)) {
+               if (WAKEMASK(gpio) == 0)
+                       return -EINVAL;
+
+               mask = WAKEMASK(gpio);
+
+               if (on) {
+                       if (GRER(gpio) | GPIO_bit(gpio))
+                               PRER |= mask;
+                       else
+                               PRER &= ~mask;
+
+                       if (GFER(gpio) | GPIO_bit(gpio))
+                               PFER |= mask;
+                       else
+                               PFER &= ~mask;
+               }
+               goto set_pwer;
+       }
+
+       switch (irq) {
+       case IRQ_RTCAlrm:
+               mask = PWER_RTC;
+               break;
+       case IRQ_USB:
+               mask = 1u << 26;
+               break;
+       default:
+               return -EINVAL;
+       }
+
+set_pwer:
+       if (on)
+               PWER |= mask;
+       else
+               PWER &=~mask;
+
+       return 0;
+}
+
+void __init pxa27x_init_irq(void)
+{
+       pxa_init_irq_low();
+       pxa_init_irq_high();
+       pxa_init_irq_gpio(128);
+       pxa_init_irq_set_wake(pxa27x_set_wake);
+}
+
 /*
  * device registration specific to PXA27x.
  */
@@ -375,13 +438,6 @@ static struct platform_device *devices[] __initdata = {
        &pxa27x_device_ohci,
 };
 
-void __init pxa27x_init_irq(void)
-{
-       pxa_init_irq_low();
-       pxa_init_irq_high();
-       pxa_init_irq_gpio(128);
-}
-
 static int __init pxa27x_init(void)
 {
        int ret = 0;