[brcm63xx] cache gpio values in gpio_set

[openwrt.git] / target / linux / brcm63xx / files / arch / mips / bcm63xx / gpio.c

diff --git a/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c b/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c
index 997fcaa..77636aa 100644 (file)
--- a/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c
+++ b/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c
@@ -18,12 +18,14 @@
 #include <bcm63xx_io.h>
 #include <bcm63xx_regs.h>
 
+static u32 gpio_out_low, gpio_out_high;
+
 static void bcm63xx_gpio_set(struct gpio_chip *chip,
                                unsigned gpio, int val)
 {
        u32 reg;
        u32 mask;
-       u32 tmp;
+       u32 *v;
        unsigned long flags;
 
        if (gpio >= chip->ngpio)
@@ -32,18 +34,19 @@ static void bcm63xx_gpio_set(struct gpio_chip *chip,
        if (gpio < 32) {
                reg = GPIO_DATA_LO_REG;
                mask = 1 << gpio;
+               v = &gpio_out_low;
        } else {
                reg = GPIO_DATA_HI_REG;
                mask = 1 << (gpio - 32);
+               v = &gpio_out_high;
        }
 
        local_irq_save(flags);
-       tmp = bcm_gpio_readl(reg);
        if (val)
-               tmp |= mask;
+               *v |= mask;
        else
-               tmp &= ~mask;
-       bcm_gpio_writel(tmp, reg);
+               *v &= ~mask;
+       bcm_gpio_writel(*v, reg);
        local_irq_restore(flags);
 }
 
@@ -117,11 +120,11 @@ static struct gpio_chip bcm63xx_gpio_chip = {
        .get                    = bcm63xx_gpio_get,
        .set                    = bcm63xx_gpio_set,
        .base                   = 0,
-       .ngpio                  = BCM63XX_GPIO_COUNT,
 };
 
 int __init bcm63xx_gpio_init(void)
 {
-       printk(KERN_INFO "registering %d GPIOs\n", BCM63XX_GPIO_COUNT);
+       bcm63xx_gpio_chip.ngpio = bcm63xx_gpio_count();
+       printk(KERN_INFO "registering %d GPIOs\n", bcm63xx_gpio_chip.ngpio);
        return gpiochip_add(&bcm63xx_gpio_chip);
 }