target/linux/ixp4xx/patches-3.3/402-ixp4xx_gpiolib.patch

   1 --- a/arch/arm/mach-ixp4xx/common.c
   2 +++ b/arch/arm/mach-ixp4xx/common.c
   3 @@ -36,6 +36,7 @@
   4  #include <asm/page.h>
   5  #include <asm/irq.h>
   6  #include <asm/sched_clock.h>
   7 +#include <asm/gpio.h>
   8
   9  #include <asm/mach/map.h>
  10  #include <asm/mach/irq.h>
  11 @@ -375,12 +376,50 @@ static struct platform_device *ixp46x_de
  12  unsigned long ixp4xx_exp_bus_size;
  13  EXPORT_SYMBOL(ixp4xx_exp_bus_size);
  14
  15 +static int ixp4xx_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
  16 +{
  17 +       gpio_line_config(gpio, IXP4XX_GPIO_IN);
  18 +       return 0;
  19 +}
  20 +
  21 +static int ixp4xx_gpio_direction_output(struct gpio_chip *chip, unsigned gpio, int level)
  22 +{
  23 +       gpio_line_set(gpio, level);
  24 +       gpio_line_config(gpio, IXP4XX_GPIO_OUT);
  25 +       return 0;
  26 +}
  27 +
  28 +static int ixp4xx_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
  29 +{
  30 +       int value;
  31 +
  32 +       gpio_line_get(gpio, &value);
  33 +       return value;
  34 +}
  35 +
  36 +static void ixp4xx_gpio_set_value(struct gpio_chip *chip, unsigned gpio, int value)
  37 +{
  38 +       gpio_line_set(gpio, value);
  39 +}
  40 +
  41 +static struct gpio_chip ixp4xx_gpio_chip = {
  42 +       .label                  = "IXP4XX_GPIO_CHIP",
  43 +       .direction_input        = ixp4xx_gpio_direction_input,
  44 +       .direction_output       = ixp4xx_gpio_direction_output,
  45 +       .get                    = ixp4xx_gpio_get_value,
  46 +       .set                    = ixp4xx_gpio_set_value,
  47 +       .base                   = 0,
  48 +       .ngpio                  = 16,
  49 +};
  50 +
  51  void __init ixp4xx_sys_init(void)
  52  {
  53         ixp4xx_exp_bus_size = SZ_16M;
  54
  55         platform_add_devices(ixp4xx_devices, ARRAY_SIZE(ixp4xx_devices));
  56
  57 +       gpiochip_add(&ixp4xx_gpio_chip);
  58 +
  59         if (cpu_is_ixp46x()) {
  60                 int region;
  61
  62 --- a/arch/arm/Kconfig
  63 +++ b/arch/arm/Kconfig
  64 @@ -529,7 +529,7 @@ config ARCH_IXP4XX
  65         depends on MMU
  66         select CLKSRC_MMIO
  67         select CPU_XSCALE
  68 -       select GENERIC_GPIO
  69 +       select ARCH_REQUIRE_GPIOLIB
  70         select GENERIC_CLOCKEVENTS
  71         select HAVE_SCHED_CLOCK
  72         select MIGHT_HAVE_PCI
  73 --- a/arch/arm/mach-ixp4xx/include/mach/gpio.h
  74 +++ b/arch/arm/mach-ixp4xx/include/mach/gpio.h
  75 @@ -27,38 +27,19 @@
  76
  77  #include <linux/kernel.h>
  78  #include <mach/hardware.h>
  79 +#include <asm-generic/gpio.h>                  /* cansleep wrappers */
  80
  81  #define __ARM_GPIOLIB_COMPLEX
  82
  83 -static inline int gpio_request(unsigned gpio, const char *label)
  84 -{
  85 -       return 0;
  86 -}
  87 -
  88 -static inline void gpio_free(unsigned gpio)
  89 -{
  90 -       might_sleep();
  91 -
  92 -       return;
  93 -}
  94 -
  95 -static inline int gpio_direction_input(unsigned gpio)
  96 -{
  97 -       gpio_line_config(gpio, IXP4XX_GPIO_IN);
  98 -       return 0;
  99 -}
 100 -
 101 -static inline int gpio_direction_output(unsigned gpio, int level)
 102 -{
 103 -       gpio_line_set(gpio, level);
 104 -       gpio_line_config(gpio, IXP4XX_GPIO_OUT);
 105 -       return 0;
 106 -}
 107 +#define NR_BUILTIN_GPIO 16
 108
 109  static inline int gpio_get_value(unsigned gpio)
 110  {
 111         int value;
 112
 113 +       if (gpio >= NR_BUILTIN_GPIO)
 114 +               return __gpio_get_value(gpio);
 115 +
 116         gpio_line_get(gpio, &value);
 117
 118         return value;
 119 @@ -66,10 +47,13 @@ static inline int gpio_get_value(unsigne
 120
 121  static inline void gpio_set_value(unsigned gpio, int value)
 122  {
 123 -       gpio_line_set(gpio, value);
 124 +       if (gpio >= NR_BUILTIN_GPIO)
 125 +               __gpio_set_value(gpio, value);
 126 +       else
 127 +               gpio_line_set(gpio, value);
 128  }
 129
 130 -#include <asm-generic/gpio.h>                  /* cansleep wrappers */
 131 +#define gpio_cansleep __gpio_cansleep
 132
 133  extern int gpio_to_irq(int gpio);
 134  #define gpio_to_irq gpio_to_irq