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
idio_24_gpio_get_direction(struct gpio_chip * chip,unsigned int offset)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
idio_24_gpio_direction_input(struct gpio_chip * chip,unsigned int offset)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
idio_24_gpio_direction_output(struct gpio_chip * chip,unsigned int offset,int value)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
idio_24_gpio_get(struct gpio_chip * chip,unsigned int offset)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
idio_24_gpio_get_multiple(struct gpio_chip * chip,unsigned long * mask,unsigned long * bits)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;
247 }
248
249 return 0;
250 }
251
idio_24_gpio_set(struct gpio_chip * chip,unsigned int offset,int value)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
idio_24_gpio_set_multiple(struct gpio_chip * chip,unsigned long * mask,unsigned long * bits)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
idio_24_irq_ack(struct irq_data * data)352 static void idio_24_irq_ack(struct irq_data *data)
353 {
354 }
355
idio_24_irq_mask(struct irq_data * data)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
idio_24_irq_unmask(struct irq_data * data)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
idio_24_irq_set_type(struct irq_data * data,unsigned int flow_type)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
idio_24_irq_handler(int irq,void * dev_id)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
idio_24_probe(struct pci_dev * pdev,const struct pci_device_id * id)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
