1#include <linux/bitops.h>
2#include <linux/kernel.h>
3#include <linux/module.h>
4#include <linux/interrupt.h>
5#include <linux/irq.h>
6#include <linux/spinlock.h>
7#include <linux/list.h>
8#include <linux/device.h>
9#include <linux/err.h>
10#include <linux/debugfs.h>
11#include <linux/seq_file.h>
12#include <linux/gpio.h>
13#include <linux/of_gpio.h>
14#include <linux/idr.h>
15#include <linux/slab.h>
16#include <linux/acpi.h>
17#include <linux/gpio/driver.h>
18#include <linux/gpio/machine.h>
19#include <linux/pinctrl/consumer.h>
20#include <linux/cdev.h>
21#include <linux/fs.h>
22#include <linux/uaccess.h>
23#include <linux/compat.h>
24#include <linux/anon_inodes.h>
25#include <linux/file.h>
26#include <linux/kfifo.h>
27#include <linux/poll.h>
28#include <linux/timekeeping.h>
29#include <uapi/linux/gpio.h>
30
31#include "gpiolib.h"
32
33#define CREATE_TRACE_POINTS
34#include <trace/events/gpio.h>
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50#ifdef DEBUG
51#define extra_checks 1
52#else
53#define extra_checks 0
54#endif
55
56
57static DEFINE_IDA(gpio_ida);
58static dev_t gpio_devt;
59#define GPIO_DEV_MAX 256
60static struct bus_type gpio_bus_type = {
61 .name = "gpio",
62};
63
64
65
66
67
68DEFINE_SPINLOCK(gpio_lock);
69
70static DEFINE_MUTEX(gpio_lookup_lock);
71static LIST_HEAD(gpio_lookup_list);
72LIST_HEAD(gpio_devices);
73
74static void gpiochip_free_hogs(struct gpio_chip *chip);
75static void gpiochip_irqchip_remove(struct gpio_chip *gpiochip);
76static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gpiochip);
77static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gpiochip);
78
79static bool gpiolib_initialized;
80
81static inline void desc_set_label(struct gpio_desc *d, const char *label)
82{
83 d->label = label;
84}
85
86
87
88
89struct gpio_desc *gpio_to_desc(unsigned gpio)
90{
91 struct gpio_device *gdev;
92 unsigned long flags;
93
94 spin_lock_irqsave(&gpio_lock, flags);
95
96 list_for_each_entry(gdev, &gpio_devices, list) {
97 if (gdev->base <= gpio &&
98 gdev->base + gdev->ngpio > gpio) {
99 spin_unlock_irqrestore(&gpio_lock, flags);
100 return &gdev->descs[gpio - gdev->base];
101 }
102 }
103
104 spin_unlock_irqrestore(&gpio_lock, flags);
105
106 if (!gpio_is_valid(gpio))
107 WARN(1, "invalid GPIO %d\n", gpio);
108
109 return NULL;
110}
111EXPORT_SYMBOL_GPL(gpio_to_desc);
112
113
114
115
116struct gpio_desc *gpiochip_get_desc(struct gpio_chip *chip,
117 u16 hwnum)
118{
119 struct gpio_device *gdev = chip->gpiodev;
120
121 if (hwnum >= gdev->ngpio)
122 return ERR_PTR(-EINVAL);
123
124 return &gdev->descs[hwnum];
125}
126
127
128
129
130
131
132int desc_to_gpio(const struct gpio_desc *desc)
133{
134 return desc->gdev->base + (desc - &desc->gdev->descs[0]);
135}
136EXPORT_SYMBOL_GPL(desc_to_gpio);
137
138
139
140
141
142
143struct gpio_chip *gpiod_to_chip(const struct gpio_desc *desc)
144{
145 if (!desc || !desc->gdev || !desc->gdev->chip)
146 return NULL;
147 return desc->gdev->chip;
148}
149EXPORT_SYMBOL_GPL(gpiod_to_chip);
150
151
152static int gpiochip_find_base(int ngpio)
153{
154 struct gpio_device *gdev;
155 int base = ARCH_NR_GPIOS - ngpio;
156
157 list_for_each_entry_reverse(gdev, &gpio_devices, list) {
158
159 if (gdev->base + gdev->ngpio <= base)
160 break;
161 else
162
163 base = gdev->base - ngpio;
164 }
165
166 if (gpio_is_valid(base)) {
167 pr_debug("%s: found new base at %d\n", __func__, base);
168 return base;
169 } else {
170 pr_err("%s: cannot find free range\n", __func__);
171 return -ENOSPC;
172 }
173}
174
175
176
177
178
179
180
181
182
183int gpiod_get_direction(struct gpio_desc *desc)
184{
185 struct gpio_chip *chip;
186 unsigned offset;
187 int status = -EINVAL;
188
189 chip = gpiod_to_chip(desc);
190 offset = gpio_chip_hwgpio(desc);
191
192 if (!chip->get_direction)
193 return status;
194
195 status = chip->get_direction(chip, offset);
196 if (status > 0) {
197
198 status = 1;
199 clear_bit(FLAG_IS_OUT, &desc->flags);
200 }
201 if (status == 0) {
202
203 set_bit(FLAG_IS_OUT, &desc->flags);
204 }
205 return status;
206}
207EXPORT_SYMBOL_GPL(gpiod_get_direction);
208
209
210
211
212
213
214
215
216static int gpiodev_add_to_list(struct gpio_device *gdev)
217{
218 struct gpio_device *prev, *next;
219
220 if (list_empty(&gpio_devices)) {
221
222 list_add_tail(&gdev->list, &gpio_devices);
223 return 0;
224 }
225
226 next = list_entry(gpio_devices.next, struct gpio_device, list);
227 if (gdev->base + gdev->ngpio <= next->base) {
228
229 list_add(&gdev->list, &gpio_devices);
230 return 0;
231 }
232
233 prev = list_entry(gpio_devices.prev, struct gpio_device, list);
234 if (prev->base + prev->ngpio <= gdev->base) {
235
236 list_add_tail(&gdev->list, &gpio_devices);
237 return 0;
238 }
239
240 list_for_each_entry_safe(prev, next, &gpio_devices, list) {
241
242 if (&next->list == &gpio_devices)
243 break;
244
245
246 if (prev->base + prev->ngpio <= gdev->base
247 && gdev->base + gdev->ngpio <= next->base) {
248 list_add(&gdev->list, &prev->list);
249 return 0;
250 }
251 }
252
253 dev_err(&gdev->dev, "GPIO integer space overlap, cannot add chip\n");
254 return -EBUSY;
255}
256
257
258
259
260static struct gpio_desc *gpio_name_to_desc(const char * const name)
261{
262 struct gpio_device *gdev;
263 unsigned long flags;
264
265 spin_lock_irqsave(&gpio_lock, flags);
266
267 list_for_each_entry(gdev, &gpio_devices, list) {
268 int i;
269
270 for (i = 0; i != gdev->ngpio; ++i) {
271 struct gpio_desc *desc = &gdev->descs[i];
272
273 if (!desc->name || !name)
274 continue;
275
276 if (!strcmp(desc->name, name)) {
277 spin_unlock_irqrestore(&gpio_lock, flags);
278 return desc;
279 }
280 }
281 }
282
283 spin_unlock_irqrestore(&gpio_lock, flags);
284
285 return NULL;
286}
287
288
289
290
291
292
293
294static int gpiochip_set_desc_names(struct gpio_chip *gc)
295{
296 struct gpio_device *gdev = gc->gpiodev;
297 int i;
298
299 if (!gc->names)
300 return 0;
301
302
303 for (i = 0; i != gc->ngpio; ++i) {
304 struct gpio_desc *gpio;
305
306 gpio = gpio_name_to_desc(gc->names[i]);
307 if (gpio)
308 dev_warn(&gdev->dev,
309 "Detected name collision for GPIO name '%s'\n",
310 gc->names[i]);
311 }
312
313
314 for (i = 0; i != gc->ngpio; ++i)
315 gdev->descs[i].name = gc->names[i];
316
317 return 0;
318}
319
320
321
322
323
324
325
326
327
328
329
330
331struct linehandle_state {
332 struct gpio_device *gdev;
333 const char *label;
334 struct gpio_desc *descs[GPIOHANDLES_MAX];
335 u32 numdescs;
336};
337
338#define GPIOHANDLE_REQUEST_VALID_FLAGS \
339 (GPIOHANDLE_REQUEST_INPUT | \
340 GPIOHANDLE_REQUEST_OUTPUT | \
341 GPIOHANDLE_REQUEST_ACTIVE_LOW | \
342 GPIOHANDLE_REQUEST_OPEN_DRAIN | \
343 GPIOHANDLE_REQUEST_OPEN_SOURCE)
344
345static long linehandle_ioctl(struct file *filep, unsigned int cmd,
346 unsigned long arg)
347{
348 struct linehandle_state *lh = filep->private_data;
349 void __user *ip = (void __user *)arg;
350 struct gpiohandle_data ghd;
351 int i;
352
353 if (cmd == GPIOHANDLE_GET_LINE_VALUES_IOCTL) {
354 int val;
355
356 memset(&ghd, 0, sizeof(ghd));
357
358
359 for (i = 0; i < lh->numdescs; i++) {
360 val = gpiod_get_value_cansleep(lh->descs[i]);
361 if (val < 0)
362 return val;
363 ghd.values[i] = val;
364 }
365
366 if (copy_to_user(ip, &ghd, sizeof(ghd)))
367 return -EFAULT;
368
369 return 0;
370 } else if (cmd == GPIOHANDLE_SET_LINE_VALUES_IOCTL) {
371 int vals[GPIOHANDLES_MAX];
372
373
374 if (copy_from_user(&ghd, ip, sizeof(ghd)))
375 return -EFAULT;
376
377
378 for (i = 0; i < lh->numdescs; i++)
379 vals[i] = !!ghd.values[i];
380
381
382 gpiod_set_array_value_complex(false,
383 true,
384 lh->numdescs,
385 lh->descs,
386 vals);
387 return 0;
388 }
389 return -EINVAL;
390}
391
392#ifdef CONFIG_COMPAT
393static long linehandle_ioctl_compat(struct file *filep, unsigned int cmd,
394 unsigned long arg)
395{
396 return linehandle_ioctl(filep, cmd, (unsigned long)compat_ptr(arg));
397}
398#endif
399
400static int linehandle_release(struct inode *inode, struct file *filep)
401{
402 struct linehandle_state *lh = filep->private_data;
403 struct gpio_device *gdev = lh->gdev;
404 int i;
405
406 for (i = 0; i < lh->numdescs; i++)
407 gpiod_free(lh->descs[i]);
408 kfree(lh->label);
409 kfree(lh);
410 put_device(&gdev->dev);
411 return 0;
412}
413
414static const struct file_operations linehandle_fileops = {
415 .release = linehandle_release,
416 .owner = THIS_MODULE,
417 .llseek = noop_llseek,
418 .unlocked_ioctl = linehandle_ioctl,
419#ifdef CONFIG_COMPAT
420 .compat_ioctl = linehandle_ioctl_compat,
421#endif
422};
423
424static int linehandle_create(struct gpio_device *gdev, void __user *ip)
425{
426 struct gpiohandle_request handlereq;
427 struct linehandle_state *lh;
428 struct file *file;
429 int fd, i, ret;
430
431 if (copy_from_user(&handlereq, ip, sizeof(handlereq)))
432 return -EFAULT;
433 if ((handlereq.lines == 0) || (handlereq.lines > GPIOHANDLES_MAX))
434 return -EINVAL;
435
436 lh = kzalloc(sizeof(*lh), GFP_KERNEL);
437 if (!lh)
438 return -ENOMEM;
439 lh->gdev = gdev;
440 get_device(&gdev->dev);
441
442
443 handlereq.consumer_label[sizeof(handlereq.consumer_label)-1] = '\0';
444 if (strlen(handlereq.consumer_label)) {
445 lh->label = kstrdup(handlereq.consumer_label,
446 GFP_KERNEL);
447 if (!lh->label) {
448 ret = -ENOMEM;
449 goto out_free_lh;
450 }
451 }
452
453
454 for (i = 0; i < handlereq.lines; i++) {
455 u32 offset = handlereq.lineoffsets[i];
456 u32 lflags = handlereq.flags;
457 struct gpio_desc *desc;
458
459 if (offset >= gdev->ngpio) {
460 ret = -EINVAL;
461 goto out_free_descs;
462 }
463
464
465 if (lflags & ~GPIOHANDLE_REQUEST_VALID_FLAGS) {
466 ret = -EINVAL;
467 goto out_free_descs;
468 }
469
470 desc = &gdev->descs[offset];
471 ret = gpiod_request(desc, lh->label);
472 if (ret)
473 goto out_free_descs;
474 lh->descs[i] = desc;
475
476 if (lflags & GPIOHANDLE_REQUEST_ACTIVE_LOW)
477 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
478 if (lflags & GPIOHANDLE_REQUEST_OPEN_DRAIN)
479 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
480 if (lflags & GPIOHANDLE_REQUEST_OPEN_SOURCE)
481 set_bit(FLAG_OPEN_SOURCE, &desc->flags);
482
483
484
485
486
487 if (lflags & GPIOHANDLE_REQUEST_OUTPUT) {
488 int val = !!handlereq.default_values[i];
489
490 ret = gpiod_direction_output(desc, val);
491 if (ret)
492 goto out_free_descs;
493 } else if (lflags & GPIOHANDLE_REQUEST_INPUT) {
494 ret = gpiod_direction_input(desc);
495 if (ret)
496 goto out_free_descs;
497 }
498 dev_dbg(&gdev->dev, "registered chardev handle for line %d\n",
499 offset);
500 }
501
502 i--;
503 lh->numdescs = handlereq.lines;
504
505 fd = get_unused_fd_flags(O_RDONLY | O_CLOEXEC);
506 if (fd < 0) {
507 ret = fd;
508 goto out_free_descs;
509 }
510
511 file = anon_inode_getfile("gpio-linehandle",
512 &linehandle_fileops,
513 lh,
514 O_RDONLY | O_CLOEXEC);
515 if (IS_ERR(file)) {
516 ret = PTR_ERR(file);
517 goto out_put_unused_fd;
518 }
519
520 handlereq.fd = fd;
521 if (copy_to_user(ip, &handlereq, sizeof(handlereq))) {
522
523
524
525
526 fput(file);
527 put_unused_fd(fd);
528 return -EFAULT;
529 }
530
531 fd_install(fd, file);
532
533 dev_dbg(&gdev->dev, "registered chardev handle for %d lines\n",
534 lh->numdescs);
535
536 return 0;
537
538out_put_unused_fd:
539 put_unused_fd(fd);
540out_free_descs:
541 for (; i >= 0; i--)
542 gpiod_free(lh->descs[i]);
543 kfree(lh->label);
544out_free_lh:
545 kfree(lh);
546 put_device(&gdev->dev);
547 return ret;
548}
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566struct lineevent_state {
567 struct gpio_device *gdev;
568 const char *label;
569 struct gpio_desc *desc;
570 u32 eflags;
571 int irq;
572 wait_queue_head_t wait;
573 DECLARE_KFIFO(events, struct gpioevent_data, 16);
574 struct mutex read_lock;
575};
576
577#define GPIOEVENT_REQUEST_VALID_FLAGS \
578 (GPIOEVENT_REQUEST_RISING_EDGE | \
579 GPIOEVENT_REQUEST_FALLING_EDGE)
580
581static unsigned int lineevent_poll(struct file *filep,
582 struct poll_table_struct *wait)
583{
584 struct lineevent_state *le = filep->private_data;
585 unsigned int events = 0;
586
587 poll_wait(filep, &le->wait, wait);
588
589 if (!kfifo_is_empty(&le->events))
590 events = POLLIN | POLLRDNORM;
591
592 return events;
593}
594
595
596static ssize_t lineevent_read(struct file *filep,
597 char __user *buf,
598 size_t count,
599 loff_t *f_ps)
600{
601 struct lineevent_state *le = filep->private_data;
602 unsigned int copied;
603 int ret;
604
605 if (count < sizeof(struct gpioevent_data))
606 return -EINVAL;
607
608 do {
609 if (kfifo_is_empty(&le->events)) {
610 if (filep->f_flags & O_NONBLOCK)
611 return -EAGAIN;
612
613 ret = wait_event_interruptible(le->wait,
614 !kfifo_is_empty(&le->events));
615 if (ret)
616 return ret;
617 }
618
619 if (mutex_lock_interruptible(&le->read_lock))
620 return -ERESTARTSYS;
621 ret = kfifo_to_user(&le->events, buf, count, &copied);
622 mutex_unlock(&le->read_lock);
623
624 if (ret)
625 return ret;
626
627
628
629
630
631
632
633 if (copied == 0 && (filep->f_flags & O_NONBLOCK))
634 return -EAGAIN;
635
636 } while (copied == 0);
637
638 return copied;
639}
640
641static int lineevent_release(struct inode *inode, struct file *filep)
642{
643 struct lineevent_state *le = filep->private_data;
644 struct gpio_device *gdev = le->gdev;
645
646 free_irq(le->irq, le);
647 gpiod_free(le->desc);
648 kfree(le->label);
649 kfree(le);
650 put_device(&gdev->dev);
651 return 0;
652}
653
654static long lineevent_ioctl(struct file *filep, unsigned int cmd,
655 unsigned long arg)
656{
657 struct lineevent_state *le = filep->private_data;
658 void __user *ip = (void __user *)arg;
659 struct gpiohandle_data ghd;
660
661
662
663
664
665 if (cmd == GPIOHANDLE_GET_LINE_VALUES_IOCTL) {
666 int val;
667
668 memset(&ghd, 0, sizeof(ghd));
669
670 val = gpiod_get_value_cansleep(le->desc);
671 if (val < 0)
672 return val;
673 ghd.values[0] = val;
674
675 if (copy_to_user(ip, &ghd, sizeof(ghd)))
676 return -EFAULT;
677
678 return 0;
679 }
680 return -EINVAL;
681}
682
683#ifdef CONFIG_COMPAT
684static long lineevent_ioctl_compat(struct file *filep, unsigned int cmd,
685 unsigned long arg)
686{
687 return lineevent_ioctl(filep, cmd, (unsigned long)compat_ptr(arg));
688}
689#endif
690
691static const struct file_operations lineevent_fileops = {
692 .release = lineevent_release,
693 .read = lineevent_read,
694 .poll = lineevent_poll,
695 .owner = THIS_MODULE,
696 .llseek = noop_llseek,
697 .unlocked_ioctl = lineevent_ioctl,
698#ifdef CONFIG_COMPAT
699 .compat_ioctl = lineevent_ioctl_compat,
700#endif
701};
702
703static irqreturn_t lineevent_irq_thread(int irq, void *p)
704{
705 struct lineevent_state *le = p;
706 struct gpioevent_data ge;
707 int ret;
708
709 ge.timestamp = ktime_get_real_ns();
710
711 if (le->eflags & GPIOEVENT_REQUEST_BOTH_EDGES) {
712 int level = gpiod_get_value_cansleep(le->desc);
713
714 if (level)
715
716 ge.id = GPIOEVENT_EVENT_RISING_EDGE;
717 else
718
719 ge.id = GPIOEVENT_EVENT_FALLING_EDGE;
720 } else if (le->eflags & GPIOEVENT_REQUEST_RISING_EDGE) {
721
722 ge.id = GPIOEVENT_EVENT_RISING_EDGE;
723 } else if (le->eflags & GPIOEVENT_REQUEST_FALLING_EDGE) {
724
725 ge.id = GPIOEVENT_EVENT_FALLING_EDGE;
726 } else {
727 return IRQ_NONE;
728 }
729
730 ret = kfifo_put(&le->events, ge);
731 if (ret != 0)
732 wake_up_poll(&le->wait, POLLIN);
733
734 return IRQ_HANDLED;
735}
736
737static int lineevent_create(struct gpio_device *gdev, void __user *ip)
738{
739 struct gpioevent_request eventreq;
740 struct lineevent_state *le;
741 struct gpio_desc *desc;
742 struct file *file;
743 u32 offset;
744 u32 lflags;
745 u32 eflags;
746 int fd;
747 int ret;
748 int irqflags = 0;
749
750 if (copy_from_user(&eventreq, ip, sizeof(eventreq)))
751 return -EFAULT;
752
753 le = kzalloc(sizeof(*le), GFP_KERNEL);
754 if (!le)
755 return -ENOMEM;
756 le->gdev = gdev;
757 get_device(&gdev->dev);
758
759
760 eventreq.consumer_label[sizeof(eventreq.consumer_label)-1] = '\0';
761 if (strlen(eventreq.consumer_label)) {
762 le->label = kstrdup(eventreq.consumer_label,
763 GFP_KERNEL);
764 if (!le->label) {
765 ret = -ENOMEM;
766 goto out_free_le;
767 }
768 }
769
770 offset = eventreq.lineoffset;
771 lflags = eventreq.handleflags;
772 eflags = eventreq.eventflags;
773
774 if (offset >= gdev->ngpio) {
775 ret = -EINVAL;
776 goto out_free_label;
777 }
778
779
780 if ((lflags & ~GPIOHANDLE_REQUEST_VALID_FLAGS) ||
781 (eflags & ~GPIOEVENT_REQUEST_VALID_FLAGS)) {
782 ret = -EINVAL;
783 goto out_free_label;
784 }
785
786
787 if (lflags & GPIOHANDLE_REQUEST_OUTPUT) {
788 ret = -EINVAL;
789 goto out_free_label;
790 }
791
792 desc = &gdev->descs[offset];
793 ret = gpiod_request(desc, le->label);
794 if (ret)
795 goto out_free_desc;
796 le->desc = desc;
797 le->eflags = eflags;
798
799 if (lflags & GPIOHANDLE_REQUEST_ACTIVE_LOW)
800 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
801 if (lflags & GPIOHANDLE_REQUEST_OPEN_DRAIN)
802 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
803 if (lflags & GPIOHANDLE_REQUEST_OPEN_SOURCE)
804 set_bit(FLAG_OPEN_SOURCE, &desc->flags);
805
806 ret = gpiod_direction_input(desc);
807 if (ret)
808 goto out_free_desc;
809
810 le->irq = gpiod_to_irq(desc);
811 if (le->irq <= 0) {
812 ret = -ENODEV;
813 goto out_free_desc;
814 }
815
816 if (eflags & GPIOEVENT_REQUEST_RISING_EDGE)
817 irqflags |= IRQF_TRIGGER_RISING;
818 if (eflags & GPIOEVENT_REQUEST_FALLING_EDGE)
819 irqflags |= IRQF_TRIGGER_FALLING;
820 irqflags |= IRQF_ONESHOT;
821 irqflags |= IRQF_SHARED;
822
823 INIT_KFIFO(le->events);
824 init_waitqueue_head(&le->wait);
825 mutex_init(&le->read_lock);
826
827
828 ret = request_threaded_irq(le->irq,
829 NULL,
830 lineevent_irq_thread,
831 irqflags,
832 le->label,
833 le);
834 if (ret)
835 goto out_free_desc;
836
837 fd = get_unused_fd_flags(O_RDONLY | O_CLOEXEC);
838 if (fd < 0) {
839 ret = fd;
840 goto out_free_irq;
841 }
842
843 file = anon_inode_getfile("gpio-event",
844 &lineevent_fileops,
845 le,
846 O_RDONLY | O_CLOEXEC);
847 if (IS_ERR(file)) {
848 ret = PTR_ERR(file);
849 goto out_put_unused_fd;
850 }
851
852 eventreq.fd = fd;
853 if (copy_to_user(ip, &eventreq, sizeof(eventreq))) {
854
855
856
857
858 fput(file);
859 put_unused_fd(fd);
860 return -EFAULT;
861 }
862
863 fd_install(fd, file);
864
865 return 0;
866
867out_put_unused_fd:
868 put_unused_fd(fd);
869out_free_irq:
870 free_irq(le->irq, le);
871out_free_desc:
872 gpiod_free(le->desc);
873out_free_label:
874 kfree(le->label);
875out_free_le:
876 kfree(le);
877 put_device(&gdev->dev);
878 return ret;
879}
880
881
882
883
884static long gpio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
885{
886 struct gpio_device *gdev = filp->private_data;
887 struct gpio_chip *chip = gdev->chip;
888 void __user *ip = (void __user *)arg;
889
890
891 if (!chip)
892 return -ENODEV;
893
894
895 if (cmd == GPIO_GET_CHIPINFO_IOCTL) {
896 struct gpiochip_info chipinfo;
897
898 memset(&chipinfo, 0, sizeof(chipinfo));
899
900 strncpy(chipinfo.name, dev_name(&gdev->dev),
901 sizeof(chipinfo.name));
902 chipinfo.name[sizeof(chipinfo.name)-1] = '\0';
903 strncpy(chipinfo.label, gdev->label,
904 sizeof(chipinfo.label));
905 chipinfo.label[sizeof(chipinfo.label)-1] = '\0';
906 chipinfo.lines = gdev->ngpio;
907 if (copy_to_user(ip, &chipinfo, sizeof(chipinfo)))
908 return -EFAULT;
909 return 0;
910 } else if (cmd == GPIO_GET_LINEINFO_IOCTL) {
911 struct gpioline_info lineinfo;
912 struct gpio_desc *desc;
913
914 if (copy_from_user(&lineinfo, ip, sizeof(lineinfo)))
915 return -EFAULT;
916 if (lineinfo.line_offset >= gdev->ngpio)
917 return -EINVAL;
918
919 desc = &gdev->descs[lineinfo.line_offset];
920 if (desc->name) {
921 strncpy(lineinfo.name, desc->name,
922 sizeof(lineinfo.name));
923 lineinfo.name[sizeof(lineinfo.name)-1] = '\0';
924 } else {
925 lineinfo.name[0] = '\0';
926 }
927 if (desc->label) {
928 strncpy(lineinfo.consumer, desc->label,
929 sizeof(lineinfo.consumer));
930 lineinfo.consumer[sizeof(lineinfo.consumer)-1] = '\0';
931 } else {
932 lineinfo.consumer[0] = '\0';
933 }
934
935
936
937
938
939 lineinfo.flags = 0;
940 if (test_bit(FLAG_REQUESTED, &desc->flags) ||
941 test_bit(FLAG_IS_HOGGED, &desc->flags) ||
942 test_bit(FLAG_USED_AS_IRQ, &desc->flags) ||
943 test_bit(FLAG_EXPORT, &desc->flags) ||
944 test_bit(FLAG_SYSFS, &desc->flags))
945 lineinfo.flags |= GPIOLINE_FLAG_KERNEL;
946 if (test_bit(FLAG_IS_OUT, &desc->flags))
947 lineinfo.flags |= GPIOLINE_FLAG_IS_OUT;
948 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
949 lineinfo.flags |= GPIOLINE_FLAG_ACTIVE_LOW;
950 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
951 lineinfo.flags |= GPIOLINE_FLAG_OPEN_DRAIN;
952 if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
953 lineinfo.flags |= GPIOLINE_FLAG_OPEN_SOURCE;
954
955 if (copy_to_user(ip, &lineinfo, sizeof(lineinfo)))
956 return -EFAULT;
957 return 0;
958 } else if (cmd == GPIO_GET_LINEHANDLE_IOCTL) {
959 return linehandle_create(gdev, ip);
960 } else if (cmd == GPIO_GET_LINEEVENT_IOCTL) {
961 return lineevent_create(gdev, ip);
962 }
963 return -EINVAL;
964}
965
966#ifdef CONFIG_COMPAT
967static long gpio_ioctl_compat(struct file *filp, unsigned int cmd,
968 unsigned long arg)
969{
970 return gpio_ioctl(filp, cmd, (unsigned long)compat_ptr(arg));
971}
972#endif
973
974
975
976
977
978
979
980static int gpio_chrdev_open(struct inode *inode, struct file *filp)
981{
982 struct gpio_device *gdev = container_of(inode->i_cdev,
983 struct gpio_device, chrdev);
984
985
986 if (!gdev->chip)
987 return -ENODEV;
988 get_device(&gdev->dev);
989 filp->private_data = gdev;
990
991 return nonseekable_open(inode, filp);
992}
993
994
995
996
997
998
999
1000static int gpio_chrdev_release(struct inode *inode, struct file *filp)
1001{
1002 struct gpio_device *gdev = container_of(inode->i_cdev,
1003 struct gpio_device, chrdev);
1004
1005 put_device(&gdev->dev);
1006 return 0;
1007}
1008
1009
1010static const struct file_operations gpio_fileops = {
1011 .release = gpio_chrdev_release,
1012 .open = gpio_chrdev_open,
1013 .owner = THIS_MODULE,
1014 .llseek = no_llseek,
1015 .unlocked_ioctl = gpio_ioctl,
1016#ifdef CONFIG_COMPAT
1017 .compat_ioctl = gpio_ioctl_compat,
1018#endif
1019};
1020
1021static void gpiodevice_release(struct device *dev)
1022{
1023 struct gpio_device *gdev = dev_get_drvdata(dev);
1024
1025 list_del(&gdev->list);
1026 ida_simple_remove(&gpio_ida, gdev->id);
1027 kfree(gdev->label);
1028 kfree(gdev->descs);
1029 kfree(gdev);
1030}
1031
1032static int gpiochip_setup_dev(struct gpio_device *gdev)
1033{
1034 int status;
1035
1036 cdev_init(&gdev->chrdev, &gpio_fileops);
1037 gdev->chrdev.owner = THIS_MODULE;
1038 gdev->chrdev.kobj.parent = &gdev->dev.kobj;
1039 gdev->dev.devt = MKDEV(MAJOR(gpio_devt), gdev->id);
1040 status = cdev_add(&gdev->chrdev, gdev->dev.devt, 1);
1041 if (status < 0)
1042 chip_warn(gdev->chip, "failed to add char device %d:%d\n",
1043 MAJOR(gpio_devt), gdev->id);
1044 else
1045 chip_dbg(gdev->chip, "added GPIO chardev (%d:%d)\n",
1046 MAJOR(gpio_devt), gdev->id);
1047 status = device_add(&gdev->dev);
1048 if (status)
1049 goto err_remove_chardev;
1050
1051 status = gpiochip_sysfs_register(gdev);
1052 if (status)
1053 goto err_remove_device;
1054
1055
1056 gdev->dev.release = gpiodevice_release;
1057 pr_debug("%s: registered GPIOs %d to %d on device: %s (%s)\n",
1058 __func__, gdev->base, gdev->base + gdev->ngpio - 1,
1059 dev_name(&gdev->dev), gdev->chip->label ? : "generic");
1060
1061 return 0;
1062
1063err_remove_device:
1064 device_del(&gdev->dev);
1065err_remove_chardev:
1066 cdev_del(&gdev->chrdev);
1067 return status;
1068}
1069
1070static void gpiochip_setup_devs(void)
1071{
1072 struct gpio_device *gdev;
1073 int err;
1074
1075 list_for_each_entry(gdev, &gpio_devices, list) {
1076 err = gpiochip_setup_dev(gdev);
1077 if (err)
1078 pr_err("%s: Failed to initialize gpio device (%d)\n",
1079 dev_name(&gdev->dev), err);
1080 }
1081}
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103int gpiochip_add_data(struct gpio_chip *chip, void *data)
1104{
1105 unsigned long flags;
1106 int status = 0;
1107 unsigned i;
1108 int base = chip->base;
1109 struct gpio_device *gdev;
1110
1111
1112
1113
1114
1115 gdev = kzalloc(sizeof(*gdev), GFP_KERNEL);
1116 if (!gdev)
1117 return -ENOMEM;
1118 gdev->dev.bus = &gpio_bus_type;
1119 gdev->chip = chip;
1120 chip->gpiodev = gdev;
1121 if (chip->parent) {
1122 gdev->dev.parent = chip->parent;
1123 gdev->dev.of_node = chip->parent->of_node;
1124 }
1125
1126#ifdef CONFIG_OF_GPIO
1127
1128 if (chip->of_node)
1129 gdev->dev.of_node = chip->of_node;
1130#endif
1131
1132 gdev->id = ida_simple_get(&gpio_ida, 0, 0, GFP_KERNEL);
1133 if (gdev->id < 0) {
1134 status = gdev->id;
1135 goto err_free_gdev;
1136 }
1137 dev_set_name(&gdev->dev, "gpiochip%d", gdev->id);
1138 device_initialize(&gdev->dev);
1139 dev_set_drvdata(&gdev->dev, gdev);
1140 if (chip->parent && chip->parent->driver)
1141 gdev->owner = chip->parent->driver->owner;
1142 else if (chip->owner)
1143
1144 gdev->owner = chip->owner;
1145 else
1146 gdev->owner = THIS_MODULE;
1147
1148 gdev->descs = kcalloc(chip->ngpio, sizeof(gdev->descs[0]), GFP_KERNEL);
1149 if (!gdev->descs) {
1150 status = -ENOMEM;
1151 goto err_free_gdev;
1152 }
1153
1154 if (chip->ngpio == 0) {
1155 chip_err(chip, "tried to insert a GPIO chip with zero lines\n");
1156 status = -EINVAL;
1157 goto err_free_descs;
1158 }
1159
1160 if (chip->label)
1161 gdev->label = kstrdup(chip->label, GFP_KERNEL);
1162 else
1163 gdev->label = kstrdup("unknown", GFP_KERNEL);
1164 if (!gdev->label) {
1165 status = -ENOMEM;
1166 goto err_free_descs;
1167 }
1168
1169 gdev->ngpio = chip->ngpio;
1170 gdev->data = data;
1171
1172 spin_lock_irqsave(&gpio_lock, flags);
1173
1174
1175
1176
1177
1178
1179
1180
1181 if (base < 0) {
1182 base = gpiochip_find_base(chip->ngpio);
1183 if (base < 0) {
1184 status = base;
1185 spin_unlock_irqrestore(&gpio_lock, flags);
1186 goto err_free_label;
1187 }
1188
1189
1190
1191
1192
1193
1194 chip->base = base;
1195 }
1196 gdev->base = base;
1197
1198 status = gpiodev_add_to_list(gdev);
1199 if (status) {
1200 spin_unlock_irqrestore(&gpio_lock, flags);
1201 goto err_free_label;
1202 }
1203
1204 spin_unlock_irqrestore(&gpio_lock, flags);
1205
1206 for (i = 0; i < chip->ngpio; i++) {
1207 struct gpio_desc *desc = &gdev->descs[i];
1208
1209 desc->gdev = gdev;
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219 if (chip->get_direction) {
1220
1221
1222
1223
1224 int dir = chip->get_direction(chip, i);
1225
1226 if (!dir)
1227 set_bit(FLAG_IS_OUT, &desc->flags);
1228 } else if (!chip->direction_input) {
1229
1230
1231
1232
1233 set_bit(FLAG_IS_OUT, &desc->flags);
1234 }
1235 }
1236
1237#ifdef CONFIG_PINCTRL
1238 INIT_LIST_HEAD(&gdev->pin_ranges);
1239#endif
1240
1241 status = gpiochip_set_desc_names(chip);
1242 if (status)
1243 goto err_remove_from_list;
1244
1245 status = gpiochip_irqchip_init_valid_mask(chip);
1246 if (status)
1247 goto err_remove_from_list;
1248
1249 status = of_gpiochip_add(chip);
1250 if (status)
1251 goto err_remove_chip;
1252
1253 acpi_gpiochip_add(chip);
1254
1255
1256
1257
1258
1259
1260
1261
1262
1263 if (gpiolib_initialized) {
1264 status = gpiochip_setup_dev(gdev);
1265 if (status)
1266 goto err_remove_chip;
1267 }
1268 return 0;
1269
1270err_remove_chip:
1271 acpi_gpiochip_remove(chip);
1272 gpiochip_free_hogs(chip);
1273 of_gpiochip_remove(chip);
1274 gpiochip_irqchip_free_valid_mask(chip);
1275err_remove_from_list:
1276 spin_lock_irqsave(&gpio_lock, flags);
1277 list_del(&gdev->list);
1278 spin_unlock_irqrestore(&gpio_lock, flags);
1279err_free_label:
1280 kfree(gdev->label);
1281err_free_descs:
1282 kfree(gdev->descs);
1283err_free_gdev:
1284 ida_simple_remove(&gpio_ida, gdev->id);
1285
1286 pr_err("%s: GPIOs %d..%d (%s) failed to register\n", __func__,
1287 gdev->base, gdev->base + gdev->ngpio - 1,
1288 chip->label ? : "generic");
1289 kfree(gdev);
1290 return status;
1291}
1292EXPORT_SYMBOL_GPL(gpiochip_add_data);
1293
1294
1295
1296
1297void *gpiochip_get_data(struct gpio_chip *chip)
1298{
1299 return chip->gpiodev->data;
1300}
1301EXPORT_SYMBOL_GPL(gpiochip_get_data);
1302
1303
1304
1305
1306
1307
1308
1309void gpiochip_remove(struct gpio_chip *chip)
1310{
1311 struct gpio_device *gdev = chip->gpiodev;
1312 struct gpio_desc *desc;
1313 unsigned long flags;
1314 unsigned i;
1315 bool requested = false;
1316
1317
1318 gpiochip_sysfs_unregister(gdev);
1319 gpiochip_free_hogs(chip);
1320
1321 gdev->chip = NULL;
1322 gpiochip_irqchip_remove(chip);
1323 acpi_gpiochip_remove(chip);
1324 gpiochip_remove_pin_ranges(chip);
1325 of_gpiochip_remove(chip);
1326
1327
1328
1329
1330 gdev->data = NULL;
1331
1332 spin_lock_irqsave(&gpio_lock, flags);
1333 for (i = 0; i < gdev->ngpio; i++) {
1334 desc = &gdev->descs[i];
1335 if (test_bit(FLAG_REQUESTED, &desc->flags))
1336 requested = true;
1337 }
1338 spin_unlock_irqrestore(&gpio_lock, flags);
1339
1340 if (requested)
1341 dev_crit(&gdev->dev,
1342 "REMOVING GPIOCHIP WITH GPIOS STILL REQUESTED\n");
1343
1344
1345
1346
1347
1348
1349
1350 cdev_del(&gdev->chrdev);
1351 device_del(&gdev->dev);
1352 put_device(&gdev->dev);
1353}
1354EXPORT_SYMBOL_GPL(gpiochip_remove);
1355
1356static void devm_gpio_chip_release(struct device *dev, void *res)
1357{
1358 struct gpio_chip *chip = *(struct gpio_chip **)res;
1359
1360 gpiochip_remove(chip);
1361}
1362
1363static int devm_gpio_chip_match(struct device *dev, void *res, void *data)
1364
1365{
1366 struct gpio_chip **r = res;
1367
1368 if (!r || !*r) {
1369 WARN_ON(!r || !*r);
1370 return 0;
1371 }
1372
1373 return *r == data;
1374}
1375
1376
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388int devm_gpiochip_add_data(struct device *dev, struct gpio_chip *chip,
1389 void *data)
1390{
1391 struct gpio_chip **ptr;
1392 int ret;
1393
1394 ptr = devres_alloc(devm_gpio_chip_release, sizeof(*ptr),
1395 GFP_KERNEL);
1396 if (!ptr)
1397 return -ENOMEM;
1398
1399 ret = gpiochip_add_data(chip, data);
1400 if (ret < 0) {
1401 devres_free(ptr);
1402 return ret;
1403 }
1404
1405 *ptr = chip;
1406 devres_add(dev, ptr);
1407
1408 return 0;
1409}
1410EXPORT_SYMBOL_GPL(devm_gpiochip_add_data);
1411
1412
1413
1414
1415
1416
1417
1418
1419void devm_gpiochip_remove(struct device *dev, struct gpio_chip *chip)
1420{
1421 int ret;
1422
1423 ret = devres_release(dev, devm_gpio_chip_release,
1424 devm_gpio_chip_match, chip);
1425 WARN_ON(ret);
1426}
1427EXPORT_SYMBOL_GPL(devm_gpiochip_remove);
1428
1429
1430
1431
1432
1433
1434
1435
1436
1437
1438
1439
1440struct gpio_chip *gpiochip_find(void *data,
1441 int (*match)(struct gpio_chip *chip,
1442 void *data))
1443{
1444 struct gpio_device *gdev;
1445 struct gpio_chip *chip = NULL;
1446 unsigned long flags;
1447
1448 spin_lock_irqsave(&gpio_lock, flags);
1449 list_for_each_entry(gdev, &gpio_devices, list)
1450 if (gdev->chip && match(gdev->chip, data)) {
1451 chip = gdev->chip;
1452 break;
1453 }
1454
1455 spin_unlock_irqrestore(&gpio_lock, flags);
1456
1457 return chip;
1458}
1459EXPORT_SYMBOL_GPL(gpiochip_find);
1460
1461static int gpiochip_match_name(struct gpio_chip *chip, void *data)
1462{
1463 const char *name = data;
1464
1465 return !strcmp(chip->label, name);
1466}
1467
1468static struct gpio_chip *find_chip_by_name(const char *name)
1469{
1470 return gpiochip_find((void *)name, gpiochip_match_name);
1471}
1472
1473#ifdef CONFIG_GPIOLIB_IRQCHIP
1474
1475
1476
1477
1478
1479static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gpiochip)
1480{
1481 int i;
1482
1483 if (!gpiochip->irq_need_valid_mask)
1484 return 0;
1485
1486 gpiochip->irq_valid_mask = kcalloc(BITS_TO_LONGS(gpiochip->ngpio),
1487 sizeof(long), GFP_KERNEL);
1488 if (!gpiochip->irq_valid_mask)
1489 return -ENOMEM;
1490
1491
1492 for (i = 0; i < gpiochip->ngpio; i++)
1493 set_bit(i, gpiochip->irq_valid_mask);
1494
1495 return 0;
1496}
1497
1498static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gpiochip)
1499{
1500 kfree(gpiochip->irq_valid_mask);
1501 gpiochip->irq_valid_mask = NULL;
1502}
1503
1504static bool gpiochip_irqchip_irq_valid(const struct gpio_chip *gpiochip,
1505 unsigned int offset)
1506{
1507
1508 if (likely(!gpiochip->irq_valid_mask))
1509 return true;
1510 return test_bit(offset, gpiochip->irq_valid_mask);
1511}
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522
1523static void gpiochip_set_cascaded_irqchip(struct gpio_chip *gpiochip,
1524 struct irq_chip *irqchip,
1525 int parent_irq,
1526 irq_flow_handler_t parent_handler)
1527{
1528 unsigned int offset;
1529
1530 if (!gpiochip->irqdomain) {
1531 chip_err(gpiochip, "called %s before setting up irqchip\n",
1532 __func__);
1533 return;
1534 }
1535
1536 if (parent_handler) {
1537 if (gpiochip->can_sleep) {
1538 chip_err(gpiochip,
1539 "you cannot have chained interrupts on a "
1540 "chip that may sleep\n");
1541 return;
1542 }
1543
1544
1545
1546
1547 irq_set_chained_handler_and_data(parent_irq, parent_handler,
1548 gpiochip);
1549
1550 gpiochip->irq_chained_parent = parent_irq;
1551 }
1552
1553
1554 for (offset = 0; offset < gpiochip->ngpio; offset++) {
1555 if (!gpiochip_irqchip_irq_valid(gpiochip, offset))
1556 continue;
1557 irq_set_parent(irq_find_mapping(gpiochip->irqdomain, offset),
1558 parent_irq);
1559 }
1560}
1561
1562
1563
1564
1565
1566
1567
1568
1569
1570
1571
1572void gpiochip_set_chained_irqchip(struct gpio_chip *gpiochip,
1573 struct irq_chip *irqchip,
1574 int parent_irq,
1575 irq_flow_handler_t parent_handler)
1576{
1577 gpiochip_set_cascaded_irqchip(gpiochip, irqchip, parent_irq,
1578 parent_handler);
1579}
1580EXPORT_SYMBOL_GPL(gpiochip_set_chained_irqchip);
1581
1582
1583
1584
1585
1586
1587
1588
1589void gpiochip_set_nested_irqchip(struct gpio_chip *gpiochip,
1590 struct irq_chip *irqchip,
1591 int parent_irq)
1592{
1593 if (!gpiochip->irq_nested) {
1594 chip_err(gpiochip, "tried to nest a chained gpiochip\n");
1595 return;
1596 }
1597 gpiochip_set_cascaded_irqchip(gpiochip, irqchip, parent_irq,
1598 NULL);
1599}
1600EXPORT_SYMBOL_GPL(gpiochip_set_nested_irqchip);
1601
1602
1603
1604
1605
1606
1607
1608
1609
1610
1611
1612static int gpiochip_irq_map(struct irq_domain *d, unsigned int irq,
1613 irq_hw_number_t hwirq)
1614{
1615 struct gpio_chip *chip = d->host_data;
1616
1617 irq_set_chip_data(irq, chip);
1618
1619
1620
1621
1622 irq_set_lockdep_class(irq, chip->lock_key);
1623 irq_set_chip_and_handler(irq, chip->irqchip, chip->irq_handler);
1624
1625 if (chip->irq_nested)
1626 irq_set_nested_thread(irq, 1);
1627 irq_set_noprobe(irq);
1628
1629
1630
1631
1632
1633 if (chip->irq_default_type != IRQ_TYPE_NONE)
1634 irq_set_irq_type(irq, chip->irq_default_type);
1635
1636 return 0;
1637}
1638
1639static void gpiochip_irq_unmap(struct irq_domain *d, unsigned int irq)
1640{
1641 struct gpio_chip *chip = d->host_data;
1642
1643 if (chip->irq_nested)
1644 irq_set_nested_thread(irq, 0);
1645 irq_set_chip_and_handler(irq, NULL, NULL);
1646 irq_set_chip_data(irq, NULL);
1647}
1648
1649static const struct irq_domain_ops gpiochip_domain_ops = {
1650 .map = gpiochip_irq_map,
1651 .unmap = gpiochip_irq_unmap,
1652
1653 .xlate = irq_domain_xlate_twocell,
1654};
1655
1656static int gpiochip_irq_reqres(struct irq_data *d)
1657{
1658 struct gpio_chip *chip = irq_data_get_irq_chip_data(d);
1659
1660 if (!try_module_get(chip->gpiodev->owner))
1661 return -ENODEV;
1662
1663 if (gpiochip_lock_as_irq(chip, d->hwirq)) {
1664 chip_err(chip,
1665 "unable to lock HW IRQ %lu for IRQ\n",
1666 d->hwirq);
1667 module_put(chip->gpiodev->owner);
1668 return -EINVAL;
1669 }
1670 return 0;
1671}
1672
1673static void gpiochip_irq_relres(struct irq_data *d)
1674{
1675 struct gpio_chip *chip = irq_data_get_irq_chip_data(d);
1676
1677 gpiochip_unlock_as_irq(chip, d->hwirq);
1678 module_put(chip->gpiodev->owner);
1679}
1680
1681static int gpiochip_to_irq(struct gpio_chip *chip, unsigned offset)
1682{
1683 return irq_find_mapping(chip->irqdomain, offset);
1684}
1685
1686
1687
1688
1689
1690
1691
1692static void gpiochip_irqchip_remove(struct gpio_chip *gpiochip)
1693{
1694 unsigned int offset;
1695
1696 acpi_gpiochip_free_interrupts(gpiochip);
1697
1698 if (gpiochip->irq_chained_parent) {
1699 irq_set_chained_handler(gpiochip->irq_chained_parent, NULL);
1700 irq_set_handler_data(gpiochip->irq_chained_parent, NULL);
1701 }
1702
1703
1704 if (gpiochip->irqdomain) {
1705 for (offset = 0; offset < gpiochip->ngpio; offset++) {
1706 if (!gpiochip_irqchip_irq_valid(gpiochip, offset))
1707 continue;
1708 irq_dispose_mapping(
1709 irq_find_mapping(gpiochip->irqdomain, offset));
1710 }
1711 irq_domain_remove(gpiochip->irqdomain);
1712 }
1713
1714 if (gpiochip->irqchip) {
1715 gpiochip->irqchip->irq_request_resources = NULL;
1716 gpiochip->irqchip->irq_release_resources = NULL;
1717 gpiochip->irqchip = NULL;
1718 }
1719
1720 gpiochip_irqchip_free_valid_mask(gpiochip);
1721}
1722
1723
1724
1725
1726
1727
1728
1729
1730
1731
1732
1733
1734
1735
1736
1737
1738
1739
1740
1741
1742
1743
1744
1745
1746
1747
1748
1749
1750int gpiochip_irqchip_add_key(struct gpio_chip *gpiochip,
1751 struct irq_chip *irqchip,
1752 unsigned int first_irq,
1753 irq_flow_handler_t handler,
1754 unsigned int type,
1755 bool nested,
1756 struct lock_class_key *lock_key)
1757{
1758 struct device_node *of_node;
1759 bool irq_base_set = false;
1760 unsigned int offset;
1761 unsigned irq_base = 0;
1762
1763 if (!gpiochip || !irqchip)
1764 return -EINVAL;
1765
1766 if (!gpiochip->parent) {
1767 pr_err("missing gpiochip .dev parent pointer\n");
1768 return -EINVAL;
1769 }
1770 gpiochip->irq_nested = nested;
1771 of_node = gpiochip->parent->of_node;
1772#ifdef CONFIG_OF_GPIO
1773
1774
1775
1776
1777
1778 if (gpiochip->of_node)
1779 of_node = gpiochip->of_node;
1780#endif
1781
1782
1783
1784
1785
1786 if (WARN(of_node && type != IRQ_TYPE_NONE,
1787 "%s: Ignoring %d default trigger\n", of_node->full_name, type))
1788 type = IRQ_TYPE_NONE;
1789 if (has_acpi_companion(gpiochip->parent) && type != IRQ_TYPE_NONE) {
1790 acpi_handle_warn(ACPI_HANDLE(gpiochip->parent),
1791 "Ignoring %d default trigger\n", type);
1792 type = IRQ_TYPE_NONE;
1793 }
1794
1795 gpiochip->irqchip = irqchip;
1796 gpiochip->irq_handler = handler;
1797 gpiochip->irq_default_type = type;
1798 gpiochip->to_irq = gpiochip_to_irq;
1799 gpiochip->lock_key = lock_key;
1800 gpiochip->irqdomain = irq_domain_add_simple(of_node,
1801 gpiochip->ngpio, first_irq,
1802 &gpiochip_domain_ops, gpiochip);
1803 if (!gpiochip->irqdomain) {
1804 gpiochip->irqchip = NULL;
1805 return -EINVAL;
1806 }
1807
1808
1809
1810
1811
1812 if (!irqchip->irq_request_resources &&
1813 !irqchip->irq_release_resources) {
1814 irqchip->irq_request_resources = gpiochip_irq_reqres;
1815 irqchip->irq_release_resources = gpiochip_irq_relres;
1816 }
1817
1818
1819
1820
1821
1822
1823 for (offset = 0; offset < gpiochip->ngpio; offset++) {
1824 if (!gpiochip_irqchip_irq_valid(gpiochip, offset))
1825 continue;
1826 irq_base = irq_create_mapping(gpiochip->irqdomain, offset);
1827 if (!irq_base_set) {
1828
1829
1830
1831
1832 gpiochip->irq_base = irq_base;
1833 irq_base_set = true;
1834 }
1835 }
1836
1837 acpi_gpiochip_request_interrupts(gpiochip);
1838
1839 return 0;
1840}
1841EXPORT_SYMBOL_GPL(gpiochip_irqchip_add_key);
1842
1843#else
1844
1845static void gpiochip_irqchip_remove(struct gpio_chip *gpiochip) {}
1846static inline int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gpiochip)
1847{
1848 return 0;
1849}
1850static inline void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gpiochip)
1851{ }
1852
1853#endif
1854
1855
1856
1857
1858
1859
1860int gpiochip_generic_request(struct gpio_chip *chip, unsigned offset)
1861{
1862 return pinctrl_request_gpio(chip->gpiodev->base + offset);
1863}
1864EXPORT_SYMBOL_GPL(gpiochip_generic_request);
1865
1866
1867
1868
1869
1870
1871void gpiochip_generic_free(struct gpio_chip *chip, unsigned offset)
1872{
1873 pinctrl_free_gpio(chip->gpiodev->base + offset);
1874}
1875EXPORT_SYMBOL_GPL(gpiochip_generic_free);
1876
1877
1878
1879
1880
1881
1882
1883int gpiochip_generic_config(struct gpio_chip *chip, unsigned offset,
1884 unsigned long config)
1885{
1886 return pinctrl_gpio_set_config(chip->gpiodev->base + offset, config);
1887}
1888EXPORT_SYMBOL_GPL(gpiochip_generic_config);
1889
1890#ifdef CONFIG_PINCTRL
1891
1892
1893
1894
1895
1896
1897
1898
1899int gpiochip_add_pingroup_range(struct gpio_chip *chip,
1900 struct pinctrl_dev *pctldev,
1901 unsigned int gpio_offset, const char *pin_group)
1902{
1903 struct gpio_pin_range *pin_range;
1904 struct gpio_device *gdev = chip->gpiodev;
1905 int ret;
1906
1907 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1908 if (!pin_range) {
1909 chip_err(chip, "failed to allocate pin ranges\n");
1910 return -ENOMEM;
1911 }
1912
1913
1914 pin_range->range.id = gpio_offset;
1915 pin_range->range.gc = chip;
1916 pin_range->range.name = chip->label;
1917 pin_range->range.base = gdev->base + gpio_offset;
1918 pin_range->pctldev = pctldev;
1919
1920 ret = pinctrl_get_group_pins(pctldev, pin_group,
1921 &pin_range->range.pins,
1922 &pin_range->range.npins);
1923 if (ret < 0) {
1924 kfree(pin_range);
1925 return ret;
1926 }
1927
1928 pinctrl_add_gpio_range(pctldev, &pin_range->range);
1929
1930 chip_dbg(chip, "created GPIO range %d->%d ==> %s PINGRP %s\n",
1931 gpio_offset, gpio_offset + pin_range->range.npins - 1,
1932 pinctrl_dev_get_devname(pctldev), pin_group);
1933
1934 list_add_tail(&pin_range->node, &gdev->pin_ranges);
1935
1936 return 0;
1937}
1938EXPORT_SYMBOL_GPL(gpiochip_add_pingroup_range);
1939
1940
1941
1942
1943
1944
1945
1946
1947
1948
1949int gpiochip_add_pin_range(struct gpio_chip *chip, const char *pinctl_name,
1950 unsigned int gpio_offset, unsigned int pin_offset,
1951 unsigned int npins)
1952{
1953 struct gpio_pin_range *pin_range;
1954 struct gpio_device *gdev = chip->gpiodev;
1955 int ret;
1956
1957 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1958 if (!pin_range) {
1959 chip_err(chip, "failed to allocate pin ranges\n");
1960 return -ENOMEM;
1961 }
1962
1963
1964 pin_range->range.id = gpio_offset;
1965 pin_range->range.gc = chip;
1966 pin_range->range.name = chip->label;
1967 pin_range->range.base = gdev->base + gpio_offset;
1968 pin_range->range.pin_base = pin_offset;
1969 pin_range->range.npins = npins;
1970 pin_range->pctldev = pinctrl_find_and_add_gpio_range(pinctl_name,
1971 &pin_range->range);
1972 if (IS_ERR(pin_range->pctldev)) {
1973 ret = PTR_ERR(pin_range->pctldev);
1974 chip_err(chip, "could not create pin range\n");
1975 kfree(pin_range);
1976 return ret;
1977 }
1978 chip_dbg(chip, "created GPIO range %d->%d ==> %s PIN %d->%d\n",
1979 gpio_offset, gpio_offset + npins - 1,
1980 pinctl_name,
1981 pin_offset, pin_offset + npins - 1);
1982
1983 list_add_tail(&pin_range->node, &gdev->pin_ranges);
1984
1985 return 0;
1986}
1987EXPORT_SYMBOL_GPL(gpiochip_add_pin_range);
1988
1989
1990
1991
1992
1993void gpiochip_remove_pin_ranges(struct gpio_chip *chip)
1994{
1995 struct gpio_pin_range *pin_range, *tmp;
1996 struct gpio_device *gdev = chip->gpiodev;
1997
1998 list_for_each_entry_safe(pin_range, tmp, &gdev->pin_ranges, node) {
1999 list_del(&pin_range->node);
2000 pinctrl_remove_gpio_range(pin_range->pctldev,
2001 &pin_range->range);
2002 kfree(pin_range);
2003 }
2004}
2005EXPORT_SYMBOL_GPL(gpiochip_remove_pin_ranges);
2006
2007#endif
2008
2009
2010
2011
2012
2013static int __gpiod_request(struct gpio_desc *desc, const char *label)
2014{
2015 struct gpio_chip *chip = desc->gdev->chip;
2016 int status;
2017 unsigned long flags;
2018
2019 spin_lock_irqsave(&gpio_lock, flags);
2020
2021
2022
2023
2024
2025 if (test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0) {
2026 desc_set_label(desc, label ? : "?");
2027 status = 0;
2028 } else {
2029 status = -EBUSY;
2030 goto done;
2031 }
2032
2033 if (chip->request) {
2034
2035 spin_unlock_irqrestore(&gpio_lock, flags);
2036 status = chip->request(chip, gpio_chip_hwgpio(desc));
2037 spin_lock_irqsave(&gpio_lock, flags);
2038
2039 if (status < 0) {
2040 desc_set_label(desc, NULL);
2041 clear_bit(FLAG_REQUESTED, &desc->flags);
2042 goto done;
2043 }
2044 }
2045 if (chip->get_direction) {
2046
2047 spin_unlock_irqrestore(&gpio_lock, flags);
2048 gpiod_get_direction(desc);
2049 spin_lock_irqsave(&gpio_lock, flags);
2050 }
2051done:
2052 spin_unlock_irqrestore(&gpio_lock, flags);
2053 return status;
2054}
2055
2056
2057
2058
2059
2060
2061
2062#define VALIDATE_DESC(desc) do { \
2063 if (!desc) \
2064 return 0; \
2065 if (IS_ERR(desc)) { \
2066 pr_warn("%s: invalid GPIO (errorpointer)\n", __func__); \
2067 return PTR_ERR(desc); \
2068 } \
2069 if (!desc->gdev) { \
2070 pr_warn("%s: invalid GPIO (no device)\n", __func__); \
2071 return -EINVAL; \
2072 } \
2073 if ( !desc->gdev->chip ) { \
2074 dev_warn(&desc->gdev->dev, \
2075 "%s: backing chip is gone\n", __func__); \
2076 return 0; \
2077 } } while (0)
2078
2079#define VALIDATE_DESC_VOID(desc) do { \
2080 if (!desc) \
2081 return; \
2082 if (IS_ERR(desc)) { \
2083 pr_warn("%s: invalid GPIO (errorpointer)\n", __func__); \
2084 return; \
2085 } \
2086 if (!desc->gdev) { \
2087 pr_warn("%s: invalid GPIO (no device)\n", __func__); \
2088 return; \
2089 } \
2090 if (!desc->gdev->chip) { \
2091 dev_warn(&desc->gdev->dev, \
2092 "%s: backing chip is gone\n", __func__); \
2093 return; \
2094 } } while (0)
2095
2096
2097int gpiod_request(struct gpio_desc *desc, const char *label)
2098{
2099 int status = -EPROBE_DEFER;
2100 struct gpio_device *gdev;
2101
2102 VALIDATE_DESC(desc);
2103 gdev = desc->gdev;
2104
2105 if (try_module_get(gdev->owner)) {
2106 status = __gpiod_request(desc, label);
2107 if (status < 0)
2108 module_put(gdev->owner);
2109 else
2110 get_device(&gdev->dev);
2111 }
2112
2113 if (status)
2114 gpiod_dbg(desc, "%s: status %d\n", __func__, status);
2115
2116 return status;
2117}
2118
2119static bool __gpiod_free(struct gpio_desc *desc)
2120{
2121 bool ret = false;
2122 unsigned long flags;
2123 struct gpio_chip *chip;
2124
2125 might_sleep();
2126
2127 gpiod_unexport(desc);
2128
2129 spin_lock_irqsave(&gpio_lock, flags);
2130
2131 chip = desc->gdev->chip;
2132 if (chip && test_bit(FLAG_REQUESTED, &desc->flags)) {
2133 if (chip->free) {
2134 spin_unlock_irqrestore(&gpio_lock, flags);
2135 might_sleep_if(chip->can_sleep);
2136 chip->free(chip, gpio_chip_hwgpio(desc));
2137 spin_lock_irqsave(&gpio_lock, flags);
2138 }
2139 desc_set_label(desc, NULL);
2140 clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
2141 clear_bit(FLAG_REQUESTED, &desc->flags);
2142 clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
2143 clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
2144 clear_bit(FLAG_IS_HOGGED, &desc->flags);
2145 ret = true;
2146 }
2147
2148 spin_unlock_irqrestore(&gpio_lock, flags);
2149 return ret;
2150}
2151
2152void gpiod_free(struct gpio_desc *desc)
2153{
2154 if (desc && desc->gdev && __gpiod_free(desc)) {
2155 module_put(desc->gdev->owner);
2156 put_device(&desc->gdev->dev);
2157 } else {
2158 WARN_ON(extra_checks);
2159 }
2160}
2161
2162
2163
2164
2165
2166
2167
2168
2169
2170
2171
2172
2173
2174
2175const char *gpiochip_is_requested(struct gpio_chip *chip, unsigned offset)
2176{
2177 struct gpio_desc *desc;
2178
2179 if (offset >= chip->ngpio)
2180 return NULL;
2181
2182 desc = &chip->gpiodev->descs[offset];
2183
2184 if (test_bit(FLAG_REQUESTED, &desc->flags) == 0)
2185 return NULL;
2186 return desc->label;
2187}
2188EXPORT_SYMBOL_GPL(gpiochip_is_requested);
2189
2190
2191
2192
2193
2194
2195
2196
2197
2198
2199
2200
2201struct gpio_desc *gpiochip_request_own_desc(struct gpio_chip *chip, u16 hwnum,
2202 const char *label)
2203{
2204 struct gpio_desc *desc = gpiochip_get_desc(chip, hwnum);
2205 int err;
2206
2207 if (IS_ERR(desc)) {
2208 chip_err(chip, "failed to get GPIO descriptor\n");
2209 return desc;
2210 }
2211
2212 err = __gpiod_request(desc, label);
2213 if (err < 0)
2214 return ERR_PTR(err);
2215
2216 return desc;
2217}
2218EXPORT_SYMBOL_GPL(gpiochip_request_own_desc);
2219
2220
2221
2222
2223
2224
2225
2226
2227void gpiochip_free_own_desc(struct gpio_desc *desc)
2228{
2229 if (desc)
2230 __gpiod_free(desc);
2231}
2232EXPORT_SYMBOL_GPL(gpiochip_free_own_desc);
2233
2234
2235
2236
2237
2238
2239
2240
2241
2242
2243
2244
2245
2246
2247
2248
2249
2250
2251
2252
2253int gpiod_direction_input(struct gpio_desc *desc)
2254{
2255 struct gpio_chip *chip;
2256 int status = -EINVAL;
2257
2258 VALIDATE_DESC(desc);
2259 chip = desc->gdev->chip;
2260
2261 if (!chip->get || !chip->direction_input) {
2262 gpiod_warn(desc,
2263 "%s: missing get() or direction_input() operations\n",
2264 __func__);
2265 return -EIO;
2266 }
2267
2268 status = chip->direction_input(chip, gpio_chip_hwgpio(desc));
2269 if (status == 0)
2270 clear_bit(FLAG_IS_OUT, &desc->flags);
2271
2272 trace_gpio_direction(desc_to_gpio(desc), 1, status);
2273
2274 return status;
2275}
2276EXPORT_SYMBOL_GPL(gpiod_direction_input);
2277
2278static int gpio_set_drive_single_ended(struct gpio_chip *gc, unsigned offset,
2279 enum pin_config_param mode)
2280{
2281 unsigned long config = { PIN_CONF_PACKED(mode, 0) };
2282
2283 return gc->set_config ? gc->set_config(gc, offset, config) : -ENOTSUPP;
2284}
2285
2286static int _gpiod_direction_output_raw(struct gpio_desc *desc, int value)
2287{
2288 struct gpio_chip *gc = desc->gdev->chip;
2289 int val = !!value;
2290 int ret;
2291
2292
2293 if (test_bit(FLAG_USED_AS_IRQ, &desc->flags)) {
2294 gpiod_err(desc,
2295 "%s: tried to set a GPIO tied to an IRQ as output\n",
2296 __func__);
2297 return -EIO;
2298 }
2299
2300 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
2301
2302 ret = gpio_set_drive_single_ended(gc, gpio_chip_hwgpio(desc),
2303 PIN_CONFIG_DRIVE_OPEN_DRAIN);
2304 if (!ret)
2305 goto set_output_value;
2306
2307 if (val)
2308 return gpiod_direction_input(desc);
2309 }
2310 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags)) {
2311 ret = gpio_set_drive_single_ended(gc, gpio_chip_hwgpio(desc),
2312 PIN_CONFIG_DRIVE_OPEN_SOURCE);
2313 if (!ret)
2314 goto set_output_value;
2315
2316 if (!val)
2317 return gpiod_direction_input(desc);
2318 } else {
2319 gpio_set_drive_single_ended(gc, gpio_chip_hwgpio(desc),
2320 PIN_CONFIG_DRIVE_PUSH_PULL);
2321 }
2322
2323set_output_value:
2324 if (!gc->set || !gc->direction_output) {
2325 gpiod_warn(desc,
2326 "%s: missing set() or direction_output() operations\n",
2327 __func__);
2328 return -EIO;
2329 }
2330
2331 ret = gc->direction_output(gc, gpio_chip_hwgpio(desc), val);
2332 if (!ret)
2333 set_bit(FLAG_IS_OUT, &desc->flags);
2334 trace_gpio_value(desc_to_gpio(desc), 0, val);
2335 trace_gpio_direction(desc_to_gpio(desc), 0, ret);
2336 return ret;
2337}
2338
2339
2340
2341
2342
2343
2344
2345
2346
2347
2348
2349
2350int gpiod_direction_output_raw(struct gpio_desc *desc, int value)
2351{
2352 VALIDATE_DESC(desc);
2353 return _gpiod_direction_output_raw(desc, value);
2354}
2355EXPORT_SYMBOL_GPL(gpiod_direction_output_raw);
2356
2357
2358
2359
2360
2361
2362
2363
2364
2365
2366
2367
2368
2369int gpiod_direction_output(struct gpio_desc *desc, int value)
2370{
2371 VALIDATE_DESC(desc);
2372 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2373 value = !value;
2374 else
2375 value = !!value;
2376 return _gpiod_direction_output_raw(desc, value);
2377}
2378EXPORT_SYMBOL_GPL(gpiod_direction_output);
2379
2380
2381
2382
2383
2384
2385
2386
2387
2388int gpiod_set_debounce(struct gpio_desc *desc, unsigned debounce)
2389{
2390 struct gpio_chip *chip;
2391 unsigned long config;
2392
2393 VALIDATE_DESC(desc);
2394 chip = desc->gdev->chip;
2395 if (!chip->set || !chip->set_config) {
2396 gpiod_dbg(desc,
2397 "%s: missing set() or set_config() operations\n",
2398 __func__);
2399 return -ENOTSUPP;
2400 }
2401
2402 config = pinconf_to_config_packed(PIN_CONFIG_INPUT_DEBOUNCE, debounce);
2403 return chip->set_config(chip, gpio_chip_hwgpio(desc), config);
2404}
2405EXPORT_SYMBOL_GPL(gpiod_set_debounce);
2406
2407
2408
2409
2410
2411
2412
2413int gpiod_is_active_low(const struct gpio_desc *desc)
2414{
2415 VALIDATE_DESC(desc);
2416 return test_bit(FLAG_ACTIVE_LOW, &desc->flags);
2417}
2418EXPORT_SYMBOL_GPL(gpiod_is_active_low);
2419
2420
2421
2422
2423
2424
2425
2426
2427
2428
2429
2430
2431
2432
2433
2434
2435
2436
2437
2438
2439
2440
2441
2442static int _gpiod_get_raw_value(const struct gpio_desc *desc)
2443{
2444 struct gpio_chip *chip;
2445 int offset;
2446 int value;
2447
2448 chip = desc->gdev->chip;
2449 offset = gpio_chip_hwgpio(desc);
2450 value = chip->get ? chip->get(chip, offset) : -EIO;
2451 value = value < 0 ? value : !!value;
2452 trace_gpio_value(desc_to_gpio(desc), 1, value);
2453 return value;
2454}
2455
2456
2457
2458
2459
2460
2461
2462
2463
2464
2465
2466int gpiod_get_raw_value(const struct gpio_desc *desc)
2467{
2468 VALIDATE_DESC(desc);
2469
2470 WARN_ON(desc->gdev->chip->can_sleep);
2471 return _gpiod_get_raw_value(desc);
2472}
2473EXPORT_SYMBOL_GPL(gpiod_get_raw_value);
2474
2475
2476
2477
2478
2479
2480
2481
2482
2483
2484
2485int gpiod_get_value(const struct gpio_desc *desc)
2486{
2487 int value;
2488
2489 VALIDATE_DESC(desc);
2490
2491 WARN_ON(desc->gdev->chip->can_sleep);
2492
2493 value = _gpiod_get_raw_value(desc);
2494 if (value < 0)
2495 return value;
2496
2497 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2498 value = !value;
2499
2500 return value;
2501}
2502EXPORT_SYMBOL_GPL(gpiod_get_value);
2503
2504
2505
2506
2507
2508
2509static void _gpio_set_open_drain_value(struct gpio_desc *desc, bool value)
2510{
2511 int err = 0;
2512 struct gpio_chip *chip = desc->gdev->chip;
2513 int offset = gpio_chip_hwgpio(desc);
2514
2515 if (value) {
2516 err = chip->direction_input(chip, offset);
2517 if (!err)
2518 clear_bit(FLAG_IS_OUT, &desc->flags);
2519 } else {
2520 err = chip->direction_output(chip, offset, 0);
2521 if (!err)
2522 set_bit(FLAG_IS_OUT, &desc->flags);
2523 }
2524 trace_gpio_direction(desc_to_gpio(desc), value, err);
2525 if (err < 0)
2526 gpiod_err(desc,
2527 "%s: Error in set_value for open drain err %d\n",
2528 __func__, err);
2529}
2530
2531
2532
2533
2534
2535
2536static void _gpio_set_open_source_value(struct gpio_desc *desc, bool value)
2537{
2538 int err = 0;
2539 struct gpio_chip *chip = desc->gdev->chip;
2540 int offset = gpio_chip_hwgpio(desc);
2541
2542 if (value) {
2543 err = chip->direction_output(chip, offset, 1);
2544 if (!err)
2545 set_bit(FLAG_IS_OUT, &desc->flags);
2546 } else {
2547 err = chip->direction_input(chip, offset);
2548 if (!err)
2549 clear_bit(FLAG_IS_OUT, &desc->flags);
2550 }
2551 trace_gpio_direction(desc_to_gpio(desc), !value, err);
2552 if (err < 0)
2553 gpiod_err(desc,
2554 "%s: Error in set_value for open source err %d\n",
2555 __func__, err);
2556}
2557
2558static void _gpiod_set_raw_value(struct gpio_desc *desc, bool value)
2559{
2560 struct gpio_chip *chip;
2561
2562 chip = desc->gdev->chip;
2563 trace_gpio_value(desc_to_gpio(desc), 0, value);
2564 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
2565 _gpio_set_open_drain_value(desc, value);
2566 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
2567 _gpio_set_open_source_value(desc, value);
2568 else
2569 chip->set(chip, gpio_chip_hwgpio(desc), value);
2570}
2571
2572
2573
2574
2575
2576
2577
2578
2579
2580
2581static void gpio_chip_set_multiple(struct gpio_chip *chip,
2582 unsigned long *mask, unsigned long *bits)
2583{
2584 if (chip->set_multiple) {
2585 chip->set_multiple(chip, mask, bits);
2586 } else {
2587 unsigned int i;
2588
2589
2590 for_each_set_bit(i, mask, chip->ngpio)
2591 chip->set(chip, i, test_bit(i, bits));
2592 }
2593}
2594
2595void gpiod_set_array_value_complex(bool raw, bool can_sleep,
2596 unsigned int array_size,
2597 struct gpio_desc **desc_array,
2598 int *value_array)
2599{
2600 int i = 0;
2601
2602 while (i < array_size) {
2603 struct gpio_chip *chip = desc_array[i]->gdev->chip;
2604 unsigned long mask[BITS_TO_LONGS(chip->ngpio)];
2605 unsigned long bits[BITS_TO_LONGS(chip->ngpio)];
2606 int count = 0;
2607
2608 if (!can_sleep)
2609 WARN_ON(chip->can_sleep);
2610
2611 memset(mask, 0, sizeof(mask));
2612 do {
2613 struct gpio_desc *desc = desc_array[i];
2614 int hwgpio = gpio_chip_hwgpio(desc);
2615 int value = value_array[i];
2616
2617 if (!raw && test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2618 value = !value;
2619 trace_gpio_value(desc_to_gpio(desc), 0, value);
2620
2621
2622
2623
2624 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
2625 _gpio_set_open_drain_value(desc, value);
2626 } else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags)) {
2627 _gpio_set_open_source_value(desc, value);
2628 } else {
2629 __set_bit(hwgpio, mask);
2630 if (value)
2631 __set_bit(hwgpio, bits);
2632 else
2633 __clear_bit(hwgpio, bits);
2634 count++;
2635 }
2636 i++;
2637 } while ((i < array_size) &&
2638 (desc_array[i]->gdev->chip == chip));
2639
2640 if (count != 0)
2641 gpio_chip_set_multiple(chip, mask, bits);
2642 }
2643}
2644
2645
2646
2647
2648
2649
2650
2651
2652
2653
2654
2655
2656void gpiod_set_raw_value(struct gpio_desc *desc, int value)
2657{
2658 VALIDATE_DESC_VOID(desc);
2659
2660 WARN_ON(desc->gdev->chip->can_sleep);
2661 _gpiod_set_raw_value(desc, value);
2662}
2663EXPORT_SYMBOL_GPL(gpiod_set_raw_value);
2664
2665
2666
2667
2668
2669
2670
2671
2672
2673
2674
2675
2676void gpiod_set_value(struct gpio_desc *desc, int value)
2677{
2678 VALIDATE_DESC_VOID(desc);
2679
2680 WARN_ON(desc->gdev->chip->can_sleep);
2681 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2682 value = !value;
2683 _gpiod_set_raw_value(desc, value);
2684}
2685EXPORT_SYMBOL_GPL(gpiod_set_value);
2686
2687
2688
2689
2690
2691
2692
2693
2694
2695
2696
2697
2698
2699void gpiod_set_raw_array_value(unsigned int array_size,
2700 struct gpio_desc **desc_array, int *value_array)
2701{
2702 if (!desc_array)
2703 return;
2704 gpiod_set_array_value_complex(true, false, array_size, desc_array,
2705 value_array);
2706}
2707EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value);
2708
2709
2710
2711
2712
2713
2714
2715
2716
2717
2718
2719
2720
2721void gpiod_set_array_value(unsigned int array_size,
2722 struct gpio_desc **desc_array, int *value_array)
2723{
2724 if (!desc_array)
2725 return;
2726 gpiod_set_array_value_complex(false, false, array_size, desc_array,
2727 value_array);
2728}
2729EXPORT_SYMBOL_GPL(gpiod_set_array_value);
2730
2731
2732
2733
2734
2735
2736int gpiod_cansleep(const struct gpio_desc *desc)
2737{
2738 VALIDATE_DESC(desc);
2739 return desc->gdev->chip->can_sleep;
2740}
2741EXPORT_SYMBOL_GPL(gpiod_cansleep);
2742
2743
2744
2745
2746
2747
2748
2749
2750int gpiod_to_irq(const struct gpio_desc *desc)
2751{
2752 struct gpio_chip *chip;
2753 int offset;
2754
2755
2756
2757
2758
2759
2760 if (!desc || IS_ERR(desc) || !desc->gdev || !desc->gdev->chip)
2761 return -EINVAL;
2762
2763 chip = desc->gdev->chip;
2764 offset = gpio_chip_hwgpio(desc);
2765 if (chip->to_irq) {
2766 int retirq = chip->to_irq(chip, offset);
2767
2768
2769 if (!retirq)
2770 return -ENXIO;
2771
2772 return retirq;
2773 }
2774 return -ENXIO;
2775}
2776EXPORT_SYMBOL_GPL(gpiod_to_irq);
2777
2778
2779
2780
2781
2782
2783
2784
2785
2786int gpiochip_lock_as_irq(struct gpio_chip *chip, unsigned int offset)
2787{
2788 struct gpio_desc *desc;
2789
2790 desc = gpiochip_get_desc(chip, offset);
2791 if (IS_ERR(desc))
2792 return PTR_ERR(desc);
2793
2794
2795
2796
2797
2798 if (!chip->can_sleep && chip->get_direction) {
2799 int dir = chip->get_direction(chip, offset);
2800
2801 if (dir)
2802 clear_bit(FLAG_IS_OUT, &desc->flags);
2803 else
2804 set_bit(FLAG_IS_OUT, &desc->flags);
2805 }
2806
2807 if (test_bit(FLAG_IS_OUT, &desc->flags)) {
2808 chip_err(chip,
2809 "%s: tried to flag a GPIO set as output for IRQ\n",
2810 __func__);
2811 return -EIO;
2812 }
2813
2814 set_bit(FLAG_USED_AS_IRQ, &desc->flags);
2815
2816
2817
2818
2819
2820
2821 if (!desc->label)
2822 desc_set_label(desc, "interrupt");
2823
2824 return 0;
2825}
2826EXPORT_SYMBOL_GPL(gpiochip_lock_as_irq);
2827
2828
2829
2830
2831
2832
2833
2834
2835
2836void gpiochip_unlock_as_irq(struct gpio_chip *chip, unsigned int offset)
2837{
2838 struct gpio_desc *desc;
2839
2840 desc = gpiochip_get_desc(chip, offset);
2841 if (IS_ERR(desc))
2842 return;
2843
2844 clear_bit(FLAG_USED_AS_IRQ, &desc->flags);
2845
2846
2847 if (desc->label && !strcmp(desc->label, "interrupt"))
2848 desc_set_label(desc, NULL);
2849}
2850EXPORT_SYMBOL_GPL(gpiochip_unlock_as_irq);
2851
2852bool gpiochip_line_is_irq(struct gpio_chip *chip, unsigned int offset)
2853{
2854 if (offset >= chip->ngpio)
2855 return false;
2856
2857 return test_bit(FLAG_USED_AS_IRQ, &chip->gpiodev->descs[offset].flags);
2858}
2859EXPORT_SYMBOL_GPL(gpiochip_line_is_irq);
2860
2861bool gpiochip_line_is_open_drain(struct gpio_chip *chip, unsigned int offset)
2862{
2863 if (offset >= chip->ngpio)
2864 return false;
2865
2866 return test_bit(FLAG_OPEN_DRAIN, &chip->gpiodev->descs[offset].flags);
2867}
2868EXPORT_SYMBOL_GPL(gpiochip_line_is_open_drain);
2869
2870bool gpiochip_line_is_open_source(struct gpio_chip *chip, unsigned int offset)
2871{
2872 if (offset >= chip->ngpio)
2873 return false;
2874
2875 return test_bit(FLAG_OPEN_SOURCE, &chip->gpiodev->descs[offset].flags);
2876}
2877EXPORT_SYMBOL_GPL(gpiochip_line_is_open_source);
2878
2879
2880
2881
2882
2883
2884
2885
2886
2887
2888int gpiod_get_raw_value_cansleep(const struct gpio_desc *desc)
2889{
2890 might_sleep_if(extra_checks);
2891 VALIDATE_DESC(desc);
2892 return _gpiod_get_raw_value(desc);
2893}
2894EXPORT_SYMBOL_GPL(gpiod_get_raw_value_cansleep);
2895
2896
2897
2898
2899
2900
2901
2902
2903
2904
2905int gpiod_get_value_cansleep(const struct gpio_desc *desc)
2906{
2907 int value;
2908
2909 might_sleep_if(extra_checks);
2910 VALIDATE_DESC(desc);
2911 value = _gpiod_get_raw_value(desc);
2912 if (value < 0)
2913 return value;
2914
2915 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2916 value = !value;
2917
2918 return value;
2919}
2920EXPORT_SYMBOL_GPL(gpiod_get_value_cansleep);
2921
2922
2923
2924
2925
2926
2927
2928
2929
2930
2931
2932void gpiod_set_raw_value_cansleep(struct gpio_desc *desc, int value)
2933{
2934 might_sleep_if(extra_checks);
2935 VALIDATE_DESC_VOID(desc);
2936 _gpiod_set_raw_value(desc, value);
2937}
2938EXPORT_SYMBOL_GPL(gpiod_set_raw_value_cansleep);
2939
2940
2941
2942
2943
2944
2945
2946
2947
2948
2949
2950void gpiod_set_value_cansleep(struct gpio_desc *desc, int value)
2951{
2952 might_sleep_if(extra_checks);
2953 VALIDATE_DESC_VOID(desc);
2954 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2955 value = !value;
2956 _gpiod_set_raw_value(desc, value);
2957}
2958EXPORT_SYMBOL_GPL(gpiod_set_value_cansleep);
2959
2960
2961
2962
2963
2964
2965
2966
2967
2968
2969
2970
2971void gpiod_set_raw_array_value_cansleep(unsigned int array_size,
2972 struct gpio_desc **desc_array,
2973 int *value_array)
2974{
2975 might_sleep_if(extra_checks);
2976 if (!desc_array)
2977 return;
2978 gpiod_set_array_value_complex(true, true, array_size, desc_array,
2979 value_array);
2980}
2981EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value_cansleep);
2982
2983
2984
2985
2986
2987
2988
2989
2990
2991
2992
2993
2994void gpiod_set_array_value_cansleep(unsigned int array_size,
2995 struct gpio_desc **desc_array,
2996 int *value_array)
2997{
2998 might_sleep_if(extra_checks);
2999 if (!desc_array)
3000 return;
3001 gpiod_set_array_value_complex(false, true, array_size, desc_array,
3002 value_array);
3003}
3004EXPORT_SYMBOL_GPL(gpiod_set_array_value_cansleep);
3005
3006
3007
3008
3009
3010void gpiod_add_lookup_table(struct gpiod_lookup_table *table)
3011{
3012 mutex_lock(&gpio_lookup_lock);
3013
3014 list_add_tail(&table->list, &gpio_lookup_list);
3015
3016 mutex_unlock(&gpio_lookup_lock);
3017}
3018
3019
3020
3021
3022
3023void gpiod_remove_lookup_table(struct gpiod_lookup_table *table)
3024{
3025 mutex_lock(&gpio_lookup_lock);
3026
3027 list_del(&table->list);
3028
3029 mutex_unlock(&gpio_lookup_lock);
3030}
3031
3032static struct gpiod_lookup_table *gpiod_find_lookup_table(struct device *dev)
3033{
3034 const char *dev_id = dev ? dev_name(dev) : NULL;
3035 struct gpiod_lookup_table *table;
3036
3037 mutex_lock(&gpio_lookup_lock);
3038
3039 list_for_each_entry(table, &gpio_lookup_list, list) {
3040 if (table->dev_id && dev_id) {
3041
3042
3043
3044
3045 if (!strcmp(table->dev_id, dev_id))
3046 goto found;
3047 } else {
3048
3049
3050
3051
3052 if (dev_id == table->dev_id)
3053 goto found;
3054 }
3055 }
3056 table = NULL;
3057
3058found:
3059 mutex_unlock(&gpio_lookup_lock);
3060 return table;
3061}
3062
3063static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id,
3064 unsigned int idx,
3065 enum gpio_lookup_flags *flags)
3066{
3067 struct gpio_desc *desc = ERR_PTR(-ENOENT);
3068 struct gpiod_lookup_table *table;
3069 struct gpiod_lookup *p;
3070
3071 table = gpiod_find_lookup_table(dev);
3072 if (!table)
3073 return desc;
3074
3075 for (p = &table->table[0]; p->chip_label; p++) {
3076 struct gpio_chip *chip;
3077
3078
3079 if (p->idx != idx)
3080 continue;
3081
3082
3083 if (p->con_id && (!con_id || strcmp(p->con_id, con_id)))
3084 continue;
3085
3086 chip = find_chip_by_name(p->chip_label);
3087
3088 if (!chip) {
3089 dev_err(dev, "cannot find GPIO chip %s\n",
3090 p->chip_label);
3091 return ERR_PTR(-ENODEV);
3092 }
3093
3094 if (chip->ngpio <= p->chip_hwnum) {
3095 dev_err(dev,
3096 "requested GPIO %d is out of range [0..%d] for chip %s\n",
3097 idx, chip->ngpio, chip->label);
3098 return ERR_PTR(-EINVAL);
3099 }
3100
3101 desc = gpiochip_get_desc(chip, p->chip_hwnum);
3102 *flags = p->flags;
3103
3104 return desc;
3105 }
3106
3107 return desc;
3108}
3109
3110static int dt_gpio_count(struct device *dev, const char *con_id)
3111{
3112 int ret;
3113 char propname[32];
3114 unsigned int i;
3115
3116 for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) {
3117 if (con_id)
3118 snprintf(propname, sizeof(propname), "%s-%s",
3119 con_id, gpio_suffixes[i]);
3120 else
3121 snprintf(propname, sizeof(propname), "%s",
3122 gpio_suffixes[i]);
3123
3124 ret = of_gpio_named_count(dev->of_node, propname);
3125 if (ret >= 0)
3126 break;
3127 }
3128 return ret;
3129}
3130
3131static int platform_gpio_count(struct device *dev, const char *con_id)
3132{
3133 struct gpiod_lookup_table *table;
3134 struct gpiod_lookup *p;
3135 unsigned int count = 0;
3136
3137 table = gpiod_find_lookup_table(dev);
3138 if (!table)
3139 return -ENOENT;
3140
3141 for (p = &table->table[0]; p->chip_label; p++) {
3142 if ((con_id && p->con_id && !strcmp(con_id, p->con_id)) ||
3143 (!con_id && !p->con_id))
3144 count++;
3145 }
3146 if (!count)
3147 return -ENOENT;
3148
3149 return count;
3150}
3151
3152
3153
3154
3155
3156
3157
3158int gpiod_count(struct device *dev, const char *con_id)
3159{
3160 int count = -ENOENT;
3161
3162 if (IS_ENABLED(CONFIG_OF) && dev && dev->of_node)
3163 count = dt_gpio_count(dev, con_id);
3164 else if (IS_ENABLED(CONFIG_ACPI) && dev && ACPI_HANDLE(dev))
3165 count = acpi_gpio_count(dev, con_id);
3166
3167 if (count < 0)
3168 count = platform_gpio_count(dev, con_id);
3169
3170 return count;
3171}
3172EXPORT_SYMBOL_GPL(gpiod_count);
3173
3174
3175
3176
3177
3178
3179
3180
3181
3182
3183
3184struct gpio_desc *__must_check gpiod_get(struct device *dev, const char *con_id,
3185 enum gpiod_flags flags)
3186{
3187 return gpiod_get_index(dev, con_id, 0, flags);
3188}
3189EXPORT_SYMBOL_GPL(gpiod_get);
3190
3191
3192
3193
3194
3195
3196
3197
3198
3199
3200
3201struct gpio_desc *__must_check gpiod_get_optional(struct device *dev,
3202 const char *con_id,
3203 enum gpiod_flags flags)
3204{
3205 return gpiod_get_index_optional(dev, con_id, 0, flags);
3206}
3207EXPORT_SYMBOL_GPL(gpiod_get_optional);
3208
3209
3210
3211
3212
3213
3214
3215
3216
3217
3218
3219
3220
3221
3222static int gpiod_configure_flags(struct gpio_desc *desc, const char *con_id,
3223 unsigned long lflags, enum gpiod_flags dflags)
3224{
3225 int status;
3226
3227 if (lflags & GPIO_ACTIVE_LOW)
3228 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
3229 if (lflags & GPIO_OPEN_DRAIN)
3230 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
3231 if (lflags & GPIO_OPEN_SOURCE)
3232 set_bit(FLAG_OPEN_SOURCE, &desc->flags);
3233
3234
3235 if (!(dflags & GPIOD_FLAGS_BIT_DIR_SET)) {
3236 pr_debug("no flags found for %s\n", con_id);
3237 return 0;
3238 }
3239
3240
3241 if (dflags & GPIOD_FLAGS_BIT_DIR_OUT)
3242 status = gpiod_direction_output(desc,
3243 !!(dflags & GPIOD_FLAGS_BIT_DIR_VAL));
3244 else
3245 status = gpiod_direction_input(desc);
3246
3247 return status;
3248}
3249
3250
3251
3252
3253
3254
3255
3256
3257
3258
3259
3260
3261
3262
3263
3264struct gpio_desc *__must_check gpiod_get_index(struct device *dev,
3265 const char *con_id,
3266 unsigned int idx,
3267 enum gpiod_flags flags)
3268{
3269 struct gpio_desc *desc = NULL;
3270 int status;
3271 enum gpio_lookup_flags lookupflags = 0;
3272
3273 dev_dbg(dev, "GPIO lookup for consumer %s\n", con_id);
3274
3275 if (dev) {
3276
3277 if (IS_ENABLED(CONFIG_OF) && dev->of_node) {
3278 dev_dbg(dev, "using device tree for GPIO lookup\n");
3279 desc = of_find_gpio(dev, con_id, idx, &lookupflags);
3280 } else if (ACPI_COMPANION(dev)) {
3281 dev_dbg(dev, "using ACPI for GPIO lookup\n");
3282 desc = acpi_find_gpio(dev, con_id, idx, flags, &lookupflags);
3283 }
3284 }
3285
3286
3287
3288
3289
3290 if (!desc || desc == ERR_PTR(-ENOENT)) {
3291 dev_dbg(dev, "using lookup tables for GPIO lookup\n");
3292 desc = gpiod_find(dev, con_id, idx, &lookupflags);
3293 }
3294
3295 if (IS_ERR(desc)) {
3296 dev_dbg(dev, "lookup for GPIO %s failed\n", con_id);
3297 return desc;
3298 }
3299
3300 status = gpiod_request(desc, con_id);
3301 if (status < 0)
3302 return ERR_PTR(status);
3303
3304 status = gpiod_configure_flags(desc, con_id, lookupflags, flags);
3305 if (status < 0) {
3306 dev_dbg(dev, "setup of GPIO %s failed\n", con_id);
3307 gpiod_put(desc);
3308 return ERR_PTR(status);
3309 }
3310
3311 return desc;
3312}
3313EXPORT_SYMBOL_GPL(gpiod_get_index);
3314
3315
3316
3317
3318
3319
3320
3321
3322
3323
3324
3325
3326
3327
3328
3329
3330
3331
3332
3333
3334struct gpio_desc *fwnode_get_named_gpiod(struct fwnode_handle *fwnode,
3335 const char *propname, int index,
3336 enum gpiod_flags dflags,
3337 const char *label)
3338{
3339 struct gpio_desc *desc = ERR_PTR(-ENODEV);
3340 unsigned long lflags = 0;
3341 bool active_low = false;
3342 bool single_ended = false;
3343 int ret;
3344
3345 if (!fwnode)
3346 return ERR_PTR(-EINVAL);
3347
3348 if (is_of_node(fwnode)) {
3349 enum of_gpio_flags flags;
3350
3351 desc = of_get_named_gpiod_flags(to_of_node(fwnode), propname,
3352 index, &flags);
3353 if (!IS_ERR(desc)) {
3354 active_low = flags & OF_GPIO_ACTIVE_LOW;
3355 single_ended = flags & OF_GPIO_SINGLE_ENDED;
3356 }
3357 } else if (is_acpi_node(fwnode)) {
3358 struct acpi_gpio_info info;
3359
3360 desc = acpi_node_get_gpiod(fwnode, propname, index, &info);
3361 if (!IS_ERR(desc))
3362 active_low = info.polarity == GPIO_ACTIVE_LOW;
3363 }
3364
3365 if (IS_ERR(desc))
3366 return desc;
3367
3368 ret = gpiod_request(desc, label);
3369 if (ret)
3370 return ERR_PTR(ret);
3371
3372 if (active_low)
3373 lflags |= GPIO_ACTIVE_LOW;
3374
3375 if (single_ended) {
3376 if (active_low)
3377 lflags |= GPIO_OPEN_DRAIN;
3378 else
3379 lflags |= GPIO_OPEN_SOURCE;
3380 }
3381
3382 ret = gpiod_configure_flags(desc, propname, lflags, dflags);
3383 if (ret < 0) {
3384 gpiod_put(desc);
3385 return ERR_PTR(ret);
3386 }
3387
3388 return desc;
3389}
3390EXPORT_SYMBOL_GPL(fwnode_get_named_gpiod);
3391
3392
3393
3394
3395
3396
3397
3398
3399
3400
3401
3402
3403
3404struct gpio_desc *__must_check gpiod_get_index_optional(struct device *dev,
3405 const char *con_id,
3406 unsigned int index,
3407 enum gpiod_flags flags)
3408{
3409 struct gpio_desc *desc;
3410
3411 desc = gpiod_get_index(dev, con_id, index, flags);
3412 if (IS_ERR(desc)) {
3413 if (PTR_ERR(desc) == -ENOENT)
3414 return NULL;
3415 }
3416
3417 return desc;
3418}
3419EXPORT_SYMBOL_GPL(gpiod_get_index_optional);
3420
3421
3422
3423
3424
3425
3426
3427
3428
3429int gpiod_hog(struct gpio_desc *desc, const char *name,
3430 unsigned long lflags, enum gpiod_flags dflags)
3431{
3432 struct gpio_chip *chip;
3433 struct gpio_desc *local_desc;
3434 int hwnum;
3435 int status;
3436
3437 chip = gpiod_to_chip(desc);
3438 hwnum = gpio_chip_hwgpio(desc);
3439
3440 local_desc = gpiochip_request_own_desc(chip, hwnum, name);
3441 if (IS_ERR(local_desc)) {
3442 status = PTR_ERR(local_desc);
3443 pr_err("requesting hog GPIO %s (chip %s, offset %d) failed, %d\n",
3444 name, chip->label, hwnum, status);
3445 return status;
3446 }
3447
3448 status = gpiod_configure_flags(desc, name, lflags, dflags);
3449 if (status < 0) {
3450 pr_err("setup of hog GPIO %s (chip %s, offset %d) failed, %d\n",
3451 name, chip->label, hwnum, status);
3452 gpiochip_free_own_desc(desc);
3453 return status;
3454 }
3455
3456
3457 set_bit(FLAG_IS_HOGGED, &desc->flags);
3458
3459 pr_info("GPIO line %d (%s) hogged as %s%s\n",
3460 desc_to_gpio(desc), name,
3461 (dflags&GPIOD_FLAGS_BIT_DIR_OUT) ? "output" : "input",
3462 (dflags&GPIOD_FLAGS_BIT_DIR_OUT) ?
3463 (dflags&GPIOD_FLAGS_BIT_DIR_VAL) ? "/high" : "/low":"");
3464
3465 return 0;
3466}
3467
3468
3469
3470
3471
3472
3473
3474static void gpiochip_free_hogs(struct gpio_chip *chip)
3475{
3476 int id;
3477
3478 for (id = 0; id < chip->ngpio; id++) {
3479 if (test_bit(FLAG_IS_HOGGED, &chip->gpiodev->descs[id].flags))
3480 gpiochip_free_own_desc(&chip->gpiodev->descs[id]);
3481 }
3482}
3483
3484
3485
3486
3487
3488
3489
3490
3491
3492
3493
3494
3495
3496struct gpio_descs *__must_check gpiod_get_array(struct device *dev,
3497 const char *con_id,
3498 enum gpiod_flags flags)
3499{
3500 struct gpio_desc *desc;
3501 struct gpio_descs *descs;
3502 int count;
3503
3504 count = gpiod_count(dev, con_id);
3505 if (count < 0)
3506 return ERR_PTR(count);
3507
3508 descs = kzalloc(sizeof(*descs) + sizeof(descs->desc[0]) * count,
3509 GFP_KERNEL);
3510 if (!descs)
3511 return ERR_PTR(-ENOMEM);
3512
3513 for (descs->ndescs = 0; descs->ndescs < count; ) {
3514 desc = gpiod_get_index(dev, con_id, descs->ndescs, flags);
3515 if (IS_ERR(desc)) {
3516 gpiod_put_array(descs);
3517 return ERR_CAST(desc);
3518 }
3519 descs->desc[descs->ndescs] = desc;
3520 descs->ndescs++;
3521 }
3522 return descs;
3523}
3524EXPORT_SYMBOL_GPL(gpiod_get_array);
3525
3526
3527
3528
3529
3530
3531
3532
3533
3534
3535
3536struct gpio_descs *__must_check gpiod_get_array_optional(struct device *dev,
3537 const char *con_id,
3538 enum gpiod_flags flags)
3539{
3540 struct gpio_descs *descs;
3541
3542 descs = gpiod_get_array(dev, con_id, flags);
3543 if (IS_ERR(descs) && (PTR_ERR(descs) == -ENOENT))
3544 return NULL;
3545
3546 return descs;
3547}
3548EXPORT_SYMBOL_GPL(gpiod_get_array_optional);
3549
3550
3551
3552
3553
3554
3555
3556void gpiod_put(struct gpio_desc *desc)
3557{
3558 gpiod_free(desc);
3559}
3560EXPORT_SYMBOL_GPL(gpiod_put);
3561
3562
3563
3564
3565
3566void gpiod_put_array(struct gpio_descs *descs)
3567{
3568 unsigned int i;
3569
3570 for (i = 0; i < descs->ndescs; i++)
3571 gpiod_put(descs->desc[i]);
3572
3573 kfree(descs);
3574}
3575EXPORT_SYMBOL_GPL(gpiod_put_array);
3576
3577static int __init gpiolib_dev_init(void)
3578{
3579 int ret;
3580
3581
3582 ret = bus_register(&gpio_bus_type);
3583 if (ret < 0) {
3584 pr_err("gpiolib: could not register GPIO bus type\n");
3585 return ret;
3586 }
3587
3588 ret = alloc_chrdev_region(&gpio_devt, 0, GPIO_DEV_MAX, "gpiochip");
3589 if (ret < 0) {
3590 pr_err("gpiolib: failed to allocate char dev region\n");
3591 bus_unregister(&gpio_bus_type);
3592 } else {
3593 gpiolib_initialized = true;
3594 gpiochip_setup_devs();
3595 }
3596 return ret;
3597}
3598core_initcall(gpiolib_dev_init);
3599
3600#ifdef CONFIG_DEBUG_FS
3601
3602static void gpiolib_dbg_show(struct seq_file *s, struct gpio_device *gdev)
3603{
3604 unsigned i;
3605 struct gpio_chip *chip = gdev->chip;
3606 unsigned gpio = gdev->base;
3607 struct gpio_desc *gdesc = &gdev->descs[0];
3608 int is_out;
3609 int is_irq;
3610
3611 for (i = 0; i < gdev->ngpio; i++, gpio++, gdesc++) {
3612 if (!test_bit(FLAG_REQUESTED, &gdesc->flags)) {
3613 if (gdesc->name) {
3614 seq_printf(s, " gpio-%-3d (%-20.20s)\n",
3615 gpio, gdesc->name);
3616 }
3617 continue;
3618 }
3619
3620 gpiod_get_direction(gdesc);
3621 is_out = test_bit(FLAG_IS_OUT, &gdesc->flags);
3622 is_irq = test_bit(FLAG_USED_AS_IRQ, &gdesc->flags);
3623 seq_printf(s, " gpio-%-3d (%-20.20s|%-20.20s) %s %s %s",
3624 gpio, gdesc->name ? gdesc->name : "", gdesc->label,
3625 is_out ? "out" : "in ",
3626 chip->get
3627 ? (chip->get(chip, i) ? "hi" : "lo")
3628 : "? ",
3629 is_irq ? "IRQ" : " ");
3630 seq_printf(s, "\n");
3631 }
3632}
3633
3634static void *gpiolib_seq_start(struct seq_file *s, loff_t *pos)
3635{
3636 unsigned long flags;
3637 struct gpio_device *gdev = NULL;
3638 loff_t index = *pos;
3639
3640 s->private = "";
3641
3642 spin_lock_irqsave(&gpio_lock, flags);
3643 list_for_each_entry(gdev, &gpio_devices, list)
3644 if (index-- == 0) {
3645 spin_unlock_irqrestore(&gpio_lock, flags);
3646 return gdev;
3647 }
3648 spin_unlock_irqrestore(&gpio_lock, flags);
3649
3650 return NULL;
3651}
3652
3653static void *gpiolib_seq_next(struct seq_file *s, void *v, loff_t *pos)
3654{
3655 unsigned long flags;
3656 struct gpio_device *gdev = v;
3657 void *ret = NULL;
3658
3659 spin_lock_irqsave(&gpio_lock, flags);
3660 if (list_is_last(&gdev->list, &gpio_devices))
3661 ret = NULL;
3662 else
3663 ret = list_entry(gdev->list.next, struct gpio_device, list);
3664 spin_unlock_irqrestore(&gpio_lock, flags);
3665
3666 s->private = "\n";
3667 ++*pos;
3668
3669 return ret;
3670}
3671
3672static void gpiolib_seq_stop(struct seq_file *s, void *v)
3673{
3674}
3675
3676static int gpiolib_seq_show(struct seq_file *s, void *v)
3677{
3678 struct gpio_device *gdev = v;
3679 struct gpio_chip *chip = gdev->chip;
3680 struct device *parent;
3681
3682 if (!chip) {
3683 seq_printf(s, "%s%s: (dangling chip)", (char *)s->private,
3684 dev_name(&gdev->dev));
3685 return 0;
3686 }
3687
3688 seq_printf(s, "%s%s: GPIOs %d-%d", (char *)s->private,
3689 dev_name(&gdev->dev),
3690 gdev->base, gdev->base + gdev->ngpio - 1);
3691 parent = chip->parent;
3692 if (parent)
3693 seq_printf(s, ", parent: %s/%s",
3694 parent->bus ? parent->bus->name : "no-bus",
3695 dev_name(parent));
3696 if (chip->label)
3697 seq_printf(s, ", %s", chip->label);
3698 if (chip->can_sleep)
3699 seq_printf(s, ", can sleep");
3700 seq_printf(s, ":\n");
3701
3702 if (chip->dbg_show)
3703 chip->dbg_show(s, chip);
3704 else
3705 gpiolib_dbg_show(s, gdev);
3706
3707 return 0;
3708}
3709
3710static const struct seq_operations gpiolib_seq_ops = {
3711 .start = gpiolib_seq_start,
3712 .next = gpiolib_seq_next,
3713 .stop = gpiolib_seq_stop,
3714 .show = gpiolib_seq_show,
3715};
3716
3717static int gpiolib_open(struct inode *inode, struct file *file)
3718{
3719 return seq_open(file, &gpiolib_seq_ops);
3720}
3721
3722static const struct file_operations gpiolib_operations = {
3723 .owner = THIS_MODULE,
3724 .open = gpiolib_open,
3725 .read = seq_read,
3726 .llseek = seq_lseek,
3727 .release = seq_release,
3728};
3729
3730static int __init gpiolib_debugfs_init(void)
3731{
3732
3733 (void) debugfs_create_file("gpio", S_IFREG | S_IRUGO,
3734 NULL, NULL, &gpiolib_operations);
3735 return 0;
3736}
3737subsys_initcall(gpiolib_debugfs_init);
3738
3739#endif
3740