target/linux/ixp4xx/patches-2.6.32/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/pgtable.h>
   5  #include <asm/page.h>
   6  #include <asm/irq.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 @@ -418,6 +418,7 @@ config ARCH_IXP4XX
  65         select GENERIC_GPIO
  66         select GENERIC_TIME
  67         select GENERIC_CLOCKEVENTS
  68 +       select ARCH_REQUIRE_GPIOLIB
  69         help
  70           Support for Intel's IXP4XX (XScale) family of processors.
  71
  72 --- a/arch/arm/mach-ixp4xx/include/mach/gpio.h
  73 +++ b/arch/arm/mach-ixp4xx/include/mach/gpio.h
  74 @@ -27,47 +27,31 @@
  75
  76  #include <linux/kernel.h>
  77  #include <mach/hardware.h>
  78 +#include <asm-generic/gpio.h>                  /* cansleep wrappers */
  79
  80 -static inline int gpio_request(unsigned gpio, const char *label)
  81 -{
  82 -       return 0;
  83 -}
  84 -
  85 -static inline void gpio_free(unsigned gpio)
  86 -{
  87 -       might_sleep();
  88 -
  89 -       return;
  90 -}
  91 -
  92 -static inline int gpio_direction_input(unsigned gpio)
  93 -{
  94 -       gpio_line_config(gpio, IXP4XX_GPIO_IN);
  95 -       return 0;
  96 -}
  97 -
  98 -static inline int gpio_direction_output(unsigned gpio, int level)
  99 -{
 100 -       gpio_line_set(gpio, level);
 101 -       gpio_line_config(gpio, IXP4XX_GPIO_OUT);
 102 -       return 0;
 103 -}
 104 +#define NR_BUILTIN_GPIO 16
 105
 106  static inline int gpio_get_value(unsigned gpio)
 107  {
 108 -       int value;
 109 -
 110 -       gpio_line_get(gpio, &value);
 111 -
 112 -       return value;
 113 +       if (gpio < NR_BUILTIN_GPIO)
 114 +       {
 115 +               int value;
 116 +               gpio_line_get(gpio, &value);
 117 +               return value;
 118 +       }
 119 +       else
 120 +               return __gpio_get_value(gpio);
 121  }
 122
 123  static inline void gpio_set_value(unsigned gpio, int value)
 124  {
 125 -       gpio_line_set(gpio, value);
 126 +       if (gpio < NR_BUILTIN_GPIO)
 127 +               gpio_line_set(gpio, value);
 128 +       else
 129 +               __gpio_set_value(gpio, value);
 130  }
 131
 132 -#include <asm-generic/gpio.h>                  /* cansleep wrappers */
 133 +#define gpio_cansleep __gpio_cansleep
 134
 135  extern int gpio_to_irq(int gpio);
 136  extern int irq_to_gpio(int gpio);