11ceacea2SWilliam Breathitt Gray /* 21ceacea2SWilliam Breathitt Gray * GPIO driver for the ACCES 104-IDIO-16 family 31ceacea2SWilliam Breathitt Gray * Copyright (C) 2015 William Breathitt Gray 41ceacea2SWilliam Breathitt Gray * 51ceacea2SWilliam Breathitt Gray * This program is free software; you can redistribute it and/or modify 61ceacea2SWilliam Breathitt Gray * it under the terms of the GNU General Public License, version 2, as 71ceacea2SWilliam Breathitt Gray * published by the Free Software Foundation. 81ceacea2SWilliam Breathitt Gray * 91ceacea2SWilliam Breathitt Gray * This program is distributed in the hope that it will be useful, but 101ceacea2SWilliam Breathitt Gray * WITHOUT ANY WARRANTY; without even the implied warranty of 111ceacea2SWilliam Breathitt Gray * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 121ceacea2SWilliam Breathitt Gray * General Public License for more details. 1386ea8a95SWilliam Breathitt Gray * 1486ea8a95SWilliam Breathitt Gray * This driver supports the following ACCES devices: 104-IDIO-16, 1586ea8a95SWilliam Breathitt Gray * 104-IDIO-16E, 104-IDO-16, 104-IDIO-8, 104-IDIO-8E, and 104-IDO-8. 161ceacea2SWilliam Breathitt Gray */ 17a1184147SWilliam Breathitt Gray #include <linux/bitops.h> 181ceacea2SWilliam Breathitt Gray #include <linux/device.h> 191ceacea2SWilliam Breathitt Gray #include <linux/errno.h> 201ceacea2SWilliam Breathitt Gray #include <linux/gpio/driver.h> 211ceacea2SWilliam Breathitt Gray #include <linux/io.h> 221ceacea2SWilliam Breathitt Gray #include <linux/ioport.h> 23a1184147SWilliam Breathitt Gray #include <linux/interrupt.h> 24a1184147SWilliam Breathitt Gray #include <linux/irqdesc.h> 2586ea8a95SWilliam Breathitt Gray #include <linux/isa.h> 261ceacea2SWilliam Breathitt Gray #include <linux/kernel.h> 271ceacea2SWilliam Breathitt Gray #include <linux/module.h> 281ceacea2SWilliam Breathitt Gray #include <linux/moduleparam.h> 291ceacea2SWilliam Breathitt Gray #include <linux/spinlock.h> 301ceacea2SWilliam Breathitt Gray 3186ea8a95SWilliam Breathitt Gray #define IDIO_16_EXTENT 8 3286ea8a95SWilliam Breathitt Gray #define MAX_NUM_IDIO_16 max_num_isa_dev(IDIO_16_EXTENT) 3386ea8a95SWilliam Breathitt Gray 3486ea8a95SWilliam Breathitt Gray static unsigned int base[MAX_NUM_IDIO_16]; 3586ea8a95SWilliam Breathitt Gray static unsigned int num_idio_16; 3686ea8a95SWilliam Breathitt Gray module_param_array(base, uint, &num_idio_16, 0); 3786ea8a95SWilliam Breathitt Gray MODULE_PARM_DESC(base, "ACCES 104-IDIO-16 base addresses"); 3886ea8a95SWilliam Breathitt Gray 3986ea8a95SWilliam Breathitt Gray static unsigned int irq[MAX_NUM_IDIO_16]; 4086ea8a95SWilliam Breathitt Gray module_param_array(irq, uint, NULL, 0); 4186ea8a95SWilliam Breathitt Gray MODULE_PARM_DESC(irq, "ACCES 104-IDIO-16 interrupt line numbers"); 421ceacea2SWilliam Breathitt Gray 431ceacea2SWilliam Breathitt Gray /** 441ceacea2SWilliam Breathitt Gray * struct idio_16_gpio - GPIO device private data structure 451ceacea2SWilliam Breathitt Gray * @chip: instance of the gpio_chip 46a1184147SWilliam Breathitt Gray * @lock: synchronization lock to prevent I/O race conditions 47a1184147SWilliam Breathitt Gray * @irq_mask: I/O bits affected by interrupts 481ceacea2SWilliam Breathitt Gray * @base: base port address of the GPIO device 49a1184147SWilliam Breathitt Gray * @irq: Interrupt line number 501ceacea2SWilliam Breathitt Gray * @out_state: output bits state 511ceacea2SWilliam Breathitt Gray */ 521ceacea2SWilliam Breathitt Gray struct idio_16_gpio { 531ceacea2SWilliam Breathitt Gray struct gpio_chip chip; 541ceacea2SWilliam Breathitt Gray spinlock_t lock; 55a1184147SWilliam Breathitt Gray unsigned long irq_mask; 561ceacea2SWilliam Breathitt Gray unsigned base; 57a1184147SWilliam Breathitt Gray unsigned irq; 581ceacea2SWilliam Breathitt Gray unsigned out_state; 591ceacea2SWilliam Breathitt Gray }; 601ceacea2SWilliam Breathitt Gray 611ceacea2SWilliam Breathitt Gray static int idio_16_gpio_get_direction(struct gpio_chip *chip, unsigned offset) 621ceacea2SWilliam Breathitt Gray { 631ceacea2SWilliam Breathitt Gray if (offset > 15) 641ceacea2SWilliam Breathitt Gray return 1; 651ceacea2SWilliam Breathitt Gray 661ceacea2SWilliam Breathitt Gray return 0; 671ceacea2SWilliam Breathitt Gray } 681ceacea2SWilliam Breathitt Gray 691ceacea2SWilliam Breathitt Gray static int idio_16_gpio_direction_input(struct gpio_chip *chip, unsigned offset) 701ceacea2SWilliam Breathitt Gray { 711ceacea2SWilliam Breathitt Gray return 0; 721ceacea2SWilliam Breathitt Gray } 731ceacea2SWilliam Breathitt Gray 741ceacea2SWilliam Breathitt Gray static int idio_16_gpio_direction_output(struct gpio_chip *chip, 751ceacea2SWilliam Breathitt Gray unsigned offset, int value) 761ceacea2SWilliam Breathitt Gray { 771ceacea2SWilliam Breathitt Gray chip->set(chip, offset, value); 781ceacea2SWilliam Breathitt Gray return 0; 791ceacea2SWilliam Breathitt Gray } 801ceacea2SWilliam Breathitt Gray 811ceacea2SWilliam Breathitt Gray static int idio_16_gpio_get(struct gpio_chip *chip, unsigned offset) 821ceacea2SWilliam Breathitt Gray { 83d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 846e0171b4SWilliam Breathitt Gray const unsigned mask = BIT(offset-16); 851ceacea2SWilliam Breathitt Gray 861ceacea2SWilliam Breathitt Gray if (offset < 16) 871ceacea2SWilliam Breathitt Gray return -EINVAL; 881ceacea2SWilliam Breathitt Gray 891ceacea2SWilliam Breathitt Gray if (offset < 24) 906e0171b4SWilliam Breathitt Gray return !!(inb(idio16gpio->base + 1) & mask); 911ceacea2SWilliam Breathitt Gray 926e0171b4SWilliam Breathitt Gray return !!(inb(idio16gpio->base + 5) & (mask>>8)); 931ceacea2SWilliam Breathitt Gray } 941ceacea2SWilliam Breathitt Gray 951ceacea2SWilliam Breathitt Gray static void idio_16_gpio_set(struct gpio_chip *chip, unsigned offset, int value) 961ceacea2SWilliam Breathitt Gray { 97d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 986e0171b4SWilliam Breathitt Gray const unsigned mask = BIT(offset); 991ceacea2SWilliam Breathitt Gray unsigned long flags; 1001ceacea2SWilliam Breathitt Gray 1011ceacea2SWilliam Breathitt Gray if (offset > 15) 1021ceacea2SWilliam Breathitt Gray return; 1031ceacea2SWilliam Breathitt Gray 1041ceacea2SWilliam Breathitt Gray spin_lock_irqsave(&idio16gpio->lock, flags); 1051ceacea2SWilliam Breathitt Gray 1061ceacea2SWilliam Breathitt Gray if (value) 1076e0171b4SWilliam Breathitt Gray idio16gpio->out_state |= mask; 1081ceacea2SWilliam Breathitt Gray else 1096e0171b4SWilliam Breathitt Gray idio16gpio->out_state &= ~mask; 1101ceacea2SWilliam Breathitt Gray 1111ceacea2SWilliam Breathitt Gray if (offset > 7) 1121ceacea2SWilliam Breathitt Gray outb(idio16gpio->out_state >> 8, idio16gpio->base + 4); 1131ceacea2SWilliam Breathitt Gray else 1141ceacea2SWilliam Breathitt Gray outb(idio16gpio->out_state, idio16gpio->base); 1151ceacea2SWilliam Breathitt Gray 1161ceacea2SWilliam Breathitt Gray spin_unlock_irqrestore(&idio16gpio->lock, flags); 1171ceacea2SWilliam Breathitt Gray } 1181ceacea2SWilliam Breathitt Gray 119a1184147SWilliam Breathitt Gray static void idio_16_irq_ack(struct irq_data *data) 120a1184147SWilliam Breathitt Gray { 121a1184147SWilliam Breathitt Gray } 122a1184147SWilliam Breathitt Gray 123a1184147SWilliam Breathitt Gray static void idio_16_irq_mask(struct irq_data *data) 124a1184147SWilliam Breathitt Gray { 125a1184147SWilliam Breathitt Gray struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 126d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 127a1184147SWilliam Breathitt Gray const unsigned long mask = BIT(irqd_to_hwirq(data)); 128a1184147SWilliam Breathitt Gray unsigned long flags; 129a1184147SWilliam Breathitt Gray 130a1184147SWilliam Breathitt Gray idio16gpio->irq_mask &= ~mask; 131a1184147SWilliam Breathitt Gray 132a1184147SWilliam Breathitt Gray if (!idio16gpio->irq_mask) { 133a1184147SWilliam Breathitt Gray spin_lock_irqsave(&idio16gpio->lock, flags); 134a1184147SWilliam Breathitt Gray 135a1184147SWilliam Breathitt Gray outb(0, idio16gpio->base + 2); 136a1184147SWilliam Breathitt Gray 137a1184147SWilliam Breathitt Gray spin_unlock_irqrestore(&idio16gpio->lock, flags); 138a1184147SWilliam Breathitt Gray } 139a1184147SWilliam Breathitt Gray } 140a1184147SWilliam Breathitt Gray 141a1184147SWilliam Breathitt Gray static void idio_16_irq_unmask(struct irq_data *data) 142a1184147SWilliam Breathitt Gray { 143a1184147SWilliam Breathitt Gray struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 144d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 145a1184147SWilliam Breathitt Gray const unsigned long mask = BIT(irqd_to_hwirq(data)); 146a1184147SWilliam Breathitt Gray const unsigned long prev_irq_mask = idio16gpio->irq_mask; 147a1184147SWilliam Breathitt Gray unsigned long flags; 148a1184147SWilliam Breathitt Gray 149a1184147SWilliam Breathitt Gray idio16gpio->irq_mask |= mask; 150a1184147SWilliam Breathitt Gray 151a1184147SWilliam Breathitt Gray if (!prev_irq_mask) { 152a1184147SWilliam Breathitt Gray spin_lock_irqsave(&idio16gpio->lock, flags); 153a1184147SWilliam Breathitt Gray 154a1184147SWilliam Breathitt Gray inb(idio16gpio->base + 2); 155a1184147SWilliam Breathitt Gray 156a1184147SWilliam Breathitt Gray spin_unlock_irqrestore(&idio16gpio->lock, flags); 157a1184147SWilliam Breathitt Gray } 158a1184147SWilliam Breathitt Gray } 159a1184147SWilliam Breathitt Gray 160a1184147SWilliam Breathitt Gray static int idio_16_irq_set_type(struct irq_data *data, unsigned flow_type) 161a1184147SWilliam Breathitt Gray { 162a1184147SWilliam Breathitt Gray /* The only valid irq types are none and both-edges */ 163a1184147SWilliam Breathitt Gray if (flow_type != IRQ_TYPE_NONE && 164a1184147SWilliam Breathitt Gray (flow_type & IRQ_TYPE_EDGE_BOTH) != IRQ_TYPE_EDGE_BOTH) 165a1184147SWilliam Breathitt Gray return -EINVAL; 166a1184147SWilliam Breathitt Gray 167a1184147SWilliam Breathitt Gray return 0; 168a1184147SWilliam Breathitt Gray } 169a1184147SWilliam Breathitt Gray 170a1184147SWilliam Breathitt Gray static struct irq_chip idio_16_irqchip = { 171a1184147SWilliam Breathitt Gray .name = "104-idio-16", 172a1184147SWilliam Breathitt Gray .irq_ack = idio_16_irq_ack, 173a1184147SWilliam Breathitt Gray .irq_mask = idio_16_irq_mask, 174a1184147SWilliam Breathitt Gray .irq_unmask = idio_16_irq_unmask, 175a1184147SWilliam Breathitt Gray .irq_set_type = idio_16_irq_set_type 176a1184147SWilliam Breathitt Gray }; 177a1184147SWilliam Breathitt Gray 178a1184147SWilliam Breathitt Gray static irqreturn_t idio_16_irq_handler(int irq, void *dev_id) 179a1184147SWilliam Breathitt Gray { 180a1184147SWilliam Breathitt Gray struct idio_16_gpio *const idio16gpio = dev_id; 181a1184147SWilliam Breathitt Gray struct gpio_chip *const chip = &idio16gpio->chip; 182a1184147SWilliam Breathitt Gray int gpio; 183a1184147SWilliam Breathitt Gray 184a1184147SWilliam Breathitt Gray for_each_set_bit(gpio, &idio16gpio->irq_mask, chip->ngpio) 185a1184147SWilliam Breathitt Gray generic_handle_irq(irq_find_mapping(chip->irqdomain, gpio)); 186a1184147SWilliam Breathitt Gray 18712b61c9dSWilliam Breathitt Gray spin_lock(&idio16gpio->lock); 18812b61c9dSWilliam Breathitt Gray 18912b61c9dSWilliam Breathitt Gray outb(0, idio16gpio->base + 1); 19012b61c9dSWilliam Breathitt Gray 19112b61c9dSWilliam Breathitt Gray spin_unlock(&idio16gpio->lock); 19212b61c9dSWilliam Breathitt Gray 193a1184147SWilliam Breathitt Gray return IRQ_HANDLED; 194a1184147SWilliam Breathitt Gray } 195a1184147SWilliam Breathitt Gray 19686ea8a95SWilliam Breathitt Gray static int idio_16_probe(struct device *dev, unsigned int id) 1971ceacea2SWilliam Breathitt Gray { 1981ceacea2SWilliam Breathitt Gray struct idio_16_gpio *idio16gpio; 1996e0171b4SWilliam Breathitt Gray const char *const name = dev_name(dev); 2001ceacea2SWilliam Breathitt Gray int err; 2011ceacea2SWilliam Breathitt Gray 2021ceacea2SWilliam Breathitt Gray idio16gpio = devm_kzalloc(dev, sizeof(*idio16gpio), GFP_KERNEL); 2031ceacea2SWilliam Breathitt Gray if (!idio16gpio) 2041ceacea2SWilliam Breathitt Gray return -ENOMEM; 2051ceacea2SWilliam Breathitt Gray 20686ea8a95SWilliam Breathitt Gray if (!devm_request_region(dev, base[id], IDIO_16_EXTENT, name)) { 207cb32389cSWilliam Breathitt Gray dev_err(dev, "Unable to lock port addresses (0x%X-0x%X)\n", 20886ea8a95SWilliam Breathitt Gray base[id], base[id] + IDIO_16_EXTENT); 209cb32389cSWilliam Breathitt Gray return -EBUSY; 2101ceacea2SWilliam Breathitt Gray } 2111ceacea2SWilliam Breathitt Gray 2126e0171b4SWilliam Breathitt Gray idio16gpio->chip.label = name; 21358383c78SLinus Walleij idio16gpio->chip.parent = dev; 2141ceacea2SWilliam Breathitt Gray idio16gpio->chip.owner = THIS_MODULE; 2151ceacea2SWilliam Breathitt Gray idio16gpio->chip.base = -1; 2161ceacea2SWilliam Breathitt Gray idio16gpio->chip.ngpio = 32; 2171ceacea2SWilliam Breathitt Gray idio16gpio->chip.get_direction = idio_16_gpio_get_direction; 2181ceacea2SWilliam Breathitt Gray idio16gpio->chip.direction_input = idio_16_gpio_direction_input; 2191ceacea2SWilliam Breathitt Gray idio16gpio->chip.direction_output = idio_16_gpio_direction_output; 2201ceacea2SWilliam Breathitt Gray idio16gpio->chip.get = idio_16_gpio_get; 2211ceacea2SWilliam Breathitt Gray idio16gpio->chip.set = idio_16_gpio_set; 22286ea8a95SWilliam Breathitt Gray idio16gpio->base = base[id]; 22386ea8a95SWilliam Breathitt Gray idio16gpio->irq = irq[id]; 2241ceacea2SWilliam Breathitt Gray idio16gpio->out_state = 0xFFFF; 2251ceacea2SWilliam Breathitt Gray 2261ceacea2SWilliam Breathitt Gray spin_lock_init(&idio16gpio->lock); 2271ceacea2SWilliam Breathitt Gray 2281ceacea2SWilliam Breathitt Gray dev_set_drvdata(dev, idio16gpio); 2291ceacea2SWilliam Breathitt Gray 230d602ae90SLinus Walleij err = gpiochip_add_data(&idio16gpio->chip, idio16gpio); 2311ceacea2SWilliam Breathitt Gray if (err) { 2321ceacea2SWilliam Breathitt Gray dev_err(dev, "GPIO registering failed (%d)\n", err); 233cb32389cSWilliam Breathitt Gray return err; 2341ceacea2SWilliam Breathitt Gray } 2351ceacea2SWilliam Breathitt Gray 236fb50cdfeSWilliam Breathitt Gray /* Disable IRQ by default */ 23786ea8a95SWilliam Breathitt Gray outb(0, base[id] + 2); 23886ea8a95SWilliam Breathitt Gray outb(0, base[id] + 1); 239fb50cdfeSWilliam Breathitt Gray 240a1184147SWilliam Breathitt Gray err = gpiochip_irqchip_add(&idio16gpio->chip, &idio_16_irqchip, 0, 241a1184147SWilliam Breathitt Gray handle_edge_irq, IRQ_TYPE_NONE); 242a1184147SWilliam Breathitt Gray if (err) { 243a1184147SWilliam Breathitt Gray dev_err(dev, "Could not add irqchip (%d)\n", err); 244cb32389cSWilliam Breathitt Gray goto err_gpiochip_remove; 245a1184147SWilliam Breathitt Gray } 246a1184147SWilliam Breathitt Gray 24786ea8a95SWilliam Breathitt Gray err = request_irq(irq[id], idio_16_irq_handler, 0, name, idio16gpio); 248a1184147SWilliam Breathitt Gray if (err) { 249a1184147SWilliam Breathitt Gray dev_err(dev, "IRQ handler registering failed (%d)\n", err); 250cb32389cSWilliam Breathitt Gray goto err_gpiochip_remove; 251a1184147SWilliam Breathitt Gray } 252a1184147SWilliam Breathitt Gray 2531ceacea2SWilliam Breathitt Gray return 0; 2541ceacea2SWilliam Breathitt Gray 255cb32389cSWilliam Breathitt Gray err_gpiochip_remove: 256a1184147SWilliam Breathitt Gray gpiochip_remove(&idio16gpio->chip); 2571ceacea2SWilliam Breathitt Gray return err; 2581ceacea2SWilliam Breathitt Gray } 2591ceacea2SWilliam Breathitt Gray 26086ea8a95SWilliam Breathitt Gray static int idio_16_remove(struct device *dev, unsigned int id) 2611ceacea2SWilliam Breathitt Gray { 26286ea8a95SWilliam Breathitt Gray struct idio_16_gpio *const idio16gpio = dev_get_drvdata(dev); 2631ceacea2SWilliam Breathitt Gray 264a1184147SWilliam Breathitt Gray free_irq(idio16gpio->irq, idio16gpio); 2651ceacea2SWilliam Breathitt Gray gpiochip_remove(&idio16gpio->chip); 2661ceacea2SWilliam Breathitt Gray 2671ceacea2SWilliam Breathitt Gray return 0; 2681ceacea2SWilliam Breathitt Gray } 2691ceacea2SWilliam Breathitt Gray 27086ea8a95SWilliam Breathitt Gray static struct isa_driver idio_16_driver = { 27186ea8a95SWilliam Breathitt Gray .probe = idio_16_probe, 2721ceacea2SWilliam Breathitt Gray .driver = { 2731ceacea2SWilliam Breathitt Gray .name = "104-idio-16" 2741ceacea2SWilliam Breathitt Gray }, 2751ceacea2SWilliam Breathitt Gray .remove = idio_16_remove 2761ceacea2SWilliam Breathitt Gray }; 2771ceacea2SWilliam Breathitt Gray 27886ea8a95SWilliam Breathitt Gray module_isa_driver(idio_16_driver, num_idio_16); 2791ceacea2SWilliam Breathitt Gray 2801ceacea2SWilliam Breathitt Gray MODULE_AUTHOR("William Breathitt Gray <vilhelm.gray@gmail.com>"); 2811ceacea2SWilliam Breathitt Gray MODULE_DESCRIPTION("ACCES 104-IDIO-16 GPIO driver"); 28222aeddb5SWilliam Breathitt Gray MODULE_LICENSE("GPL v2"); 283