cache GPIO addresses to be more efficent

[librecmc/librecmc.git] / target / linux / ar7 / files / include / asm-mips / ar7 / gpio.h

diff --git a/target/linux/ar7/files/include/asm-mips/ar7/gpio.h b/target/linux/ar7/files/include/asm-mips/ar7/gpio.h
index c82ba78cf991cfc695b5253ae6a6528884d15cae..7d665ff62dd6115a1f1bd4b8bd2a7995d4380442 100644 (file)
--- a/target/linux/ar7/files/include/asm-mips/ar7/gpio.h
+++ b/target/linux/ar7/files/include/asm-mips/ar7/gpio.h
@@ -22,24 +22,40 @@
 
 #define AR7_GPIO_MAX 32
 
-extern int gpio_request(unsigned gpio, char *label);
+extern int gpio_request(unsigned gpio, const char *label);
 extern void gpio_free(unsigned gpio);
 
 /* Common GPIO layer */
-static inline int gpio_direction_input(unsigned gpio)
+static inline int gpio_get_value(unsigned gpio)
 {
-       void __iomem *gpio_dir =
-               (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR);
+       static unsigned addr;
 
-       if (gpio >= AR7_GPIO_MAX)
-               return -EINVAL;
+       if (!addr) {
+               void __iomem *gpio_in = (void __iomem *)
+                               KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_INPUT);
+               addr = readl(gpio_in);
+       }
 
-       writel(readl(gpio_dir) | (1 << gpio), gpio_dir);
+       return addr & (1 << gpio);
+}
 
-       return 0;
+static inline void gpio_set_value(unsigned gpio, int value)
+{
+       static unsigned addr;
+       unsigned tmp;
+
+       void __iomem *gpio_out =
+               (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_OUTPUT);
+       if (!addr)
+               addr = readl(gpio_out);
+
+       tmp = addr & ~(1 << gpio);
+       if (value)
+               tmp |= 1 << gpio;
+       writel(tmp, gpio_out);
 }
 
-static inline int gpio_direction_output(unsigned gpio)
+static inline int gpio_direction_input(unsigned gpio)
 {
        void __iomem *gpio_dir =
                (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR);
@@ -47,35 +63,23 @@ static inline int gpio_direction_output(unsigned gpio)
        if (gpio >= AR7_GPIO_MAX)
                return -EINVAL;
 
-       writel(readl(gpio_dir) & ~(1 << gpio), gpio_dir);
+       writel(readl(gpio_dir) | (1 << gpio), gpio_dir);
 
        return 0;
 }
 
-static inline int gpio_get_value(unsigned gpio)
+static inline int gpio_direction_output(unsigned gpio, int value)
 {
-       void __iomem *gpio_in =
-               (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_INPUT);
+       void __iomem *gpio_dir =
+               (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR);
 
        if (gpio >= AR7_GPIO_MAX)
                return -EINVAL;
 
-       return ((readl(gpio_in) & (1 << gpio)) != 0);
-}
-
-static inline void gpio_set_value(unsigned gpio, int value)
-{
-       void __iomem *gpio_out =
-               (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_OUTPUT);
-       volatile unsigned tmp;
-
-       if (gpio >= AR7_GPIO_MAX)
-               return;
+       gpio_set_value(gpio, value);
+       writel(readl(gpio_dir) & ~(1 << gpio), gpio_dir);
 
-       tmp = readl(gpio_out) & ~(1 << gpio);
-       if (value)
-               tmp |= 1 << gpio;
-       writel(tmp, gpio_out);
+       return 0;
 }
 
 static inline int gpio_to_irq(unsigned gpio)
@@ -94,9 +98,6 @@ static inline int ar7_gpio_enable(unsigned gpio)
        void __iomem *gpio_en =
                (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_ENABLE);
 
-       if (gpio >= AR7_GPIO_MAX)
-               return -EINVAL;
-
        writel(readl(gpio_en) | (1 << gpio), gpio_en);
 
        return 0;
@@ -107,9 +108,6 @@ static inline int ar7_gpio_disable(unsigned gpio)
        void __iomem *gpio_en =
                (void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_ENABLE);
 
-       if (gpio >= AR7_GPIO_MAX)
-               return -EINVAL;
-
        writel(readl(gpio_en) & ~(1 << gpio), gpio_en);
 
        return 0;