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. 131ceacea2SWilliam Breathitt Gray */ 14a1184147SWilliam Breathitt Gray #include <linux/bitops.h> 151ceacea2SWilliam Breathitt Gray #include <linux/device.h> 161ceacea2SWilliam Breathitt Gray #include <linux/errno.h> 171ceacea2SWilliam Breathitt Gray #include <linux/gpio/driver.h> 181ceacea2SWilliam Breathitt Gray #include <linux/io.h> 191ceacea2SWilliam Breathitt Gray #include <linux/ioport.h> 20a1184147SWilliam Breathitt Gray #include <linux/interrupt.h> 21a1184147SWilliam Breathitt Gray #include <linux/irqdesc.h> 221ceacea2SWilliam Breathitt Gray #include <linux/kernel.h> 231ceacea2SWilliam Breathitt Gray #include <linux/module.h> 241ceacea2SWilliam Breathitt Gray #include <linux/moduleparam.h> 251ceacea2SWilliam Breathitt Gray #include <linux/platform_device.h> 261ceacea2SWilliam Breathitt Gray #include <linux/spinlock.h> 271ceacea2SWilliam Breathitt Gray 281ceacea2SWilliam Breathitt Gray static unsigned idio_16_base; 291ceacea2SWilliam Breathitt Gray module_param(idio_16_base, uint, 0); 301ceacea2SWilliam Breathitt Gray MODULE_PARM_DESC(idio_16_base, "ACCES 104-IDIO-16 base address"); 31a1184147SWilliam Breathitt Gray static unsigned idio_16_irq; 32a1184147SWilliam Breathitt Gray module_param(idio_16_irq, uint, 0); 33a1184147SWilliam Breathitt Gray MODULE_PARM_DESC(idio_16_irq, "ACCES 104-IDIO-16 interrupt line number"); 341ceacea2SWilliam Breathitt Gray 351ceacea2SWilliam Breathitt Gray /** 361ceacea2SWilliam Breathitt Gray * struct idio_16_gpio - GPIO device private data structure 371ceacea2SWilliam Breathitt Gray * @chip: instance of the gpio_chip 38a1184147SWilliam Breathitt Gray * @lock: synchronization lock to prevent I/O race conditions 39a1184147SWilliam Breathitt Gray * @irq_mask: I/O bits affected by interrupts 401ceacea2SWilliam Breathitt Gray * @base: base port address of the GPIO device 41a1184147SWilliam Breathitt Gray * @irq: Interrupt line number 421ceacea2SWilliam Breathitt Gray * @out_state: output bits state 431ceacea2SWilliam Breathitt Gray */ 441ceacea2SWilliam Breathitt Gray struct idio_16_gpio { 451ceacea2SWilliam Breathitt Gray struct gpio_chip chip; 461ceacea2SWilliam Breathitt Gray spinlock_t lock; 47a1184147SWilliam Breathitt Gray unsigned long irq_mask; 481ceacea2SWilliam Breathitt Gray unsigned base; 49a1184147SWilliam Breathitt Gray unsigned irq; 501ceacea2SWilliam Breathitt Gray unsigned out_state; 511ceacea2SWilliam Breathitt Gray }; 521ceacea2SWilliam Breathitt Gray 531ceacea2SWilliam Breathitt Gray static int idio_16_gpio_get_direction(struct gpio_chip *chip, unsigned offset) 541ceacea2SWilliam Breathitt Gray { 551ceacea2SWilliam Breathitt Gray if (offset > 15) 561ceacea2SWilliam Breathitt Gray return 1; 571ceacea2SWilliam Breathitt Gray 581ceacea2SWilliam Breathitt Gray return 0; 591ceacea2SWilliam Breathitt Gray } 601ceacea2SWilliam Breathitt Gray 611ceacea2SWilliam Breathitt Gray static int idio_16_gpio_direction_input(struct gpio_chip *chip, unsigned offset) 621ceacea2SWilliam Breathitt Gray { 631ceacea2SWilliam Breathitt Gray return 0; 641ceacea2SWilliam Breathitt Gray } 651ceacea2SWilliam Breathitt Gray 661ceacea2SWilliam Breathitt Gray static int idio_16_gpio_direction_output(struct gpio_chip *chip, 671ceacea2SWilliam Breathitt Gray unsigned offset, int value) 681ceacea2SWilliam Breathitt Gray { 691ceacea2SWilliam Breathitt Gray chip->set(chip, offset, value); 701ceacea2SWilliam Breathitt Gray return 0; 711ceacea2SWilliam Breathitt Gray } 721ceacea2SWilliam Breathitt Gray 731ceacea2SWilliam Breathitt Gray static int idio_16_gpio_get(struct gpio_chip *chip, unsigned offset) 741ceacea2SWilliam Breathitt Gray { 75d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 766e0171b4SWilliam Breathitt Gray const unsigned mask = BIT(offset-16); 771ceacea2SWilliam Breathitt Gray 781ceacea2SWilliam Breathitt Gray if (offset < 16) 791ceacea2SWilliam Breathitt Gray return -EINVAL; 801ceacea2SWilliam Breathitt Gray 811ceacea2SWilliam Breathitt Gray if (offset < 24) 826e0171b4SWilliam Breathitt Gray return !!(inb(idio16gpio->base + 1) & mask); 831ceacea2SWilliam Breathitt Gray 846e0171b4SWilliam Breathitt Gray return !!(inb(idio16gpio->base + 5) & (mask>>8)); 851ceacea2SWilliam Breathitt Gray } 861ceacea2SWilliam Breathitt Gray 871ceacea2SWilliam Breathitt Gray static void idio_16_gpio_set(struct gpio_chip *chip, unsigned offset, int value) 881ceacea2SWilliam Breathitt Gray { 89d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 906e0171b4SWilliam Breathitt Gray const unsigned mask = BIT(offset); 911ceacea2SWilliam Breathitt Gray unsigned long flags; 921ceacea2SWilliam Breathitt Gray 931ceacea2SWilliam Breathitt Gray if (offset > 15) 941ceacea2SWilliam Breathitt Gray return; 951ceacea2SWilliam Breathitt Gray 961ceacea2SWilliam Breathitt Gray spin_lock_irqsave(&idio16gpio->lock, flags); 971ceacea2SWilliam Breathitt Gray 981ceacea2SWilliam Breathitt Gray if (value) 996e0171b4SWilliam Breathitt Gray idio16gpio->out_state |= mask; 1001ceacea2SWilliam Breathitt Gray else 1016e0171b4SWilliam Breathitt Gray idio16gpio->out_state &= ~mask; 1021ceacea2SWilliam Breathitt Gray 1031ceacea2SWilliam Breathitt Gray if (offset > 7) 1041ceacea2SWilliam Breathitt Gray outb(idio16gpio->out_state >> 8, idio16gpio->base + 4); 1051ceacea2SWilliam Breathitt Gray else 1061ceacea2SWilliam Breathitt Gray outb(idio16gpio->out_state, idio16gpio->base); 1071ceacea2SWilliam Breathitt Gray 1081ceacea2SWilliam Breathitt Gray spin_unlock_irqrestore(&idio16gpio->lock, flags); 1091ceacea2SWilliam Breathitt Gray } 1101ceacea2SWilliam Breathitt Gray 111a1184147SWilliam Breathitt Gray static void idio_16_irq_ack(struct irq_data *data) 112a1184147SWilliam Breathitt Gray { 113a1184147SWilliam Breathitt Gray } 114a1184147SWilliam Breathitt Gray 115a1184147SWilliam Breathitt Gray static void idio_16_irq_mask(struct irq_data *data) 116a1184147SWilliam Breathitt Gray { 117a1184147SWilliam Breathitt Gray struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 118d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 119a1184147SWilliam Breathitt Gray const unsigned long mask = BIT(irqd_to_hwirq(data)); 120a1184147SWilliam Breathitt Gray unsigned long flags; 121a1184147SWilliam Breathitt Gray 122a1184147SWilliam Breathitt Gray idio16gpio->irq_mask &= ~mask; 123a1184147SWilliam Breathitt Gray 124a1184147SWilliam Breathitt Gray if (!idio16gpio->irq_mask) { 125a1184147SWilliam Breathitt Gray spin_lock_irqsave(&idio16gpio->lock, flags); 126a1184147SWilliam Breathitt Gray 127a1184147SWilliam Breathitt Gray outb(0, idio16gpio->base + 2); 128a1184147SWilliam Breathitt Gray 129a1184147SWilliam Breathitt Gray spin_unlock_irqrestore(&idio16gpio->lock, flags); 130a1184147SWilliam Breathitt Gray } 131a1184147SWilliam Breathitt Gray } 132a1184147SWilliam Breathitt Gray 133a1184147SWilliam Breathitt Gray static void idio_16_irq_unmask(struct irq_data *data) 134a1184147SWilliam Breathitt Gray { 135a1184147SWilliam Breathitt Gray struct gpio_chip *chip = irq_data_get_irq_chip_data(data); 136d602ae90SLinus Walleij struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); 137a1184147SWilliam Breathitt Gray const unsigned long mask = BIT(irqd_to_hwirq(data)); 138a1184147SWilliam Breathitt Gray const unsigned long prev_irq_mask = idio16gpio->irq_mask; 139a1184147SWilliam Breathitt Gray unsigned long flags; 140a1184147SWilliam Breathitt Gray 141a1184147SWilliam Breathitt Gray idio16gpio->irq_mask |= mask; 142a1184147SWilliam Breathitt Gray 143a1184147SWilliam Breathitt Gray if (!prev_irq_mask) { 144a1184147SWilliam Breathitt Gray spin_lock_irqsave(&idio16gpio->lock, flags); 145a1184147SWilliam Breathitt Gray 146a1184147SWilliam Breathitt Gray inb(idio16gpio->base + 2); 147a1184147SWilliam Breathitt Gray 148a1184147SWilliam Breathitt Gray spin_unlock_irqrestore(&idio16gpio->lock, flags); 149a1184147SWilliam Breathitt Gray } 150a1184147SWilliam Breathitt Gray } 151a1184147SWilliam Breathitt Gray 152a1184147SWilliam Breathitt Gray static int idio_16_irq_set_type(struct irq_data *data, unsigned flow_type) 153a1184147SWilliam Breathitt Gray { 154a1184147SWilliam Breathitt Gray /* The only valid irq types are none and both-edges */ 155a1184147SWilliam Breathitt Gray if (flow_type != IRQ_TYPE_NONE && 156a1184147SWilliam Breathitt Gray (flow_type & IRQ_TYPE_EDGE_BOTH) != IRQ_TYPE_EDGE_BOTH) 157a1184147SWilliam Breathitt Gray return -EINVAL; 158a1184147SWilliam Breathitt Gray 159a1184147SWilliam Breathitt Gray return 0; 160a1184147SWilliam Breathitt Gray } 161a1184147SWilliam Breathitt Gray 162a1184147SWilliam Breathitt Gray static struct irq_chip idio_16_irqchip = { 163a1184147SWilliam Breathitt Gray .name = "104-idio-16", 164a1184147SWilliam Breathitt Gray .irq_ack = idio_16_irq_ack, 165a1184147SWilliam Breathitt Gray .irq_mask = idio_16_irq_mask, 166a1184147SWilliam Breathitt Gray .irq_unmask = idio_16_irq_unmask, 167a1184147SWilliam Breathitt Gray .irq_set_type = idio_16_irq_set_type 168a1184147SWilliam Breathitt Gray }; 169a1184147SWilliam Breathitt Gray 170a1184147SWilliam Breathitt Gray static irqreturn_t idio_16_irq_handler(int irq, void *dev_id) 171a1184147SWilliam Breathitt Gray { 172a1184147SWilliam Breathitt Gray struct idio_16_gpio *const idio16gpio = dev_id; 173a1184147SWilliam Breathitt Gray struct gpio_chip *const chip = &idio16gpio->chip; 174a1184147SWilliam Breathitt Gray int gpio; 175a1184147SWilliam Breathitt Gray 176a1184147SWilliam Breathitt Gray for_each_set_bit(gpio, &idio16gpio->irq_mask, chip->ngpio) 177a1184147SWilliam Breathitt Gray generic_handle_irq(irq_find_mapping(chip->irqdomain, gpio)); 178a1184147SWilliam Breathitt Gray 17912b61c9dSWilliam Breathitt Gray spin_lock(&idio16gpio->lock); 18012b61c9dSWilliam Breathitt Gray 18112b61c9dSWilliam Breathitt Gray outb(0, idio16gpio->base + 1); 18212b61c9dSWilliam Breathitt Gray 18312b61c9dSWilliam Breathitt Gray spin_unlock(&idio16gpio->lock); 18412b61c9dSWilliam Breathitt Gray 185a1184147SWilliam Breathitt Gray return IRQ_HANDLED; 186a1184147SWilliam Breathitt Gray } 187a1184147SWilliam Breathitt Gray 1881ceacea2SWilliam Breathitt Gray static int __init idio_16_probe(struct platform_device *pdev) 1891ceacea2SWilliam Breathitt Gray { 1901ceacea2SWilliam Breathitt Gray struct device *dev = &pdev->dev; 1911ceacea2SWilliam Breathitt Gray struct idio_16_gpio *idio16gpio; 1926e0171b4SWilliam Breathitt Gray const unsigned base = idio_16_base; 1936e0171b4SWilliam Breathitt Gray const unsigned extent = 8; 1946e0171b4SWilliam Breathitt Gray const char *const name = dev_name(dev); 1951ceacea2SWilliam Breathitt Gray int err; 1966e0171b4SWilliam Breathitt Gray const unsigned irq = idio_16_irq; 1971ceacea2SWilliam Breathitt Gray 1981ceacea2SWilliam Breathitt Gray idio16gpio = devm_kzalloc(dev, sizeof(*idio16gpio), GFP_KERNEL); 1991ceacea2SWilliam Breathitt Gray if (!idio16gpio) 2001ceacea2SWilliam Breathitt Gray return -ENOMEM; 2011ceacea2SWilliam Breathitt Gray 202cb32389cSWilliam Breathitt Gray if (!devm_request_region(dev, base, extent, name)) { 203cb32389cSWilliam Breathitt Gray dev_err(dev, "Unable to lock port addresses (0x%X-0x%X)\n", 204cb32389cSWilliam Breathitt Gray base, base + extent); 205cb32389cSWilliam Breathitt Gray return -EBUSY; 2061ceacea2SWilliam Breathitt Gray } 2071ceacea2SWilliam Breathitt Gray 2086e0171b4SWilliam Breathitt Gray idio16gpio->chip.label = name; 20958383c78SLinus Walleij idio16gpio->chip.parent = dev; 2101ceacea2SWilliam Breathitt Gray idio16gpio->chip.owner = THIS_MODULE; 2111ceacea2SWilliam Breathitt Gray idio16gpio->chip.base = -1; 2121ceacea2SWilliam Breathitt Gray idio16gpio->chip.ngpio = 32; 2131ceacea2SWilliam Breathitt Gray idio16gpio->chip.get_direction = idio_16_gpio_get_direction; 2141ceacea2SWilliam Breathitt Gray idio16gpio->chip.direction_input = idio_16_gpio_direction_input; 2151ceacea2SWilliam Breathitt Gray idio16gpio->chip.direction_output = idio_16_gpio_direction_output; 2161ceacea2SWilliam Breathitt Gray idio16gpio->chip.get = idio_16_gpio_get; 2171ceacea2SWilliam Breathitt Gray idio16gpio->chip.set = idio_16_gpio_set; 2186e0171b4SWilliam Breathitt Gray idio16gpio->base = base; 2196e0171b4SWilliam Breathitt Gray idio16gpio->irq = irq; 2201ceacea2SWilliam Breathitt Gray idio16gpio->out_state = 0xFFFF; 2211ceacea2SWilliam Breathitt Gray 2221ceacea2SWilliam Breathitt Gray spin_lock_init(&idio16gpio->lock); 2231ceacea2SWilliam Breathitt Gray 2241ceacea2SWilliam Breathitt Gray dev_set_drvdata(dev, idio16gpio); 2251ceacea2SWilliam Breathitt Gray 226d602ae90SLinus Walleij err = gpiochip_add_data(&idio16gpio->chip, idio16gpio); 2271ceacea2SWilliam Breathitt Gray if (err) { 2281ceacea2SWilliam Breathitt Gray dev_err(dev, "GPIO registering failed (%d)\n", err); 229cb32389cSWilliam Breathitt Gray return err; 2301ceacea2SWilliam Breathitt Gray } 2311ceacea2SWilliam Breathitt Gray 232fb50cdfeSWilliam Breathitt Gray /* Disable IRQ by default */ 233fb50cdfeSWilliam Breathitt Gray outb(0, base + 2); 23412b61c9dSWilliam Breathitt Gray outb(0, base + 1); 235fb50cdfeSWilliam Breathitt Gray 236a1184147SWilliam Breathitt Gray err = gpiochip_irqchip_add(&idio16gpio->chip, &idio_16_irqchip, 0, 237a1184147SWilliam Breathitt Gray handle_edge_irq, IRQ_TYPE_NONE); 238a1184147SWilliam Breathitt Gray if (err) { 239a1184147SWilliam Breathitt Gray dev_err(dev, "Could not add irqchip (%d)\n", err); 240cb32389cSWilliam Breathitt Gray goto err_gpiochip_remove; 241a1184147SWilliam Breathitt Gray } 242a1184147SWilliam Breathitt Gray 2436e0171b4SWilliam Breathitt Gray err = request_irq(irq, idio_16_irq_handler, 0, name, idio16gpio); 244a1184147SWilliam Breathitt Gray if (err) { 245a1184147SWilliam Breathitt Gray dev_err(dev, "IRQ handler registering failed (%d)\n", err); 246cb32389cSWilliam Breathitt Gray goto err_gpiochip_remove; 247a1184147SWilliam Breathitt Gray } 248a1184147SWilliam Breathitt Gray 2491ceacea2SWilliam Breathitt Gray return 0; 2501ceacea2SWilliam Breathitt Gray 251cb32389cSWilliam Breathitt Gray err_gpiochip_remove: 252a1184147SWilliam Breathitt Gray gpiochip_remove(&idio16gpio->chip); 2531ceacea2SWilliam Breathitt Gray return err; 2541ceacea2SWilliam Breathitt Gray } 2551ceacea2SWilliam Breathitt Gray 2561ceacea2SWilliam Breathitt Gray static int idio_16_remove(struct platform_device *pdev) 2571ceacea2SWilliam Breathitt Gray { 2581ceacea2SWilliam Breathitt Gray struct idio_16_gpio *const idio16gpio = platform_get_drvdata(pdev); 2591ceacea2SWilliam Breathitt Gray 260a1184147SWilliam Breathitt Gray free_irq(idio16gpio->irq, idio16gpio); 2611ceacea2SWilliam Breathitt Gray gpiochip_remove(&idio16gpio->chip); 2621ceacea2SWilliam Breathitt Gray 2631ceacea2SWilliam Breathitt Gray return 0; 2641ceacea2SWilliam Breathitt Gray } 2651ceacea2SWilliam Breathitt Gray 2661ceacea2SWilliam Breathitt Gray static struct platform_device *idio_16_device; 2671ceacea2SWilliam Breathitt Gray 2681ceacea2SWilliam Breathitt Gray static struct platform_driver idio_16_driver = { 2691ceacea2SWilliam Breathitt Gray .driver = { 2701ceacea2SWilliam Breathitt Gray .name = "104-idio-16" 2711ceacea2SWilliam Breathitt Gray }, 2721ceacea2SWilliam Breathitt Gray .remove = idio_16_remove 2731ceacea2SWilliam Breathitt Gray }; 2741ceacea2SWilliam Breathitt Gray 2751ceacea2SWilliam Breathitt Gray static void __exit idio_16_exit(void) 2761ceacea2SWilliam Breathitt Gray { 2771ceacea2SWilliam Breathitt Gray platform_device_unregister(idio_16_device); 2781ceacea2SWilliam Breathitt Gray platform_driver_unregister(&idio_16_driver); 2791ceacea2SWilliam Breathitt Gray } 2801ceacea2SWilliam Breathitt Gray 2811ceacea2SWilliam Breathitt Gray static int __init idio_16_init(void) 2821ceacea2SWilliam Breathitt Gray { 2831ceacea2SWilliam Breathitt Gray int err; 2841ceacea2SWilliam Breathitt Gray 2851ceacea2SWilliam Breathitt Gray idio_16_device = platform_device_alloc(idio_16_driver.driver.name, -1); 2861ceacea2SWilliam Breathitt Gray if (!idio_16_device) 2871ceacea2SWilliam Breathitt Gray return -ENOMEM; 2881ceacea2SWilliam Breathitt Gray 2891ceacea2SWilliam Breathitt Gray err = platform_device_add(idio_16_device); 2901ceacea2SWilliam Breathitt Gray if (err) 2911ceacea2SWilliam Breathitt Gray goto err_platform_device; 2921ceacea2SWilliam Breathitt Gray 2931ceacea2SWilliam Breathitt Gray err = platform_driver_probe(&idio_16_driver, idio_16_probe); 2941ceacea2SWilliam Breathitt Gray if (err) 2951ceacea2SWilliam Breathitt Gray goto err_platform_driver; 2961ceacea2SWilliam Breathitt Gray 2971ceacea2SWilliam Breathitt Gray return 0; 2981ceacea2SWilliam Breathitt Gray 2991ceacea2SWilliam Breathitt Gray err_platform_driver: 3001ceacea2SWilliam Breathitt Gray platform_device_del(idio_16_device); 3011ceacea2SWilliam Breathitt Gray err_platform_device: 3021ceacea2SWilliam Breathitt Gray platform_device_put(idio_16_device); 3031ceacea2SWilliam Breathitt Gray return err; 3041ceacea2SWilliam Breathitt Gray } 3051ceacea2SWilliam Breathitt Gray 3061ceacea2SWilliam Breathitt Gray module_init(idio_16_init); 3071ceacea2SWilliam Breathitt Gray module_exit(idio_16_exit); 3081ceacea2SWilliam Breathitt Gray 3091ceacea2SWilliam Breathitt Gray MODULE_AUTHOR("William Breathitt Gray <vilhelm.gray@gmail.com>"); 3101ceacea2SWilliam Breathitt Gray MODULE_DESCRIPTION("ACCES 104-IDIO-16 GPIO driver"); 31122aeddb5SWilliam Breathitt Gray MODULE_LICENSE("GPL v2"); 312