gpio-104-idio-16.c 8.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * GPIO driver for the ACCES 104-IDIO-16 family
  4. * Copyright (C) 2015 William Breathitt Gray
  5. *
  6. * This driver supports the following ACCES devices: 104-IDIO-16,
  7. * 104-IDIO-16E, 104-IDO-16, 104-IDIO-8, 104-IDIO-8E, and 104-IDO-8.
  8. */
  9. #include <linux/bitops.h>
  10. #include <linux/device.h>
  11. #include <linux/errno.h>
  12. #include <linux/gpio/driver.h>
  13. #include <linux/io.h>
  14. #include <linux/ioport.h>
  15. #include <linux/interrupt.h>
  16. #include <linux/irqdesc.h>
  17. #include <linux/isa.h>
  18. #include <linux/kernel.h>
  19. #include <linux/module.h>
  20. #include <linux/moduleparam.h>
  21. #include <linux/spinlock.h>
  22. #define IDIO_16_EXTENT 8
  23. #define MAX_NUM_IDIO_16 max_num_isa_dev(IDIO_16_EXTENT)
  24. static unsigned int base[MAX_NUM_IDIO_16];
  25. static unsigned int num_idio_16;
  26. module_param_hw_array(base, uint, ioport, &num_idio_16, 0);
  27. MODULE_PARM_DESC(base, "ACCES 104-IDIO-16 base addresses");
  28. static unsigned int irq[MAX_NUM_IDIO_16];
  29. module_param_hw_array(irq, uint, irq, NULL, 0);
  30. MODULE_PARM_DESC(irq, "ACCES 104-IDIO-16 interrupt line numbers");
  31. /**
  32. * struct idio_16_gpio - GPIO device private data structure
  33. * @chip: instance of the gpio_chip
  34. * @lock: synchronization lock to prevent I/O race conditions
  35. * @irq_mask: I/O bits affected by interrupts
  36. * @base: base port address of the GPIO device
  37. * @out_state: output bits state
  38. */
  39. struct idio_16_gpio {
  40. struct gpio_chip chip;
  41. raw_spinlock_t lock;
  42. unsigned long irq_mask;
  43. unsigned base;
  44. unsigned out_state;
  45. };
  46. static int idio_16_gpio_get_direction(struct gpio_chip *chip, unsigned offset)
  47. {
  48. if (offset > 15)
  49. return GPIO_LINE_DIRECTION_IN;
  50. return GPIO_LINE_DIRECTION_OUT;
  51. }
  52. static int idio_16_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
  53. {
  54. return 0;
  55. }
  56. static int idio_16_gpio_direction_output(struct gpio_chip *chip,
  57. unsigned offset, int value)
  58. {
  59. chip->set(chip, offset, value);
  60. return 0;
  61. }
  62. static int idio_16_gpio_get(struct gpio_chip *chip, unsigned offset)
  63. {
  64. struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
  65. const unsigned mask = BIT(offset-16);
  66. if (offset < 16)
  67. return -EINVAL;
  68. if (offset < 24)
  69. return !!(inb(idio16gpio->base + 1) & mask);
  70. return !!(inb(idio16gpio->base + 5) & (mask>>8));
  71. }
  72. static int idio_16_gpio_get_multiple(struct gpio_chip *chip,
  73. unsigned long *mask, unsigned long *bits)
  74. {
  75. struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
  76. *bits = 0;
  77. if (*mask & GENMASK(23, 16))
  78. *bits |= (unsigned long)inb(idio16gpio->base + 1) << 16;
  79. if (*mask & GENMASK(31, 24))
  80. *bits |= (unsigned long)inb(idio16gpio->base + 5) << 24;
  81. return 0;
  82. }
  83. static void idio_16_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
  84. {
  85. struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
  86. const unsigned mask = BIT(offset);
  87. unsigned long flags;
  88. if (offset > 15)
  89. return;
  90. raw_spin_lock_irqsave(&idio16gpio->lock, flags);
  91. if (value)
  92. idio16gpio->out_state |= mask;
  93. else
  94. idio16gpio->out_state &= ~mask;
  95. if (offset > 7)
  96. outb(idio16gpio->out_state >> 8, idio16gpio->base + 4);
  97. else
  98. outb(idio16gpio->out_state, idio16gpio->base);
  99. raw_spin_unlock_irqrestore(&idio16gpio->lock, flags);
  100. }
  101. static void idio_16_gpio_set_multiple(struct gpio_chip *chip,
  102. unsigned long *mask, unsigned long *bits)
  103. {
  104. struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
  105. unsigned long flags;
  106. raw_spin_lock_irqsave(&idio16gpio->lock, flags);
  107. idio16gpio->out_state &= ~*mask;
  108. idio16gpio->out_state |= *mask & *bits;
  109. if (*mask & 0xFF)
  110. outb(idio16gpio->out_state, idio16gpio->base);
  111. if ((*mask >> 8) & 0xFF)
  112. outb(idio16gpio->out_state >> 8, idio16gpio->base + 4);
  113. raw_spin_unlock_irqrestore(&idio16gpio->lock, flags);
  114. }
  115. static void idio_16_irq_ack(struct irq_data *data)
  116. {
  117. }
  118. static void idio_16_irq_mask(struct irq_data *data)
  119. {
  120. struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
  121. struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
  122. const unsigned long mask = BIT(irqd_to_hwirq(data));
  123. unsigned long flags;
  124. idio16gpio->irq_mask &= ~mask;
  125. if (!idio16gpio->irq_mask) {
  126. raw_spin_lock_irqsave(&idio16gpio->lock, flags);
  127. outb(0, idio16gpio->base + 2);
  128. raw_spin_unlock_irqrestore(&idio16gpio->lock, flags);
  129. }
  130. }
  131. static void idio_16_irq_unmask(struct irq_data *data)
  132. {
  133. struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
  134. struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
  135. const unsigned long mask = BIT(irqd_to_hwirq(data));
  136. const unsigned long prev_irq_mask = idio16gpio->irq_mask;
  137. unsigned long flags;
  138. idio16gpio->irq_mask |= mask;
  139. if (!prev_irq_mask) {
  140. raw_spin_lock_irqsave(&idio16gpio->lock, flags);
  141. inb(idio16gpio->base + 2);
  142. raw_spin_unlock_irqrestore(&idio16gpio->lock, flags);
  143. }
  144. }
  145. static int idio_16_irq_set_type(struct irq_data *data, unsigned flow_type)
  146. {
  147. /* The only valid irq types are none and both-edges */
  148. if (flow_type != IRQ_TYPE_NONE &&
  149. (flow_type & IRQ_TYPE_EDGE_BOTH) != IRQ_TYPE_EDGE_BOTH)
  150. return -EINVAL;
  151. return 0;
  152. }
  153. static struct irq_chip idio_16_irqchip = {
  154. .name = "104-idio-16",
  155. .irq_ack = idio_16_irq_ack,
  156. .irq_mask = idio_16_irq_mask,
  157. .irq_unmask = idio_16_irq_unmask,
  158. .irq_set_type = idio_16_irq_set_type
  159. };
  160. static irqreturn_t idio_16_irq_handler(int irq, void *dev_id)
  161. {
  162. struct idio_16_gpio *const idio16gpio = dev_id;
  163. struct gpio_chip *const chip = &idio16gpio->chip;
  164. int gpio;
  165. for_each_set_bit(gpio, &idio16gpio->irq_mask, chip->ngpio)
  166. generic_handle_irq(irq_find_mapping(chip->irq.domain, gpio));
  167. raw_spin_lock(&idio16gpio->lock);
  168. outb(0, idio16gpio->base + 1);
  169. raw_spin_unlock(&idio16gpio->lock);
  170. return IRQ_HANDLED;
  171. }
  172. #define IDIO_16_NGPIO 32
  173. static const char *idio_16_names[IDIO_16_NGPIO] = {
  174. "OUT0", "OUT1", "OUT2", "OUT3", "OUT4", "OUT5", "OUT6", "OUT7",
  175. "OUT8", "OUT9", "OUT10", "OUT11", "OUT12", "OUT13", "OUT14", "OUT15",
  176. "IIN0", "IIN1", "IIN2", "IIN3", "IIN4", "IIN5", "IIN6", "IIN7",
  177. "IIN8", "IIN9", "IIN10", "IIN11", "IIN12", "IIN13", "IIN14", "IIN15"
  178. };
  179. static int idio_16_irq_init_hw(struct gpio_chip *gc)
  180. {
  181. struct idio_16_gpio *const idio16gpio = gpiochip_get_data(gc);
  182. /* Disable IRQ by default */
  183. outb(0, idio16gpio->base + 2);
  184. outb(0, idio16gpio->base + 1);
  185. return 0;
  186. }
  187. static int idio_16_probe(struct device *dev, unsigned int id)
  188. {
  189. struct idio_16_gpio *idio16gpio;
  190. const char *const name = dev_name(dev);
  191. struct gpio_irq_chip *girq;
  192. int err;
  193. idio16gpio = devm_kzalloc(dev, sizeof(*idio16gpio), GFP_KERNEL);
  194. if (!idio16gpio)
  195. return -ENOMEM;
  196. if (!devm_request_region(dev, base[id], IDIO_16_EXTENT, name)) {
  197. dev_err(dev, "Unable to lock port addresses (0x%X-0x%X)\n",
  198. base[id], base[id] + IDIO_16_EXTENT);
  199. return -EBUSY;
  200. }
  201. idio16gpio->chip.label = name;
  202. idio16gpio->chip.parent = dev;
  203. idio16gpio->chip.owner = THIS_MODULE;
  204. idio16gpio->chip.base = -1;
  205. idio16gpio->chip.ngpio = IDIO_16_NGPIO;
  206. idio16gpio->chip.names = idio_16_names;
  207. idio16gpio->chip.get_direction = idio_16_gpio_get_direction;
  208. idio16gpio->chip.direction_input = idio_16_gpio_direction_input;
  209. idio16gpio->chip.direction_output = idio_16_gpio_direction_output;
  210. idio16gpio->chip.get = idio_16_gpio_get;
  211. idio16gpio->chip.get_multiple = idio_16_gpio_get_multiple;
  212. idio16gpio->chip.set = idio_16_gpio_set;
  213. idio16gpio->chip.set_multiple = idio_16_gpio_set_multiple;
  214. idio16gpio->base = base[id];
  215. idio16gpio->out_state = 0xFFFF;
  216. girq = &idio16gpio->chip.irq;
  217. girq->chip = &idio_16_irqchip;
  218. /* This will let us handle the parent IRQ in the driver */
  219. girq->parent_handler = NULL;
  220. girq->num_parents = 0;
  221. girq->parents = NULL;
  222. girq->default_type = IRQ_TYPE_NONE;
  223. girq->handler = handle_edge_irq;
  224. girq->init_hw = idio_16_irq_init_hw;
  225. raw_spin_lock_init(&idio16gpio->lock);
  226. err = devm_gpiochip_add_data(dev, &idio16gpio->chip, idio16gpio);
  227. if (err) {
  228. dev_err(dev, "GPIO registering failed (%d)\n", err);
  229. return err;
  230. }
  231. err = devm_request_irq(dev, irq[id], idio_16_irq_handler, 0, name,
  232. idio16gpio);
  233. if (err) {
  234. dev_err(dev, "IRQ handler registering failed (%d)\n", err);
  235. return err;
  236. }
  237. return 0;
  238. }
  239. static struct isa_driver idio_16_driver = {
  240. .probe = idio_16_probe,
  241. .driver = {
  242. .name = "104-idio-16"
  243. },
  244. };
  245. module_isa_driver(idio_16_driver, num_idio_16);
  246. MODULE_AUTHOR("William Breathitt Gray <vilhelm.gray@gmail.com>");
  247. MODULE_DESCRIPTION("ACCES 104-IDIO-16 GPIO driver");
  248. MODULE_LICENSE("GPL v2");