drivers/gpio/gpio-sa1100.c

   1 /*
   2  * linux/arch/arm/mach-sa1100/gpio.c
   3  *
   4  * Generic SA-1100 GPIO handling
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10 #include <linux/gpio.h>
  11 #include <linux/init.h>
  12 #include <linux/module.h>
  13
  14 #include <mach/hardware.h>
  15
  16 static int sa1100_gpio_get(struct gpio_chip *chip, unsigned offset)
  17 {
  18         return GPLR & GPIO_GPIO(offset);
  19 }
  20
  21 static void sa1100_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
  22 {
  23         if (value)
  24                 GPSR = GPIO_GPIO(offset);
  25         else
  26                 GPCR = GPIO_GPIO(offset);
  27 }
  28
  29 static int sa1100_direction_input(struct gpio_chip *chip, unsigned offset)
  30 {
  31         unsigned long flags;
  32
  33         local_irq_save(flags);
  34         GPDR &= ~GPIO_GPIO(offset);
  35         local_irq_restore(flags);
  36         return 0;
  37 }
  38
  39 static int sa1100_direction_output(struct gpio_chip *chip, unsigned offset, int value)
  40 {
  41         unsigned long flags;
  42
  43         local_irq_save(flags);
  44         sa1100_gpio_set(chip, offset, value);
  45         GPDR |= GPIO_GPIO(offset);
  46         local_irq_restore(flags);
  47         return 0;
  48 }
  49
  50 static int sa1100_to_irq(struct gpio_chip *chip, unsigned offset)
  51 {
  52         return offset < 11 ? (IRQ_GPIO0 + offset) : (IRQ_GPIO11 - 11 + offset);
  53 }
  54
  55 static struct gpio_chip sa1100_gpio_chip = {
  56         .label                  = "gpio",
  57         .direction_input        = sa1100_direction_input,
  58         .direction_output       = sa1100_direction_output,
  59         .set                    = sa1100_gpio_set,
  60         .get                    = sa1100_gpio_get,
  61         .to_irq                 = sa1100_to_irq,
  62         .base                   = 0,
  63         .ngpio                  = GPIO_MAX + 1,
  64 };
  65
  66 void __init sa1100_init_gpio(void)
  67 {
  68         gpiochip_add(&sa1100_gpio_chip);
  69 }