2 files changed, 57 insertions, 1 deletions

diff --git a/arch/arm/mach-pxa/generic.c b/arch/arm/mach-pxa/generic.c
index 390524c4710f..b8cb79f899d5 100644
--- a/arch/arm/mach-pxa/generic.c
+++ b/arch/arm/mach-pxa/generic.c
@@ -36,6 +36,7 @@
 #include <asm/mach/map.h>
 
 #include <asm/arch/pxa-regs.h>
+#include <asm/arch/gpio.h>
 #include <asm/arch/udc.h>
 #include <asm/arch/pxafb.h>
 #include <asm/arch/mmc.h>
@@ -106,13 +107,16 @@ unsigned long long sched_clock(void)
  * Handy function to set GPIO alternate functions
  */
 
-void pxa_gpio_mode(int gpio_mode)
+int pxa_gpio_mode(int gpio_mode)
 {
         unsigned long flags;
         int gpio = gpio_mode & GPIO_MD_MASK_NR;
         int fn = (gpio_mode & GPIO_MD_MASK_FN) >> 8;
         int gafr;
 
+        if (gpio > PXA_LAST_GPIO)
+                return -EINVAL;
+
         local_irq_save(flags);
         if (gpio_mode & GPIO_DFLT_LOW)
                 GPCR(gpio) = GPIO_bit(gpio);
@@ -125,11 +129,33 @@ void pxa_gpio_mode(int gpio_mode)
         gafr = GAFR(gpio) & ~(0x3 << (((gpio) & 0xf)*2));
         GAFR(gpio) = gafr |  (fn  << (((gpio) & 0xf)*2));
         local_irq_restore(flags);
+
+        return 0;
 }
 
 EXPORT_SYMBOL(pxa_gpio_mode);
 
 /*
+ * Return GPIO level
+ */
+int pxa_gpio_get_value(unsigned gpio)
+{
+        return __gpio_get_value(gpio);
+}
+
+EXPORT_SYMBOL(pxa_gpio_get_value);
+
+/*
+ * Set output GPIO level
+ */
+void pxa_gpio_set_value(unsigned gpio, int value)
+{
+        __gpio_set_value(gpio, value);
+}
+
+EXPORT_SYMBOL(pxa_gpio_set_value);
+
+/*
  * Routine to safely enable or disable a clock in the CKEN
  */
 void pxa_set_cken(int clock, int enable)
diff --git a/arch/arm/mach-sa1100/generic.c b/arch/arm/mach-sa1100/generic.c
index e510295c2580..192a5a26cf2b 100644
--- a/arch/arm/mach-sa1100/generic.c
+++ b/arch/arm/mach-sa1100/generic.c
@@ -138,6 +138,36 @@ unsigned long long sched_clock(void)
         return v;
 }
 
+int gpio_direction_input(unsigned gpio)
+{
+        unsigned long flags;
+
+        if (gpio > GPIO_MAX)
+                return -EINVAL;
+
+        local_irq_save(flags);
+        GPDR &= ~GPIO_GPIO(gpio);
+        local_irq_restore(flags);
+        return 0;
+}
+
+EXPORT_SYMBOL(gpio_direction_input);
+
+int gpio_direction_output(unsigned gpio)
+{
+        unsigned long flags;
+
+        if (gpio > GPIO_MAX)
+                return -EINVAL;
+
+        local_irq_save(flags);
+        GPDR |= GPIO_GPIO(gpio);
+        local_irq_restore(flags);
+        return 0;
+}
+
+EXPORT_SYMBOL(gpio_direction_output);
+
 /*
  * Default power-off for SA1100
  */