1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * GPIO driver for the ACCES PCIe-IDIO-24 family 4 * Copyright (C) 2018 William Breathitt Gray 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 * This program is distributed in the hope that it will be useful, but 11 * WITHOUT ANY WARRANTY; without even the implied warranty of 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 13 * General Public License for more details. 14 * 15 * This driver supports the following ACCES devices: PCIe-IDIO-24, 16 * PCIe-IDI-24, PCIe-IDO-24, and PCIe-IDIO-12. 17 */ 18 #include <linux/bitmap.h> 19 #include <linux/bitops.h> 20 #include <linux/device.h> 21 #include <linux/errno.h> 22 #include <linux/gpio/driver.h> 23 #include <linux/interrupt.h> 24 #include <linux/irqdesc.h> 25 #include <linux/kernel.h> 26 #include <linux/module.h> 27 #include <linux/pci.h> 28 #include <linux/spinlock.h> 29 #include <linux/types.h> 30 31 /** 32 * struct idio_24_gpio_reg - GPIO device registers structure 33 * @out0_7: Read: FET Outputs 0-7 34 * Write: FET Outputs 0-7 35 * @out8_15: Read: FET Outputs 8-15 36 * Write: FET Outputs 8-15 37 * @out16_23: Read: FET Outputs 16-23 38 * Write: FET Outputs 16-23 39 * @ttl_out0_7: Read: TTL/CMOS Outputs 0-7 40 * Write: TTL/CMOS Outputs 0-7 41 * @in0_7: Read: Isolated Inputs 0-7 42 * Write: Reserved 43 * @in8_15: Read: Isolated Inputs 8-15 44 * Write: Reserved 45 * @in16_23: Read: Isolated Inputs 16-23 46 * Write: Reserved 47 * @ttl_in0_7: Read: TTL/CMOS Inputs 0-7 48 * Write: Reserved 49 * @cos0_7: Read: COS Status Inputs 0-7 50 * Write: COS Clear Inputs 0-7 51 * @cos8_15: Read: COS Status Inputs 8-15 52 * Write: COS Clear Inputs 8-15 53 * @cos16_23: Read: COS Status Inputs 16-23 54 * Write: COS Clear Inputs 16-23 55 * @cos_ttl0_7: Read: COS Status TTL/CMOS 0-7 56 * Write: COS Clear TTL/CMOS 0-7 57 * @ctl: Read: Control Register 58 * Write: Control Register 59 * @reserved: Read: Reserved 60 * Write: Reserved 61 * @cos_enable: Read: COS Enable 62 * Write: COS Enable 63 * @soft_reset: Read: IRQ Output Pin Status 64 * Write: Software Board Reset 65 */ 66 struct idio_24_gpio_reg { 67 u8 out0_7; 68 u8 out8_15; 69 u8 out16_23; 70 u8 ttl_out0_7; 71 u8 in0_7; 72 u8 in8_15; 73 u8 in16_23; 74 u8 ttl_in0_7; 75 u8 cos0_7; 76 u8 cos8_15; 77 u8 cos16_23; 78 u8 cos_ttl0_7; 79 u8 ctl; 80 u8 reserved; 81 u8 cos_enable; 82 u8 soft_reset; 83 }; 84 85 /** 86 * struct idio_24_gpio - GPIO device private data structure 87 * @chip: instance of the gpio_chip 88 * @lock: synchronization lock to prevent I/O race conditions 89 * @reg: I/O address offset for the GPIO device registers 90 * @irq_mask: I/O bits affected by interrupts 91 */ 92 struct idio_24_gpio { 93 struct gpio_chip chip; 94 raw_spinlock_t lock; 95 struct idio_24_gpio_reg __iomem *reg; 96 unsigned long irq_mask; 97 }; 98 99 static int idio_24_gpio_get_direction(struct gpio_chip *chip, 100 unsigned int offset) 101 { 102 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 103 const unsigned long out_mode_mask = BIT(1); 104 105 /* FET Outputs */ 106 if (offset < 24) 107 return 0; 108 109 /* Isolated Inputs */ 110 if (offset < 48) 111 return 1; 112 113 /* TTL/CMOS I/O */ 114 /* OUT MODE = 1 when TTL/CMOS Output Mode is set */ 115 return !(ioread8(&idio24gpio->reg->ctl) & out_mode_mask); 116 } 117 118 static int idio_24_gpio_direction_input(struct gpio_chip *chip, 119 unsigned int offset) 120 { 121 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 122 unsigned long flags; 123 unsigned int ctl_state; 124 const unsigned long out_mode_mask = BIT(1); 125 126 /* TTL/CMOS I/O */ 127 if (offset > 47) { 128 raw_spin_lock_irqsave(&idio24gpio->lock, flags); 129 130 /* Clear TTL/CMOS Output Mode */ 131 ctl_state = ioread8(&idio24gpio->reg->ctl) & ~out_mode_mask; 132 iowrite8(ctl_state, &idio24gpio->reg->ctl); 133 134 raw_spin_unlock_irqrestore(&idio24gpio->lock, flags); 135 } 136 137 return 0; 138 } 139 140 static int idio_24_gpio_direction_output(struct gpio_chip *chip, 141 unsigned int offset, int value) 142 { 143 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 144 unsigned long flags; 145 unsigned int ctl_state; 146 const unsigned long out_mode_mask = BIT(1); 147 148 /* TTL/CMOS I/O */ 149 if (offset > 47) { 150 raw_spin_lock_irqsave(&idio24gpio->lock, flags); 151 152 /* Set TTL/CMOS Output Mode */ 153 ctl_state = ioread8(&idio24gpio->reg->ctl) | out_mode_mask; 154 iowrite8(ctl_state, &idio24gpio->reg->ctl); 155 156 raw_spin_unlock_irqrestore(&idio24gpio->lock, flags); 157 } 158 159 chip->set(chip, offset, value); 160 return 0; 161 } 162 163 static int idio_24_gpio_get(struct gpio_chip *chip, unsigned int offset) 164 { 165 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 166 const unsigned long offset_mask = BIT(offset % 8); 167 const unsigned long out_mode_mask = BIT(1); 168 169 /* FET Outputs */ 170 if (offset < 8) 171 return !!(ioread8(&idio24gpio->reg->out0_7) & offset_mask); 172 173 if (offset < 16) 174 return !!(ioread8(&idio24gpio->reg->out8_15) & offset_mask); 175 176 if (offset < 24) 177 return !!(ioread8(&idio24gpio->reg->out16_23) & offset_mask); 178 179 /* Isolated Inputs */ 180 if (offset < 32) 181 return !!(ioread8(&idio24gpio->reg->in0_7) & offset_mask); 182 183 if (offset < 40) 184 return !!(ioread8(&idio24gpio->reg->in8_15) & offset_mask); 185 186 if (offset < 48) 187 return !!(ioread8(&idio24gpio->reg->in16_23) & offset_mask); 188 189 /* TTL/CMOS Outputs */ 190 if (ioread8(&idio24gpio->reg->ctl) & out_mode_mask) 191 return !!(ioread8(&idio24gpio->reg->ttl_out0_7) & offset_mask); 192 193 /* TTL/CMOS Inputs */ 194 return !!(ioread8(&idio24gpio->reg->ttl_in0_7) & offset_mask); 195 } 196 197 static int idio_24_gpio_get_multiple(struct gpio_chip *chip, 198 unsigned long *mask, unsigned long *bits) 199 { 200 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 201 size_t i; 202 const unsigned int gpio_reg_size = 8; 203 unsigned int bits_offset; 204 size_t word_index; 205 unsigned int word_offset; 206 unsigned long word_mask; 207 const unsigned long port_mask = GENMASK(gpio_reg_size - 1, 0); 208 unsigned long port_state; 209 void __iomem *ports[] = { 210 &idio24gpio->reg->out0_7, &idio24gpio->reg->out8_15, 211 &idio24gpio->reg->out16_23, &idio24gpio->reg->in0_7, 212 &idio24gpio->reg->in8_15, &idio24gpio->reg->in16_23, 213 }; 214 const unsigned long out_mode_mask = BIT(1); 215 216 /* clear bits array to a clean slate */ 217 bitmap_zero(bits, chip->ngpio); 218 219 /* get bits are evaluated a gpio port register at a time */ 220 for (i = 0; i < ARRAY_SIZE(ports) + 1; i++) { 221 /* gpio offset in bits array */ 222 bits_offset = i * gpio_reg_size; 223 224 /* word index for bits array */ 225 word_index = BIT_WORD(bits_offset); 226 227 /* gpio offset within current word of bits array */ 228 word_offset = bits_offset % BITS_PER_LONG; 229 230 /* mask of get bits for current gpio within current word */ 231 word_mask = mask[word_index] & (port_mask << word_offset); 232 if (!word_mask) { 233 /* no get bits in this port so skip to next one */ 234 continue; 235 } 236 237 /* read bits from current gpio port (port 6 is TTL GPIO) */ 238 if (i < 6) 239 port_state = ioread8(ports[i]); 240 else if (ioread8(&idio24gpio->reg->ctl) & out_mode_mask) 241 port_state = ioread8(&idio24gpio->reg->ttl_out0_7); 242 else 243 port_state = ioread8(&idio24gpio->reg->ttl_in0_7); 244 245 /* store acquired bits at respective bits array offset */ 246 bits[word_index] |= (port_state << word_offset) & word_mask; 247 } 248 249 return 0; 250 } 251 252 static void idio_24_gpio_set(struct gpio_chip *chip, unsigned int offset, 253 int value) 254 { 255 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 256 const unsigned long out_mode_mask = BIT(1); 257 void __iomem *base; 258 const unsigned int mask = BIT(offset % 8); 259 unsigned long flags; 260 unsigned int out_state; 261 262 /* Isolated Inputs */ 263 if (offset > 23 && offset < 48) 264 return; 265 266 /* TTL/CMOS Inputs */ 267 if (offset > 47 && !(ioread8(&idio24gpio->reg->ctl) & out_mode_mask)) 268 return; 269 270 /* TTL/CMOS Outputs */ 271 if (offset > 47) 272 base = &idio24gpio->reg->ttl_out0_7; 273 /* FET Outputs */ 274 else if (offset > 15) 275 base = &idio24gpio->reg->out16_23; 276 else if (offset > 7) 277 base = &idio24gpio->reg->out8_15; 278 else 279 base = &idio24gpio->reg->out0_7; 280 281 raw_spin_lock_irqsave(&idio24gpio->lock, flags); 282 283 if (value) 284 out_state = ioread8(base) | mask; 285 else 286 out_state = ioread8(base) & ~mask; 287 288 iowrite8(out_state, base); 289 290 raw_spin_unlock_irqrestore(&idio24gpio->lock, flags); 291 } 292 293 static void idio_24_gpio_set_multiple(struct gpio_chip *chip, 294 unsigned long *mask, unsigned long *bits) 295 { 296 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 297 size_t i; 298 unsigned long bits_offset; 299 unsigned long gpio_mask; 300 const unsigned int gpio_reg_size = 8; 301 const unsigned long port_mask = GENMASK(gpio_reg_size, 0); 302 unsigned long flags; 303 unsigned int out_state; 304 void __iomem *ports[] = { 305 &idio24gpio->reg->out0_7, &idio24gpio->reg->out8_15, 306 &idio24gpio->reg->out16_23 307 }; 308 const unsigned long out_mode_mask = BIT(1); 309 const unsigned int ttl_offset = 48; 310 const size_t ttl_i = BIT_WORD(ttl_offset); 311 const unsigned int word_offset = ttl_offset % BITS_PER_LONG; 312 const unsigned long ttl_mask = (mask[ttl_i] >> word_offset) & port_mask; 313 const unsigned long ttl_bits = (bits[ttl_i] >> word_offset) & ttl_mask; 314 315 /* set bits are processed a gpio port register at a time */ 316 for (i = 0; i < ARRAY_SIZE(ports); i++) { 317 /* gpio offset in bits array */ 318 bits_offset = i * gpio_reg_size; 319 320 /* check if any set bits for current port */ 321 gpio_mask = (*mask >> bits_offset) & port_mask; 322 if (!gpio_mask) { 323 /* no set bits for this port so move on to next port */ 324 continue; 325 } 326 327 raw_spin_lock_irqsave(&idio24gpio->lock, flags); 328 329 /* process output lines */ 330 out_state = ioread8(ports[i]) & ~gpio_mask; 331 out_state |= (*bits >> bits_offset) & gpio_mask; 332 iowrite8(out_state, ports[i]); 333 334 raw_spin_unlock_irqrestore(&idio24gpio->lock, flags); 335 } 336 337 /* check if setting TTL lines and if they are in output mode */ 338 if (!ttl_mask || !(ioread8(&idio24gpio->reg->ctl) & out_mode_mask)) 339 return; 340 341 /* handle TTL output */ 342 raw_spin_lock_irqsave(&idio24gpio->lock, flags); 343 344 /* process output lines */ 345 out_state = ioread8(&idio24gpio->reg->ttl_out0_7) & ~ttl_mask; 346 out_state |= ttl_bits; 347 iowrite8(out_state, &idio24gpio->reg->ttl_out0_7); 348 349 raw_spin_unlock_irqrestore(&idio24gpio->lock, flags); 350 } 351 352 static void idio_24_irq_ack(struct irq_data *data) 353 { 354 } 355 356 static void idio_24_irq_mask(struct irq_data *data) 357 { 358 struct gpio_chip *const chip = irq_data_get_irq_chip_data(data); 359 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 360 unsigned long flags; 361 const unsigned long bit_offset = irqd_to_hwirq(data) - 24; 362 unsigned char new_irq_mask; 363 const unsigned long bank_offset = bit_offset/8 * 8; 364 unsigned char cos_enable_state; 365 366 raw_spin_lock_irqsave(&idio24gpio->lock, flags); 367 368 idio24gpio->irq_mask &= BIT(bit_offset); 369 new_irq_mask = idio24gpio->irq_mask >> bank_offset; 370 371 if (!new_irq_mask) { 372 cos_enable_state = ioread8(&idio24gpio->reg->cos_enable); 373 374 /* Disable Rising Edge detection */ 375 cos_enable_state &= ~BIT(bank_offset); 376 /* Disable Falling Edge detection */ 377 cos_enable_state &= ~BIT(bank_offset + 4); 378 379 iowrite8(cos_enable_state, &idio24gpio->reg->cos_enable); 380 } 381 382 raw_spin_unlock_irqrestore(&idio24gpio->lock, flags); 383 } 384 385 static void idio_24_irq_unmask(struct irq_data *data) 386 { 387 struct gpio_chip *const chip = irq_data_get_irq_chip_data(data); 388 struct idio_24_gpio *const idio24gpio = gpiochip_get_data(chip); 389 unsigned long flags; 390 unsigned char prev_irq_mask; 391 const unsigned long bit_offset = irqd_to_hwirq(data) - 24; 392 const unsigned long bank_offset = bit_offset/8 * 8; 393 unsigned char cos_enable_state; 394 395 raw_spin_lock_irqsave(&idio24gpio->lock, flags); 396 397 prev_irq_mask = idio24gpio->irq_mask >> bank_offset; 398 idio24gpio->irq_mask |= BIT(bit_offset); 399 400 if (!prev_irq_mask) { 401 cos_enable_state = ioread8(&idio24gpio->reg->cos_enable); 402 403 /* Enable Rising Edge detection */ 404 cos_enable_state |= BIT(bank_offset); 405 /* Enable Falling Edge detection */ 406 cos_enable_state |= BIT(bank_offset + 4); 407 408 iowrite8(cos_enable_state, &idio24gpio->reg->cos_enable); 409 } 410 411 raw_spin_unlock_irqrestore(&idio24gpio->lock, flags); 412 } 413 414 static int idio_24_irq_set_type(struct irq_data *data, unsigned int flow_type) 415 { 416 /* The only valid irq types are none and both-edges */ 417 if (flow_type != IRQ_TYPE_NONE && 418 (flow_type & IRQ_TYPE_EDGE_BOTH) != IRQ_TYPE_EDGE_BOTH) 419 return -EINVAL; 420 421 return 0; 422 } 423 424 static struct irq_chip idio_24_irqchip = { 425 .name = "pcie-idio-24", 426 .irq_ack = idio_24_irq_ack, 427 .irq_mask = idio_24_irq_mask, 428 .irq_unmask = idio_24_irq_unmask, 429 .irq_set_type = idio_24_irq_set_type 430 }; 431 432 static irqreturn_t idio_24_irq_handler(int irq, void *dev_id) 433 { 434 struct idio_24_gpio *const idio24gpio = dev_id; 435 unsigned long irq_status; 436 struct gpio_chip *const chip = &idio24gpio->chip; 437 unsigned long irq_mask; 438 int gpio; 439 440 raw_spin_lock(&idio24gpio->lock); 441 442 /* Read Change-Of-State status */ 443 irq_status = ioread32(&idio24gpio->reg->cos0_7); 444 445 raw_spin_unlock(&idio24gpio->lock); 446 447 /* Make sure our device generated IRQ */ 448 if (!irq_status) 449 return IRQ_NONE; 450 451 /* Handle only unmasked IRQ */ 452 irq_mask = idio24gpio->irq_mask & irq_status; 453 454 for_each_set_bit(gpio, &irq_mask, chip->ngpio - 24) 455 generic_handle_irq(irq_find_mapping(chip->irq.domain, 456 gpio + 24)); 457 458 raw_spin_lock(&idio24gpio->lock); 459 460 /* Clear Change-Of-State status */ 461 iowrite32(irq_status, &idio24gpio->reg->cos0_7); 462 463 raw_spin_unlock(&idio24gpio->lock); 464 465 return IRQ_HANDLED; 466 } 467 468 #define IDIO_24_NGPIO 56 469 static const char *idio_24_names[IDIO_24_NGPIO] = { 470 "OUT0", "OUT1", "OUT2", "OUT3", "OUT4", "OUT5", "OUT6", "OUT7", 471 "OUT8", "OUT9", "OUT10", "OUT11", "OUT12", "OUT13", "OUT14", "OUT15", 472 "OUT16", "OUT17", "OUT18", "OUT19", "OUT20", "OUT21", "OUT22", "OUT23", 473 "IIN0", "IIN1", "IIN2", "IIN3", "IIN4", "IIN5", "IIN6", "IIN7", 474 "IIN8", "IIN9", "IIN10", "IIN11", "IIN12", "IIN13", "IIN14", "IIN15", 475 "IIN16", "IIN17", "IIN18", "IIN19", "IIN20", "IIN21", "IIN22", "IIN23", 476 "TTL0", "TTL1", "TTL2", "TTL3", "TTL4", "TTL5", "TTL6", "TTL7" 477 }; 478 479 static int idio_24_probe(struct pci_dev *pdev, const struct pci_device_id *id) 480 { 481 struct device *const dev = &pdev->dev; 482 struct idio_24_gpio *idio24gpio; 483 int err; 484 const size_t pci_bar_index = 2; 485 const char *const name = pci_name(pdev); 486 487 idio24gpio = devm_kzalloc(dev, sizeof(*idio24gpio), GFP_KERNEL); 488 if (!idio24gpio) 489 return -ENOMEM; 490 491 err = pcim_enable_device(pdev); 492 if (err) { 493 dev_err(dev, "Failed to enable PCI device (%d)\n", err); 494 return err; 495 } 496 497 err = pcim_iomap_regions(pdev, BIT(pci_bar_index), name); 498 if (err) { 499 dev_err(dev, "Unable to map PCI I/O addresses (%d)\n", err); 500 return err; 501 } 502 503 idio24gpio->reg = pcim_iomap_table(pdev)[pci_bar_index]; 504 505 idio24gpio->chip.label = name; 506 idio24gpio->chip.parent = dev; 507 idio24gpio->chip.owner = THIS_MODULE; 508 idio24gpio->chip.base = -1; 509 idio24gpio->chip.ngpio = IDIO_24_NGPIO; 510 idio24gpio->chip.names = idio_24_names; 511 idio24gpio->chip.get_direction = idio_24_gpio_get_direction; 512 idio24gpio->chip.direction_input = idio_24_gpio_direction_input; 513 idio24gpio->chip.direction_output = idio_24_gpio_direction_output; 514 idio24gpio->chip.get = idio_24_gpio_get; 515 idio24gpio->chip.get_multiple = idio_24_gpio_get_multiple; 516 idio24gpio->chip.set = idio_24_gpio_set; 517 idio24gpio->chip.set_multiple = idio_24_gpio_set_multiple; 518 519 raw_spin_lock_init(&idio24gpio->lock); 520 521 /* Software board reset */ 522 iowrite8(0, &idio24gpio->reg->soft_reset); 523 524 err = devm_gpiochip_add_data(dev, &idio24gpio->chip, idio24gpio); 525 if (err) { 526 dev_err(dev, "GPIO registering failed (%d)\n", err); 527 return err; 528 } 529 530 err = gpiochip_irqchip_add(&idio24gpio->chip, &idio_24_irqchip, 0, 531 handle_edge_irq, IRQ_TYPE_NONE); 532 if (err) { 533 dev_err(dev, "Could not add irqchip (%d)\n", err); 534 return err; 535 } 536 537 err = devm_request_irq(dev, pdev->irq, idio_24_irq_handler, IRQF_SHARED, 538 name, idio24gpio); 539 if (err) { 540 dev_err(dev, "IRQ handler registering failed (%d)\n", err); 541 return err; 542 } 543 544 return 0; 545 } 546 547 static const struct pci_device_id idio_24_pci_dev_id[] = { 548 { PCI_DEVICE(0x494F, 0x0FD0) }, { PCI_DEVICE(0x494F, 0x0BD0) }, 549 { PCI_DEVICE(0x494F, 0x07D0) }, { PCI_DEVICE(0x494F, 0x0FC0) }, 550 { 0 } 551 }; 552 MODULE_DEVICE_TABLE(pci, idio_24_pci_dev_id); 553 554 static struct pci_driver idio_24_driver = { 555 .name = "pcie-idio-24", 556 .id_table = idio_24_pci_dev_id, 557 .probe = idio_24_probe 558 }; 559 560 module_pci_driver(idio_24_driver); 561 562 MODULE_AUTHOR("William Breathitt Gray <vilhelm.gray@gmail.com>"); 563 MODULE_DESCRIPTION("ACCES PCIe-IDIO-24 GPIO driver"); 564 MODULE_LICENSE("GPL v2"); 565