1 // SPDX-License-Identifier: GPL-2.0
2 #include <linux/bitmap.h>
3 #include <linux/kernel.h>
4 #include <linux/module.h>
5 #include <linux/interrupt.h>
6 #include <linux/irq.h>
7 #include <linux/spinlock.h>
8 #include <linux/list.h>
9 #include <linux/device.h>
10 #include <linux/err.h>
11 #include <linux/debugfs.h>
12 #include <linux/seq_file.h>
13 #include <linux/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/fs.h>
21 #include <linux/compat.h>
22 #include <linux/file.h>
23 #include <uapi/linux/gpio.h>
24
25 #include "gpiolib.h"
26 #include "gpiolib-of.h"
27 #include "gpiolib-acpi.h"
28 #include "gpiolib-cdev.h"
29 #include "gpiolib-sysfs.h"
30
31 #define CREATE_TRACE_POINTS
32 #include <trace/events/gpio.h>
33
34 /* Implementation infrastructure for GPIO interfaces.
35 *
36 * The GPIO programming interface allows for inlining speed-critical
37 * get/set operations for common cases, so that access to SOC-integrated
38 * GPIOs can sometimes cost only an instruction or two per bit.
39 */
40
41
42 /* When debugging, extend minimal trust to callers and platform code.
43 * Also emit diagnostic messages that may help initial bringup, when
44 * board setup or driver bugs are most common.
45 *
46 * Otherwise, minimize overhead in what may be bitbanging codepaths.
47 */
48 #ifdef DEBUG
49 #define extra_checks 1
50 #else
51 #define extra_checks 0
52 #endif
53
54 /* Device and char device-related information */
55 static DEFINE_IDA(gpio_ida);
56 static dev_t gpio_devt;
57 #define GPIO_DEV_MAX 256 /* 256 GPIO chip devices supported */
58 static struct bus_type gpio_bus_type = {
59 .name = "gpio",
60 };
61
62 /*
63 * Number of GPIOs to use for the fast path in set array
64 */
65 #define FASTPATH_NGPIO CONFIG_GPIOLIB_FASTPATH_LIMIT
66
67 /* gpio_lock prevents conflicts during gpio_desc[] table updates.
68 * While any GPIO is requested, its gpio_chip is not removable;
69 * each GPIO's "requested" flag serves as a lock and refcount.
70 */
71 DEFINE_SPINLOCK(gpio_lock);
72
73 static DEFINE_MUTEX(gpio_lookup_lock);
74 static LIST_HEAD(gpio_lookup_list);
75 LIST_HEAD(gpio_devices);
76
77 static DEFINE_MUTEX(gpio_machine_hogs_mutex);
78 static LIST_HEAD(gpio_machine_hogs);
79
80 static void gpiochip_free_hogs(struct gpio_chip *gc);
81 static int gpiochip_add_irqchip(struct gpio_chip *gc,
82 struct lock_class_key *lock_key,
83 struct lock_class_key *request_key);
84 static void gpiochip_irqchip_remove(struct gpio_chip *gc);
85 static int gpiochip_irqchip_init_hw(struct gpio_chip *gc);
86 static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc);
87 static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc);
88
89 static bool gpiolib_initialized;
90
desc_set_label(struct gpio_desc * d,const char * label)91 static inline void desc_set_label(struct gpio_desc *d, const char *label)
92 {
93 d->label = label;
94 }
95
96 /**
97 * gpio_to_desc - Convert a GPIO number to its descriptor
98 * @gpio: global GPIO number
99 *
100 * Returns:
101 * The GPIO descriptor associated with the given GPIO, or %NULL if no GPIO
102 * with the given number exists in the system.
103 */
gpio_to_desc(unsigned gpio)104 struct gpio_desc *gpio_to_desc(unsigned gpio)
105 {
106 struct gpio_device *gdev;
107 unsigned long flags;
108
109 spin_lock_irqsave(&gpio_lock, flags);
110
111 list_for_each_entry(gdev, &gpio_devices, list) {
112 if (gdev->base <= gpio &&
113 gdev->base + gdev->ngpio > gpio) {
114 spin_unlock_irqrestore(&gpio_lock, flags);
115 return &gdev->descs[gpio - gdev->base];
116 }
117 }
118
119 spin_unlock_irqrestore(&gpio_lock, flags);
120
121 if (!gpio_is_valid(gpio))
122 WARN(1, "invalid GPIO %d\n", gpio);
123
124 return NULL;
125 }
126 EXPORT_SYMBOL_GPL(gpio_to_desc);
127
128 /**
129 * gpiochip_get_desc - get the GPIO descriptor corresponding to the given
130 * hardware number for this chip
131 * @gc: GPIO chip
132 * @hwnum: hardware number of the GPIO for this chip
133 *
134 * Returns:
135 * A pointer to the GPIO descriptor or ``ERR_PTR(-EINVAL)`` if no GPIO exists
136 * in the given chip for the specified hardware number.
137 */
gpiochip_get_desc(struct gpio_chip * gc,unsigned int hwnum)138 struct gpio_desc *gpiochip_get_desc(struct gpio_chip *gc,
139 unsigned int hwnum)
140 {
141 struct gpio_device *gdev = gc->gpiodev;
142
143 if (hwnum >= gdev->ngpio)
144 return ERR_PTR(-EINVAL);
145
146 return &gdev->descs[hwnum];
147 }
148 EXPORT_SYMBOL_GPL(gpiochip_get_desc);
149
150 /**
151 * desc_to_gpio - convert a GPIO descriptor to the integer namespace
152 * @desc: GPIO descriptor
153 *
154 * This should disappear in the future but is needed since we still
155 * use GPIO numbers for error messages and sysfs nodes.
156 *
157 * Returns:
158 * The global GPIO number for the GPIO specified by its descriptor.
159 */
desc_to_gpio(const struct gpio_desc * desc)160 int desc_to_gpio(const struct gpio_desc *desc)
161 {
162 return desc->gdev->base + (desc - &desc->gdev->descs[0]);
163 }
164 EXPORT_SYMBOL_GPL(desc_to_gpio);
165
166
167 /**
168 * gpiod_to_chip - Return the GPIO chip to which a GPIO descriptor belongs
169 * @desc: descriptor to return the chip of
170 */
gpiod_to_chip(const struct gpio_desc * desc)171 struct gpio_chip *gpiod_to_chip(const struct gpio_desc *desc)
172 {
173 if (!desc || !desc->gdev)
174 return NULL;
175 return desc->gdev->chip;
176 }
177 EXPORT_SYMBOL_GPL(gpiod_to_chip);
178
179 /* dynamic allocation of GPIOs, e.g. on a hotplugged device */
gpiochip_find_base(int ngpio)180 static int gpiochip_find_base(int ngpio)
181 {
182 struct gpio_device *gdev;
183 int base = ARCH_NR_GPIOS - ngpio;
184
185 list_for_each_entry_reverse(gdev, &gpio_devices, list) {
186 /* found a free space? */
187 if (gdev->base + gdev->ngpio <= base)
188 break;
189 else
190 /* nope, check the space right before the chip */
191 base = gdev->base - ngpio;
192 }
193
194 if (gpio_is_valid(base)) {
195 pr_debug("%s: found new base at %d\n", __func__, base);
196 return base;
197 } else {
198 pr_err("%s: cannot find free range\n", __func__);
199 return -ENOSPC;
200 }
201 }
202
203 /**
204 * gpiod_get_direction - return the current direction of a GPIO
205 * @desc: GPIO to get the direction of
206 *
207 * Returns 0 for output, 1 for input, or an error code in case of error.
208 *
209 * This function may sleep if gpiod_cansleep() is true.
210 */
gpiod_get_direction(struct gpio_desc * desc)211 int gpiod_get_direction(struct gpio_desc *desc)
212 {
213 struct gpio_chip *gc;
214 unsigned offset;
215 int ret;
216
217 gc = gpiod_to_chip(desc);
218 offset = gpio_chip_hwgpio(desc);
219
220 /*
221 * Open drain emulation using input mode may incorrectly report
222 * input here, fix that up.
223 */
224 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags) &&
225 test_bit(FLAG_IS_OUT, &desc->flags))
226 return 0;
227
228 if (!gc->get_direction)
229 return -ENOTSUPP;
230
231 ret = gc->get_direction(gc, offset);
232 if (ret < 0)
233 return ret;
234
235 /* GPIOF_DIR_IN or other positive, otherwise GPIOF_DIR_OUT */
236 if (ret > 0)
237 ret = 1;
238
239 assign_bit(FLAG_IS_OUT, &desc->flags, !ret);
240
241 return ret;
242 }
243 EXPORT_SYMBOL_GPL(gpiod_get_direction);
244
245 /*
246 * Add a new chip to the global chips list, keeping the list of chips sorted
247 * by range(means [base, base + ngpio - 1]) order.
248 *
249 * Return -EBUSY if the new chip overlaps with some other chip's integer
250 * space.
251 */
gpiodev_add_to_list(struct gpio_device * gdev)252 static int gpiodev_add_to_list(struct gpio_device *gdev)
253 {
254 struct gpio_device *prev, *next;
255
256 if (list_empty(&gpio_devices)) {
257 /* initial entry in list */
258 list_add_tail(&gdev->list, &gpio_devices);
259 return 0;
260 }
261
262 next = list_entry(gpio_devices.next, struct gpio_device, list);
263 if (gdev->base + gdev->ngpio <= next->base) {
264 /* add before first entry */
265 list_add(&gdev->list, &gpio_devices);
266 return 0;
267 }
268
269 prev = list_entry(gpio_devices.prev, struct gpio_device, list);
270 if (prev->base + prev->ngpio <= gdev->base) {
271 /* add behind last entry */
272 list_add_tail(&gdev->list, &gpio_devices);
273 return 0;
274 }
275
276 list_for_each_entry_safe(prev, next, &gpio_devices, list) {
277 /* at the end of the list */
278 if (&next->list == &gpio_devices)
279 break;
280
281 /* add between prev and next */
282 if (prev->base + prev->ngpio <= gdev->base
283 && gdev->base + gdev->ngpio <= next->base) {
284 list_add(&gdev->list, &prev->list);
285 return 0;
286 }
287 }
288
289 dev_err(&gdev->dev, "GPIO integer space overlap, cannot add chip\n");
290 return -EBUSY;
291 }
292
293 /*
294 * Convert a GPIO name to its descriptor
295 * Note that there is no guarantee that GPIO names are globally unique!
296 * Hence this function will return, if it exists, a reference to the first GPIO
297 * line found that matches the given name.
298 */
gpio_name_to_desc(const char * const name)299 static struct gpio_desc *gpio_name_to_desc(const char * const name)
300 {
301 struct gpio_device *gdev;
302 unsigned long flags;
303
304 if (!name)
305 return NULL;
306
307 spin_lock_irqsave(&gpio_lock, flags);
308
309 list_for_each_entry(gdev, &gpio_devices, list) {
310 int i;
311
312 for (i = 0; i != gdev->ngpio; ++i) {
313 struct gpio_desc *desc = &gdev->descs[i];
314
315 if (!desc->name)
316 continue;
317
318 if (!strcmp(desc->name, name)) {
319 spin_unlock_irqrestore(&gpio_lock, flags);
320 return desc;
321 }
322 }
323 }
324
325 spin_unlock_irqrestore(&gpio_lock, flags);
326
327 return NULL;
328 }
329
330 /*
331 * Take the names from gc->names and assign them to their GPIO descriptors.
332 * Warn if a name is already used for a GPIO line on a different GPIO chip.
333 *
334 * Note that:
335 * 1. Non-unique names are still accepted,
336 * 2. Name collisions within the same GPIO chip are not reported.
337 */
gpiochip_set_desc_names(struct gpio_chip * gc)338 static int gpiochip_set_desc_names(struct gpio_chip *gc)
339 {
340 struct gpio_device *gdev = gc->gpiodev;
341 int i;
342
343 /* First check all names if they are unique */
344 for (i = 0; i != gc->ngpio; ++i) {
345 struct gpio_desc *gpio;
346
347 gpio = gpio_name_to_desc(gc->names[i]);
348 if (gpio)
349 dev_warn(&gdev->dev,
350 "Detected name collision for GPIO name '%s'\n",
351 gc->names[i]);
352 }
353
354 /* Then add all names to the GPIO descriptors */
355 for (i = 0; i != gc->ngpio; ++i)
356 gdev->descs[i].name = gc->names[i];
357
358 return 0;
359 }
360
361 /*
362 * devprop_gpiochip_set_names - Set GPIO line names using device properties
363 * @chip: GPIO chip whose lines should be named, if possible
364 *
365 * Looks for device property "gpio-line-names" and if it exists assigns
366 * GPIO line names for the chip. The memory allocated for the assigned
367 * names belong to the underlying firmware node and should not be released
368 * by the caller.
369 */
devprop_gpiochip_set_names(struct gpio_chip * chip)370 static int devprop_gpiochip_set_names(struct gpio_chip *chip)
371 {
372 struct gpio_device *gdev = chip->gpiodev;
373 struct fwnode_handle *fwnode = dev_fwnode(&gdev->dev);
374 const char **names;
375 int ret, i;
376 int count;
377
378 count = fwnode_property_string_array_count(fwnode, "gpio-line-names");
379 if (count < 0)
380 return 0;
381
382 if (count > gdev->ngpio) {
383 dev_warn(&gdev->dev, "gpio-line-names is length %d but should be at most length %d",
384 count, gdev->ngpio);
385 count = gdev->ngpio;
386 }
387
388 names = kcalloc(count, sizeof(*names), GFP_KERNEL);
389 if (!names)
390 return -ENOMEM;
391
392 ret = fwnode_property_read_string_array(fwnode, "gpio-line-names",
393 names, count);
394 if (ret < 0) {
395 dev_warn(&gdev->dev, "failed to read GPIO line names\n");
396 kfree(names);
397 return ret;
398 }
399
400 for (i = 0; i < count; i++)
401 gdev->descs[i].name = names[i];
402
403 kfree(names);
404
405 return 0;
406 }
407
gpiochip_allocate_mask(struct gpio_chip * gc)408 static unsigned long *gpiochip_allocate_mask(struct gpio_chip *gc)
409 {
410 unsigned long *p;
411
412 p = bitmap_alloc(gc->ngpio, GFP_KERNEL);
413 if (!p)
414 return NULL;
415
416 /* Assume by default all GPIOs are valid */
417 bitmap_fill(p, gc->ngpio);
418
419 return p;
420 }
421
gpiochip_alloc_valid_mask(struct gpio_chip * gc)422 static int gpiochip_alloc_valid_mask(struct gpio_chip *gc)
423 {
424 if (!(of_gpio_need_valid_mask(gc) || gc->init_valid_mask))
425 return 0;
426
427 gc->valid_mask = gpiochip_allocate_mask(gc);
428 if (!gc->valid_mask)
429 return -ENOMEM;
430
431 return 0;
432 }
433
gpiochip_init_valid_mask(struct gpio_chip * gc)434 static int gpiochip_init_valid_mask(struct gpio_chip *gc)
435 {
436 if (gc->init_valid_mask)
437 return gc->init_valid_mask(gc,
438 gc->valid_mask,
439 gc->ngpio);
440
441 return 0;
442 }
443
gpiochip_free_valid_mask(struct gpio_chip * gc)444 static void gpiochip_free_valid_mask(struct gpio_chip *gc)
445 {
446 bitmap_free(gc->valid_mask);
447 gc->valid_mask = NULL;
448 }
449
gpiochip_add_pin_ranges(struct gpio_chip * gc)450 static int gpiochip_add_pin_ranges(struct gpio_chip *gc)
451 {
452 if (gc->add_pin_ranges)
453 return gc->add_pin_ranges(gc);
454
455 return 0;
456 }
457
gpiochip_line_is_valid(const struct gpio_chip * gc,unsigned int offset)458 bool gpiochip_line_is_valid(const struct gpio_chip *gc,
459 unsigned int offset)
460 {
461 /* No mask means all valid */
462 if (likely(!gc->valid_mask))
463 return true;
464 return test_bit(offset, gc->valid_mask);
465 }
466 EXPORT_SYMBOL_GPL(gpiochip_line_is_valid);
467
gpiodevice_release(struct device * dev)468 static void gpiodevice_release(struct device *dev)
469 {
470 struct gpio_device *gdev = dev_get_drvdata(dev);
471 unsigned long flags;
472
473 spin_lock_irqsave(&gpio_lock, flags);
474 list_del(&gdev->list);
475 spin_unlock_irqrestore(&gpio_lock, flags);
476
477 ida_free(&gpio_ida, gdev->id);
478 kfree_const(gdev->label);
479 kfree(gdev->descs);
480 kfree(gdev);
481 }
482
483 #ifdef CONFIG_GPIO_CDEV
484 #define gcdev_register(gdev, devt) gpiolib_cdev_register((gdev), (devt))
485 #define gcdev_unregister(gdev) gpiolib_cdev_unregister((gdev))
486 #else
487 /*
488 * gpiolib_cdev_register() indirectly calls device_add(), which is still
489 * required even when cdev is not selected.
490 */
491 #define gcdev_register(gdev, devt) device_add(&(gdev)->dev)
492 #define gcdev_unregister(gdev) device_del(&(gdev)->dev)
493 #endif
494
gpiochip_setup_dev(struct gpio_device * gdev)495 static int gpiochip_setup_dev(struct gpio_device *gdev)
496 {
497 int ret;
498
499 ret = gcdev_register(gdev, gpio_devt);
500 if (ret)
501 return ret;
502
503 ret = gpiochip_sysfs_register(gdev);
504 if (ret)
505 goto err_remove_device;
506
507 /* From this point, the .release() function cleans up gpio_device */
508 gdev->dev.release = gpiodevice_release;
509 dev_dbg(&gdev->dev, "registered GPIOs %d to %d on %s\n", gdev->base,
510 gdev->base + gdev->ngpio - 1, gdev->chip->label ? : "generic");
511
512 return 0;
513
514 err_remove_device:
515 gcdev_unregister(gdev);
516 return ret;
517 }
518
gpiochip_machine_hog(struct gpio_chip * gc,struct gpiod_hog * hog)519 static void gpiochip_machine_hog(struct gpio_chip *gc, struct gpiod_hog *hog)
520 {
521 struct gpio_desc *desc;
522 int rv;
523
524 desc = gpiochip_get_desc(gc, hog->chip_hwnum);
525 if (IS_ERR(desc)) {
526 chip_err(gc, "%s: unable to get GPIO desc: %ld\n", __func__,
527 PTR_ERR(desc));
528 return;
529 }
530
531 if (test_bit(FLAG_IS_HOGGED, &desc->flags))
532 return;
533
534 rv = gpiod_hog(desc, hog->line_name, hog->lflags, hog->dflags);
535 if (rv)
536 gpiod_err(desc, "%s: unable to hog GPIO line (%s:%u): %d\n",
537 __func__, gc->label, hog->chip_hwnum, rv);
538 }
539
machine_gpiochip_add(struct gpio_chip * gc)540 static void machine_gpiochip_add(struct gpio_chip *gc)
541 {
542 struct gpiod_hog *hog;
543
544 mutex_lock(&gpio_machine_hogs_mutex);
545
546 list_for_each_entry(hog, &gpio_machine_hogs, list) {
547 if (!strcmp(gc->label, hog->chip_label))
548 gpiochip_machine_hog(gc, hog);
549 }
550
551 mutex_unlock(&gpio_machine_hogs_mutex);
552 }
553
gpiochip_setup_devs(void)554 static void gpiochip_setup_devs(void)
555 {
556 struct gpio_device *gdev;
557 int ret;
558
559 list_for_each_entry(gdev, &gpio_devices, list) {
560 ret = gpiochip_setup_dev(gdev);
561 if (ret)
562 dev_err(&gdev->dev,
563 "Failed to initialize gpio device (%d)\n", ret);
564 }
565 }
566
gpiochip_add_data_with_key(struct gpio_chip * gc,void * data,struct lock_class_key * lock_key,struct lock_class_key * request_key)567 int gpiochip_add_data_with_key(struct gpio_chip *gc, void *data,
568 struct lock_class_key *lock_key,
569 struct lock_class_key *request_key)
570 {
571 struct fwnode_handle *fwnode = gc->parent ? dev_fwnode(gc->parent) : NULL;
572 unsigned long flags;
573 int ret = 0;
574 unsigned i;
575 int base = gc->base;
576 struct gpio_device *gdev;
577
578 /*
579 * First: allocate and populate the internal stat container, and
580 * set up the struct device.
581 */
582 gdev = kzalloc(sizeof(*gdev), GFP_KERNEL);
583 if (!gdev)
584 return -ENOMEM;
585 gdev->dev.bus = &gpio_bus_type;
586 gdev->chip = gc;
587 gc->gpiodev = gdev;
588 if (gc->parent) {
589 gdev->dev.parent = gc->parent;
590 gdev->dev.of_node = gc->parent->of_node;
591 }
592
593 #ifdef CONFIG_OF_GPIO
594 /* If the gpiochip has an assigned OF node this takes precedence */
595 if (gc->of_node)
596 gdev->dev.of_node = gc->of_node;
597 else
598 gc->of_node = gdev->dev.of_node;
599 #endif
600
601 /*
602 * Assign fwnode depending on the result of the previous calls,
603 * if none of them succeed, assign it to the parent's one.
604 */
605 gdev->dev.fwnode = dev_fwnode(&gdev->dev) ?: fwnode;
606
607 gdev->id = ida_alloc(&gpio_ida, GFP_KERNEL);
608 if (gdev->id < 0) {
609 ret = gdev->id;
610 goto err_free_gdev;
611 }
612
613 ret = dev_set_name(&gdev->dev, GPIOCHIP_NAME "%d", gdev->id);
614 if (ret)
615 goto err_free_ida;
616
617 device_initialize(&gdev->dev);
618 dev_set_drvdata(&gdev->dev, gdev);
619 if (gc->parent && gc->parent->driver)
620 gdev->owner = gc->parent->driver->owner;
621 else if (gc->owner)
622 /* TODO: remove chip->owner */
623 gdev->owner = gc->owner;
624 else
625 gdev->owner = THIS_MODULE;
626
627 gdev->descs = kcalloc(gc->ngpio, sizeof(gdev->descs[0]), GFP_KERNEL);
628 if (!gdev->descs) {
629 ret = -ENOMEM;
630 goto err_free_dev_name;
631 }
632
633 if (gc->ngpio == 0) {
634 chip_err(gc, "tried to insert a GPIO chip with zero lines\n");
635 ret = -EINVAL;
636 goto err_free_descs;
637 }
638
639 if (gc->ngpio > FASTPATH_NGPIO)
640 chip_warn(gc, "line cnt %u is greater than fast path cnt %u\n",
641 gc->ngpio, FASTPATH_NGPIO);
642
643 gdev->label = kstrdup_const(gc->label ?: "unknown", GFP_KERNEL);
644 if (!gdev->label) {
645 ret = -ENOMEM;
646 goto err_free_descs;
647 }
648
649 gdev->ngpio = gc->ngpio;
650 gdev->data = data;
651
652 spin_lock_irqsave(&gpio_lock, flags);
653
654 /*
655 * TODO: this allocates a Linux GPIO number base in the global
656 * GPIO numberspace for this chip. In the long run we want to
657 * get *rid* of this numberspace and use only descriptors, but
658 * it may be a pipe dream. It will not happen before we get rid
659 * of the sysfs interface anyways.
660 */
661 if (base < 0) {
662 base = gpiochip_find_base(gc->ngpio);
663 if (base < 0) {
664 ret = base;
665 spin_unlock_irqrestore(&gpio_lock, flags);
666 goto err_free_label;
667 }
668 /*
669 * TODO: it should not be necessary to reflect the assigned
670 * base outside of the GPIO subsystem. Go over drivers and
671 * see if anyone makes use of this, else drop this and assign
672 * a poison instead.
673 */
674 gc->base = base;
675 }
676 gdev->base = base;
677
678 ret = gpiodev_add_to_list(gdev);
679 if (ret) {
680 spin_unlock_irqrestore(&gpio_lock, flags);
681 goto err_free_label;
682 }
683
684 for (i = 0; i < gc->ngpio; i++)
685 gdev->descs[i].gdev = gdev;
686
687 spin_unlock_irqrestore(&gpio_lock, flags);
688
689 BLOCKING_INIT_NOTIFIER_HEAD(&gdev->notifier);
690
691 #ifdef CONFIG_PINCTRL
692 INIT_LIST_HEAD(&gdev->pin_ranges);
693 #endif
694
695 if (gc->names)
696 ret = gpiochip_set_desc_names(gc);
697 else
698 ret = devprop_gpiochip_set_names(gc);
699 if (ret)
700 goto err_remove_from_list;
701
702 ret = gpiochip_alloc_valid_mask(gc);
703 if (ret)
704 goto err_remove_from_list;
705
706 ret = of_gpiochip_add(gc);
707 if (ret)
708 goto err_free_gpiochip_mask;
709
710 ret = gpiochip_init_valid_mask(gc);
711 if (ret)
712 goto err_remove_of_chip;
713
714 for (i = 0; i < gc->ngpio; i++) {
715 struct gpio_desc *desc = &gdev->descs[i];
716
717 if (gc->get_direction && gpiochip_line_is_valid(gc, i)) {
718 assign_bit(FLAG_IS_OUT,
719 &desc->flags, !gc->get_direction(gc, i));
720 } else {
721 assign_bit(FLAG_IS_OUT,
722 &desc->flags, !gc->direction_input);
723 }
724 }
725
726 ret = gpiochip_add_pin_ranges(gc);
727 if (ret)
728 goto err_remove_of_chip;
729
730 acpi_gpiochip_add(gc);
731
732 machine_gpiochip_add(gc);
733
734 ret = gpiochip_irqchip_init_valid_mask(gc);
735 if (ret)
736 goto err_remove_acpi_chip;
737
738 ret = gpiochip_irqchip_init_hw(gc);
739 if (ret)
740 goto err_remove_acpi_chip;
741
742 ret = gpiochip_add_irqchip(gc, lock_key, request_key);
743 if (ret)
744 goto err_remove_irqchip_mask;
745
746 /*
747 * By first adding the chardev, and then adding the device,
748 * we get a device node entry in sysfs under
749 * /sys/bus/gpio/devices/gpiochipN/dev that can be used for
750 * coldplug of device nodes and other udev business.
751 * We can do this only if gpiolib has been initialized.
752 * Otherwise, defer until later.
753 */
754 if (gpiolib_initialized) {
755 ret = gpiochip_setup_dev(gdev);
756 if (ret)
757 goto err_remove_irqchip;
758 }
759 return 0;
760
761 err_remove_irqchip:
762 gpiochip_irqchip_remove(gc);
763 err_remove_irqchip_mask:
764 gpiochip_irqchip_free_valid_mask(gc);
765 err_remove_acpi_chip:
766 acpi_gpiochip_remove(gc);
767 err_remove_of_chip:
768 gpiochip_free_hogs(gc);
769 of_gpiochip_remove(gc);
770 err_free_gpiochip_mask:
771 gpiochip_remove_pin_ranges(gc);
772 gpiochip_free_valid_mask(gc);
773 err_remove_from_list:
774 spin_lock_irqsave(&gpio_lock, flags);
775 list_del(&gdev->list);
776 spin_unlock_irqrestore(&gpio_lock, flags);
777 err_free_label:
778 kfree_const(gdev->label);
779 err_free_descs:
780 kfree(gdev->descs);
781 err_free_dev_name:
782 kfree(dev_name(&gdev->dev));
783 err_free_ida:
784 ida_free(&gpio_ida, gdev->id);
785 err_free_gdev:
786 /* failures here can mean systems won't boot... */
787 pr_err("%s: GPIOs %d..%d (%s) failed to register, %d\n", __func__,
788 gdev->base, gdev->base + gdev->ngpio - 1,
789 gc->label ? : "generic", ret);
790 kfree(gdev);
791 return ret;
792 }
793 EXPORT_SYMBOL_GPL(gpiochip_add_data_with_key);
794
795 /**
796 * gpiochip_get_data() - get per-subdriver data for the chip
797 * @gc: GPIO chip
798 *
799 * Returns:
800 * The per-subdriver data for the chip.
801 */
gpiochip_get_data(struct gpio_chip * gc)802 void *gpiochip_get_data(struct gpio_chip *gc)
803 {
804 return gc->gpiodev->data;
805 }
806 EXPORT_SYMBOL_GPL(gpiochip_get_data);
807
808 /**
809 * gpiochip_remove() - unregister a gpio_chip
810 * @gc: the chip to unregister
811 *
812 * A gpio_chip with any GPIOs still requested may not be removed.
813 */
gpiochip_remove(struct gpio_chip * gc)814 void gpiochip_remove(struct gpio_chip *gc)
815 {
816 struct gpio_device *gdev = gc->gpiodev;
817 unsigned long flags;
818 unsigned int i;
819
820 /* FIXME: should the legacy sysfs handling be moved to gpio_device? */
821 gpiochip_sysfs_unregister(gdev);
822 gpiochip_free_hogs(gc);
823 /* Numb the device, cancelling all outstanding operations */
824 gdev->chip = NULL;
825 gpiochip_irqchip_remove(gc);
826 acpi_gpiochip_remove(gc);
827 of_gpiochip_remove(gc);
828 gpiochip_remove_pin_ranges(gc);
829 gpiochip_free_valid_mask(gc);
830 /*
831 * We accept no more calls into the driver from this point, so
832 * NULL the driver data pointer
833 */
834 gdev->data = NULL;
835
836 spin_lock_irqsave(&gpio_lock, flags);
837 for (i = 0; i < gdev->ngpio; i++) {
838 if (gpiochip_is_requested(gc, i))
839 break;
840 }
841 spin_unlock_irqrestore(&gpio_lock, flags);
842
843 if (i != gdev->ngpio)
844 dev_crit(&gdev->dev,
845 "REMOVING GPIOCHIP WITH GPIOS STILL REQUESTED\n");
846
847 /*
848 * The gpiochip side puts its use of the device to rest here:
849 * if there are no userspace clients, the chardev and device will
850 * be removed, else it will be dangling until the last user is
851 * gone.
852 */
853 gcdev_unregister(gdev);
854 put_device(&gdev->dev);
855 }
856 EXPORT_SYMBOL_GPL(gpiochip_remove);
857
858 /**
859 * gpiochip_find() - iterator for locating a specific gpio_chip
860 * @data: data to pass to match function
861 * @match: Callback function to check gpio_chip
862 *
863 * Similar to bus_find_device. It returns a reference to a gpio_chip as
864 * determined by a user supplied @match callback. The callback should return
865 * 0 if the device doesn't match and non-zero if it does. If the callback is
866 * non-zero, this function will return to the caller and not iterate over any
867 * more gpio_chips.
868 */
gpiochip_find(void * data,int (* match)(struct gpio_chip * gc,void * data))869 struct gpio_chip *gpiochip_find(void *data,
870 int (*match)(struct gpio_chip *gc,
871 void *data))
872 {
873 struct gpio_device *gdev;
874 struct gpio_chip *gc = NULL;
875 unsigned long flags;
876
877 spin_lock_irqsave(&gpio_lock, flags);
878 list_for_each_entry(gdev, &gpio_devices, list)
879 if (gdev->chip && match(gdev->chip, data)) {
880 gc = gdev->chip;
881 break;
882 }
883
884 spin_unlock_irqrestore(&gpio_lock, flags);
885
886 return gc;
887 }
888 EXPORT_SYMBOL_GPL(gpiochip_find);
889
gpiochip_match_name(struct gpio_chip * gc,void * data)890 static int gpiochip_match_name(struct gpio_chip *gc, void *data)
891 {
892 const char *name = data;
893
894 return !strcmp(gc->label, name);
895 }
896
find_chip_by_name(const char * name)897 static struct gpio_chip *find_chip_by_name(const char *name)
898 {
899 return gpiochip_find((void *)name, gpiochip_match_name);
900 }
901
902 #ifdef CONFIG_GPIOLIB_IRQCHIP
903
904 /*
905 * The following is irqchip helper code for gpiochips.
906 */
907
gpiochip_irqchip_init_hw(struct gpio_chip * gc)908 static int gpiochip_irqchip_init_hw(struct gpio_chip *gc)
909 {
910 struct gpio_irq_chip *girq = &gc->irq;
911
912 if (!girq->init_hw)
913 return 0;
914
915 return girq->init_hw(gc);
916 }
917
gpiochip_irqchip_init_valid_mask(struct gpio_chip * gc)918 static int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc)
919 {
920 struct gpio_irq_chip *girq = &gc->irq;
921
922 if (!girq->init_valid_mask)
923 return 0;
924
925 girq->valid_mask = gpiochip_allocate_mask(gc);
926 if (!girq->valid_mask)
927 return -ENOMEM;
928
929 girq->init_valid_mask(gc, girq->valid_mask, gc->ngpio);
930
931 return 0;
932 }
933
gpiochip_irqchip_free_valid_mask(struct gpio_chip * gc)934 static void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc)
935 {
936 bitmap_free(gc->irq.valid_mask);
937 gc->irq.valid_mask = NULL;
938 }
939
gpiochip_irqchip_irq_valid(const struct gpio_chip * gc,unsigned int offset)940 bool gpiochip_irqchip_irq_valid(const struct gpio_chip *gc,
941 unsigned int offset)
942 {
943 if (!gpiochip_line_is_valid(gc, offset))
944 return false;
945 /* No mask means all valid */
946 if (likely(!gc->irq.valid_mask))
947 return true;
948 return test_bit(offset, gc->irq.valid_mask);
949 }
950 EXPORT_SYMBOL_GPL(gpiochip_irqchip_irq_valid);
951
952 /**
953 * gpiochip_set_cascaded_irqchip() - connects a cascaded irqchip to a gpiochip
954 * @gc: the gpiochip to set the irqchip chain to
955 * @parent_irq: the irq number corresponding to the parent IRQ for this
956 * cascaded irqchip
957 * @parent_handler: the parent interrupt handler for the accumulated IRQ
958 * coming out of the gpiochip. If the interrupt is nested rather than
959 * cascaded, pass NULL in this handler argument
960 */
gpiochip_set_cascaded_irqchip(struct gpio_chip * gc,unsigned int parent_irq,irq_flow_handler_t parent_handler)961 static void gpiochip_set_cascaded_irqchip(struct gpio_chip *gc,
962 unsigned int parent_irq,
963 irq_flow_handler_t parent_handler)
964 {
965 struct gpio_irq_chip *girq = &gc->irq;
966 struct device *dev = &gc->gpiodev->dev;
967
968 if (!girq->domain) {
969 chip_err(gc, "called %s before setting up irqchip\n",
970 __func__);
971 return;
972 }
973
974 if (parent_handler) {
975 if (gc->can_sleep) {
976 chip_err(gc,
977 "you cannot have chained interrupts on a chip that may sleep\n");
978 return;
979 }
980 girq->parents = devm_kcalloc(dev, 1,
981 sizeof(*girq->parents),
982 GFP_KERNEL);
983 if (!girq->parents) {
984 chip_err(gc, "out of memory allocating parent IRQ\n");
985 return;
986 }
987 girq->parents[0] = parent_irq;
988 girq->num_parents = 1;
989 /*
990 * The parent irqchip is already using the chip_data for this
991 * irqchip, so our callbacks simply use the handler_data.
992 */
993 irq_set_chained_handler_and_data(parent_irq, parent_handler,
994 gc);
995 }
996 }
997
998 /**
999 * gpiochip_set_nested_irqchip() - connects a nested irqchip to a gpiochip
1000 * @gc: the gpiochip to set the irqchip nested handler to
1001 * @irqchip: the irqchip to nest to the gpiochip
1002 * @parent_irq: the irq number corresponding to the parent IRQ for this
1003 * nested irqchip
1004 */
gpiochip_set_nested_irqchip(struct gpio_chip * gc,struct irq_chip * irqchip,unsigned int parent_irq)1005 void gpiochip_set_nested_irqchip(struct gpio_chip *gc,
1006 struct irq_chip *irqchip,
1007 unsigned int parent_irq)
1008 {
1009 gpiochip_set_cascaded_irqchip(gc, parent_irq, NULL);
1010 }
1011 EXPORT_SYMBOL_GPL(gpiochip_set_nested_irqchip);
1012
1013 #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1014
1015 /**
1016 * gpiochip_set_hierarchical_irqchip() - connects a hierarchical irqchip
1017 * to a gpiochip
1018 * @gc: the gpiochip to set the irqchip hierarchical handler to
1019 * @irqchip: the irqchip to handle this level of the hierarchy, the interrupt
1020 * will then percolate up to the parent
1021 */
gpiochip_set_hierarchical_irqchip(struct gpio_chip * gc,struct irq_chip * irqchip)1022 static void gpiochip_set_hierarchical_irqchip(struct gpio_chip *gc,
1023 struct irq_chip *irqchip)
1024 {
1025 /* DT will deal with mapping each IRQ as we go along */
1026 if (is_of_node(gc->irq.fwnode))
1027 return;
1028
1029 /*
1030 * This is for legacy and boardfile "irqchip" fwnodes: allocate
1031 * irqs upfront instead of dynamically since we don't have the
1032 * dynamic type of allocation that hardware description languages
1033 * provide. Once all GPIO drivers using board files are gone from
1034 * the kernel we can delete this code, but for a transitional period
1035 * it is necessary to keep this around.
1036 */
1037 if (is_fwnode_irqchip(gc->irq.fwnode)) {
1038 int i;
1039 int ret;
1040
1041 for (i = 0; i < gc->ngpio; i++) {
1042 struct irq_fwspec fwspec;
1043 unsigned int parent_hwirq;
1044 unsigned int parent_type;
1045 struct gpio_irq_chip *girq = &gc->irq;
1046
1047 /*
1048 * We call the child to parent translation function
1049 * only to check if the child IRQ is valid or not.
1050 * Just pick the rising edge type here as that is what
1051 * we likely need to support.
1052 */
1053 ret = girq->child_to_parent_hwirq(gc, i,
1054 IRQ_TYPE_EDGE_RISING,
1055 &parent_hwirq,
1056 &parent_type);
1057 if (ret) {
1058 chip_err(gc, "skip set-up on hwirq %d\n",
1059 i);
1060 continue;
1061 }
1062
1063 fwspec.fwnode = gc->irq.fwnode;
1064 /* This is the hwirq for the GPIO line side of things */
1065 fwspec.param[0] = girq->child_offset_to_irq(gc, i);
1066 /* Just pick something */
1067 fwspec.param[1] = IRQ_TYPE_EDGE_RISING;
1068 fwspec.param_count = 2;
1069 ret = __irq_domain_alloc_irqs(gc->irq.domain,
1070 /* just pick something */
1071 -1,
1072 1,
1073 NUMA_NO_NODE,
1074 &fwspec,
1075 false,
1076 NULL);
1077 if (ret < 0) {
1078 chip_err(gc,
1079 "can not allocate irq for GPIO line %d parent hwirq %d in hierarchy domain: %d\n",
1080 i, parent_hwirq,
1081 ret);
1082 }
1083 }
1084 }
1085
1086 chip_err(gc, "%s unknown fwnode type proceed anyway\n", __func__);
1087
1088 return;
1089 }
1090
gpiochip_hierarchy_irq_domain_translate(struct irq_domain * d,struct irq_fwspec * fwspec,unsigned long * hwirq,unsigned int * type)1091 static int gpiochip_hierarchy_irq_domain_translate(struct irq_domain *d,
1092 struct irq_fwspec *fwspec,
1093 unsigned long *hwirq,
1094 unsigned int *type)
1095 {
1096 /* We support standard DT translation */
1097 if (is_of_node(fwspec->fwnode) && fwspec->param_count == 2) {
1098 return irq_domain_translate_twocell(d, fwspec, hwirq, type);
1099 }
1100
1101 /* This is for board files and others not using DT */
1102 if (is_fwnode_irqchip(fwspec->fwnode)) {
1103 int ret;
1104
1105 ret = irq_domain_translate_twocell(d, fwspec, hwirq, type);
1106 if (ret)
1107 return ret;
1108 WARN_ON(*type == IRQ_TYPE_NONE);
1109 return 0;
1110 }
1111 return -EINVAL;
1112 }
1113
gpiochip_hierarchy_irq_domain_alloc(struct irq_domain * d,unsigned int irq,unsigned int nr_irqs,void * data)1114 static int gpiochip_hierarchy_irq_domain_alloc(struct irq_domain *d,
1115 unsigned int irq,
1116 unsigned int nr_irqs,
1117 void *data)
1118 {
1119 struct gpio_chip *gc = d->host_data;
1120 irq_hw_number_t hwirq;
1121 unsigned int type = IRQ_TYPE_NONE;
1122 struct irq_fwspec *fwspec = data;
1123 void *parent_arg;
1124 unsigned int parent_hwirq;
1125 unsigned int parent_type;
1126 struct gpio_irq_chip *girq = &gc->irq;
1127 int ret;
1128
1129 /*
1130 * The nr_irqs parameter is always one except for PCI multi-MSI
1131 * so this should not happen.
1132 */
1133 WARN_ON(nr_irqs != 1);
1134
1135 ret = gc->irq.child_irq_domain_ops.translate(d, fwspec, &hwirq, &type);
1136 if (ret)
1137 return ret;
1138
1139 chip_dbg(gc, "allocate IRQ %d, hwirq %lu\n", irq, hwirq);
1140
1141 ret = girq->child_to_parent_hwirq(gc, hwirq, type,
1142 &parent_hwirq, &parent_type);
1143 if (ret) {
1144 chip_err(gc, "can't look up hwirq %lu\n", hwirq);
1145 return ret;
1146 }
1147 chip_dbg(gc, "found parent hwirq %u\n", parent_hwirq);
1148
1149 /*
1150 * We set handle_bad_irq because the .set_type() should
1151 * always be invoked and set the right type of handler.
1152 */
1153 irq_domain_set_info(d,
1154 irq,
1155 hwirq,
1156 gc->irq.chip,
1157 gc,
1158 girq->handler,
1159 NULL, NULL);
1160 irq_set_probe(irq);
1161
1162 /* This parent only handles asserted level IRQs */
1163 parent_arg = girq->populate_parent_alloc_arg(gc, parent_hwirq, parent_type);
1164 if (!parent_arg)
1165 return -ENOMEM;
1166
1167 chip_dbg(gc, "alloc_irqs_parent for %d parent hwirq %d\n",
1168 irq, parent_hwirq);
1169 irq_set_lockdep_class(irq, gc->irq.lock_key, gc->irq.request_key);
1170 ret = irq_domain_alloc_irqs_parent(d, irq, 1, parent_arg);
1171 /*
1172 * If the parent irqdomain is msi, the interrupts have already
1173 * been allocated, so the EEXIST is good.
1174 */
1175 if (irq_domain_is_msi(d->parent) && (ret == -EEXIST))
1176 ret = 0;
1177 if (ret)
1178 chip_err(gc,
1179 "failed to allocate parent hwirq %d for hwirq %lu\n",
1180 parent_hwirq, hwirq);
1181
1182 kfree(parent_arg);
1183 return ret;
1184 }
1185
gpiochip_child_offset_to_irq_noop(struct gpio_chip * gc,unsigned int offset)1186 static unsigned int gpiochip_child_offset_to_irq_noop(struct gpio_chip *gc,
1187 unsigned int offset)
1188 {
1189 return offset;
1190 }
1191
gpiochip_hierarchy_setup_domain_ops(struct irq_domain_ops * ops)1192 static void gpiochip_hierarchy_setup_domain_ops(struct irq_domain_ops *ops)
1193 {
1194 ops->activate = gpiochip_irq_domain_activate;
1195 ops->deactivate = gpiochip_irq_domain_deactivate;
1196 ops->alloc = gpiochip_hierarchy_irq_domain_alloc;
1197 ops->free = irq_domain_free_irqs_common;
1198
1199 /*
1200 * We only allow overriding the translate() function for
1201 * hierarchical chips, and this should only be done if the user
1202 * really need something other than 1:1 translation.
1203 */
1204 if (!ops->translate)
1205 ops->translate = gpiochip_hierarchy_irq_domain_translate;
1206 }
1207
gpiochip_hierarchy_add_domain(struct gpio_chip * gc)1208 static int gpiochip_hierarchy_add_domain(struct gpio_chip *gc)
1209 {
1210 if (!gc->irq.child_to_parent_hwirq ||
1211 !gc->irq.fwnode) {
1212 chip_err(gc, "missing irqdomain vital data\n");
1213 return -EINVAL;
1214 }
1215
1216 if (!gc->irq.child_offset_to_irq)
1217 gc->irq.child_offset_to_irq = gpiochip_child_offset_to_irq_noop;
1218
1219 if (!gc->irq.populate_parent_alloc_arg)
1220 gc->irq.populate_parent_alloc_arg =
1221 gpiochip_populate_parent_fwspec_twocell;
1222
1223 gpiochip_hierarchy_setup_domain_ops(&gc->irq.child_irq_domain_ops);
1224
1225 gc->irq.domain = irq_domain_create_hierarchy(
1226 gc->irq.parent_domain,
1227 0,
1228 gc->ngpio,
1229 gc->irq.fwnode,
1230 &gc->irq.child_irq_domain_ops,
1231 gc);
1232
1233 if (!gc->irq.domain)
1234 return -ENOMEM;
1235
1236 gpiochip_set_hierarchical_irqchip(gc, gc->irq.chip);
1237
1238 return 0;
1239 }
1240
gpiochip_hierarchy_is_hierarchical(struct gpio_chip * gc)1241 static bool gpiochip_hierarchy_is_hierarchical(struct gpio_chip *gc)
1242 {
1243 return !!gc->irq.parent_domain;
1244 }
1245
gpiochip_populate_parent_fwspec_twocell(struct gpio_chip * gc,unsigned int parent_hwirq,unsigned int parent_type)1246 void *gpiochip_populate_parent_fwspec_twocell(struct gpio_chip *gc,
1247 unsigned int parent_hwirq,
1248 unsigned int parent_type)
1249 {
1250 struct irq_fwspec *fwspec;
1251
1252 fwspec = kmalloc(sizeof(*fwspec), GFP_KERNEL);
1253 if (!fwspec)
1254 return NULL;
1255
1256 fwspec->fwnode = gc->irq.parent_domain->fwnode;
1257 fwspec->param_count = 2;
1258 fwspec->param[0] = parent_hwirq;
1259 fwspec->param[1] = parent_type;
1260
1261 return fwspec;
1262 }
1263 EXPORT_SYMBOL_GPL(gpiochip_populate_parent_fwspec_twocell);
1264
gpiochip_populate_parent_fwspec_fourcell(struct gpio_chip * gc,unsigned int parent_hwirq,unsigned int parent_type)1265 void *gpiochip_populate_parent_fwspec_fourcell(struct gpio_chip *gc,
1266 unsigned int parent_hwirq,
1267 unsigned int parent_type)
1268 {
1269 struct irq_fwspec *fwspec;
1270
1271 fwspec = kmalloc(sizeof(*fwspec), GFP_KERNEL);
1272 if (!fwspec)
1273 return NULL;
1274
1275 fwspec->fwnode = gc->irq.parent_domain->fwnode;
1276 fwspec->param_count = 4;
1277 fwspec->param[0] = 0;
1278 fwspec->param[1] = parent_hwirq;
1279 fwspec->param[2] = 0;
1280 fwspec->param[3] = parent_type;
1281
1282 return fwspec;
1283 }
1284 EXPORT_SYMBOL_GPL(gpiochip_populate_parent_fwspec_fourcell);
1285
1286 #else
1287
gpiochip_hierarchy_add_domain(struct gpio_chip * gc)1288 static int gpiochip_hierarchy_add_domain(struct gpio_chip *gc)
1289 {
1290 return -EINVAL;
1291 }
1292
gpiochip_hierarchy_is_hierarchical(struct gpio_chip * gc)1293 static bool gpiochip_hierarchy_is_hierarchical(struct gpio_chip *gc)
1294 {
1295 return false;
1296 }
1297
1298 #endif /* CONFIG_IRQ_DOMAIN_HIERARCHY */
1299
1300 /**
1301 * gpiochip_irq_map() - maps an IRQ into a GPIO irqchip
1302 * @d: the irqdomain used by this irqchip
1303 * @irq: the global irq number used by this GPIO irqchip irq
1304 * @hwirq: the local IRQ/GPIO line offset on this gpiochip
1305 *
1306 * This function will set up the mapping for a certain IRQ line on a
1307 * gpiochip by assigning the gpiochip as chip data, and using the irqchip
1308 * stored inside the gpiochip.
1309 */
gpiochip_irq_map(struct irq_domain * d,unsigned int irq,irq_hw_number_t hwirq)1310 int gpiochip_irq_map(struct irq_domain *d, unsigned int irq,
1311 irq_hw_number_t hwirq)
1312 {
1313 struct gpio_chip *gc = d->host_data;
1314 int ret = 0;
1315
1316 if (!gpiochip_irqchip_irq_valid(gc, hwirq))
1317 return -ENXIO;
1318
1319 irq_set_chip_data(irq, gc);
1320 /*
1321 * This lock class tells lockdep that GPIO irqs are in a different
1322 * category than their parents, so it won't report false recursion.
1323 */
1324 irq_set_lockdep_class(irq, gc->irq.lock_key, gc->irq.request_key);
1325 irq_set_chip_and_handler(irq, gc->irq.chip, gc->irq.handler);
1326 /* Chips that use nested thread handlers have them marked */
1327 if (gc->irq.threaded)
1328 irq_set_nested_thread(irq, 1);
1329 irq_set_noprobe(irq);
1330
1331 if (gc->irq.num_parents == 1)
1332 ret = irq_set_parent(irq, gc->irq.parents[0]);
1333 else if (gc->irq.map)
1334 ret = irq_set_parent(irq, gc->irq.map[hwirq]);
1335
1336 if (ret < 0)
1337 return ret;
1338
1339 /*
1340 * No set-up of the hardware will happen if IRQ_TYPE_NONE
1341 * is passed as default type.
1342 */
1343 if (gc->irq.default_type != IRQ_TYPE_NONE)
1344 irq_set_irq_type(irq, gc->irq.default_type);
1345
1346 return 0;
1347 }
1348 EXPORT_SYMBOL_GPL(gpiochip_irq_map);
1349
gpiochip_irq_unmap(struct irq_domain * d,unsigned int irq)1350 void gpiochip_irq_unmap(struct irq_domain *d, unsigned int irq)
1351 {
1352 struct gpio_chip *gc = d->host_data;
1353
1354 if (gc->irq.threaded)
1355 irq_set_nested_thread(irq, 0);
1356 irq_set_chip_and_handler(irq, NULL, NULL);
1357 irq_set_chip_data(irq, NULL);
1358 }
1359 EXPORT_SYMBOL_GPL(gpiochip_irq_unmap);
1360
1361 static const struct irq_domain_ops gpiochip_domain_ops = {
1362 .map = gpiochip_irq_map,
1363 .unmap = gpiochip_irq_unmap,
1364 /* Virtually all GPIO irqchips are twocell:ed */
1365 .xlate = irq_domain_xlate_twocell,
1366 };
1367
1368 /*
1369 * TODO: move these activate/deactivate in under the hierarchicial
1370 * irqchip implementation as static once SPMI and SSBI (all external
1371 * users) are phased over.
1372 */
1373 /**
1374 * gpiochip_irq_domain_activate() - Lock a GPIO to be used as an IRQ
1375 * @domain: The IRQ domain used by this IRQ chip
1376 * @data: Outermost irq_data associated with the IRQ
1377 * @reserve: If set, only reserve an interrupt vector instead of assigning one
1378 *
1379 * This function is a wrapper that calls gpiochip_lock_as_irq() and is to be
1380 * used as the activate function for the &struct irq_domain_ops. The host_data
1381 * for the IRQ domain must be the &struct gpio_chip.
1382 */
gpiochip_irq_domain_activate(struct irq_domain * domain,struct irq_data * data,bool reserve)1383 int gpiochip_irq_domain_activate(struct irq_domain *domain,
1384 struct irq_data *data, bool reserve)
1385 {
1386 struct gpio_chip *gc = domain->host_data;
1387
1388 return gpiochip_lock_as_irq(gc, data->hwirq);
1389 }
1390 EXPORT_SYMBOL_GPL(gpiochip_irq_domain_activate);
1391
1392 /**
1393 * gpiochip_irq_domain_deactivate() - Unlock a GPIO used as an IRQ
1394 * @domain: The IRQ domain used by this IRQ chip
1395 * @data: Outermost irq_data associated with the IRQ
1396 *
1397 * This function is a wrapper that will call gpiochip_unlock_as_irq() and is to
1398 * be used as the deactivate function for the &struct irq_domain_ops. The
1399 * host_data for the IRQ domain must be the &struct gpio_chip.
1400 */
gpiochip_irq_domain_deactivate(struct irq_domain * domain,struct irq_data * data)1401 void gpiochip_irq_domain_deactivate(struct irq_domain *domain,
1402 struct irq_data *data)
1403 {
1404 struct gpio_chip *gc = domain->host_data;
1405
1406 return gpiochip_unlock_as_irq(gc, data->hwirq);
1407 }
1408 EXPORT_SYMBOL_GPL(gpiochip_irq_domain_deactivate);
1409
gpiochip_to_irq(struct gpio_chip * gc,unsigned offset)1410 static int gpiochip_to_irq(struct gpio_chip *gc, unsigned offset)
1411 {
1412 struct irq_domain *domain = gc->irq.domain;
1413
1414 if (!gpiochip_irqchip_irq_valid(gc, offset))
1415 return -ENXIO;
1416
1417 #ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
1418 if (irq_domain_is_hierarchy(domain)) {
1419 struct irq_fwspec spec;
1420
1421 spec.fwnode = domain->fwnode;
1422 spec.param_count = 2;
1423 spec.param[0] = gc->irq.child_offset_to_irq(gc, offset);
1424 spec.param[1] = IRQ_TYPE_NONE;
1425
1426 return irq_create_fwspec_mapping(&spec);
1427 }
1428 #endif
1429
1430 return irq_create_mapping(domain, offset);
1431 }
1432
gpiochip_irq_reqres(struct irq_data * d)1433 static int gpiochip_irq_reqres(struct irq_data *d)
1434 {
1435 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1436
1437 return gpiochip_reqres_irq(gc, d->hwirq);
1438 }
1439
gpiochip_irq_relres(struct irq_data * d)1440 static void gpiochip_irq_relres(struct irq_data *d)
1441 {
1442 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1443
1444 gpiochip_relres_irq(gc, d->hwirq);
1445 }
1446
gpiochip_irq_mask(struct irq_data * d)1447 static void gpiochip_irq_mask(struct irq_data *d)
1448 {
1449 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1450
1451 if (gc->irq.irq_mask)
1452 gc->irq.irq_mask(d);
1453 gpiochip_disable_irq(gc, d->hwirq);
1454 }
1455
gpiochip_irq_unmask(struct irq_data * d)1456 static void gpiochip_irq_unmask(struct irq_data *d)
1457 {
1458 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1459
1460 gpiochip_enable_irq(gc, d->hwirq);
1461 if (gc->irq.irq_unmask)
1462 gc->irq.irq_unmask(d);
1463 }
1464
gpiochip_irq_enable(struct irq_data * d)1465 static void gpiochip_irq_enable(struct irq_data *d)
1466 {
1467 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1468
1469 gpiochip_enable_irq(gc, d->hwirq);
1470 gc->irq.irq_enable(d);
1471 }
1472
gpiochip_irq_disable(struct irq_data * d)1473 static void gpiochip_irq_disable(struct irq_data *d)
1474 {
1475 struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
1476
1477 gc->irq.irq_disable(d);
1478 gpiochip_disable_irq(gc, d->hwirq);
1479 }
1480
gpiochip_set_irq_hooks(struct gpio_chip * gc)1481 static void gpiochip_set_irq_hooks(struct gpio_chip *gc)
1482 {
1483 struct irq_chip *irqchip = gc->irq.chip;
1484
1485 if (!irqchip->irq_request_resources &&
1486 !irqchip->irq_release_resources) {
1487 irqchip->irq_request_resources = gpiochip_irq_reqres;
1488 irqchip->irq_release_resources = gpiochip_irq_relres;
1489 }
1490 if (WARN_ON(gc->irq.irq_enable))
1491 return;
1492 /* Check if the irqchip already has this hook... */
1493 if (irqchip->irq_enable == gpiochip_irq_enable ||
1494 irqchip->irq_mask == gpiochip_irq_mask) {
1495 /*
1496 * ...and if so, give a gentle warning that this is bad
1497 * practice.
1498 */
1499 chip_info(gc,
1500 "detected irqchip that is shared with multiple gpiochips: please fix the driver.\n");
1501 return;
1502 }
1503
1504 if (irqchip->irq_disable) {
1505 gc->irq.irq_disable = irqchip->irq_disable;
1506 irqchip->irq_disable = gpiochip_irq_disable;
1507 } else {
1508 gc->irq.irq_mask = irqchip->irq_mask;
1509 irqchip->irq_mask = gpiochip_irq_mask;
1510 }
1511
1512 if (irqchip->irq_enable) {
1513 gc->irq.irq_enable = irqchip->irq_enable;
1514 irqchip->irq_enable = gpiochip_irq_enable;
1515 } else {
1516 gc->irq.irq_unmask = irqchip->irq_unmask;
1517 irqchip->irq_unmask = gpiochip_irq_unmask;
1518 }
1519 }
1520
1521 /**
1522 * gpiochip_add_irqchip() - adds an IRQ chip to a GPIO chip
1523 * @gc: the GPIO chip to add the IRQ chip to
1524 * @lock_key: lockdep class for IRQ lock
1525 * @request_key: lockdep class for IRQ request
1526 */
gpiochip_add_irqchip(struct gpio_chip * gc,struct lock_class_key * lock_key,struct lock_class_key * request_key)1527 static int gpiochip_add_irqchip(struct gpio_chip *gc,
1528 struct lock_class_key *lock_key,
1529 struct lock_class_key *request_key)
1530 {
1531 struct irq_chip *irqchip = gc->irq.chip;
1532 const struct irq_domain_ops *ops = NULL;
1533 struct device_node *np;
1534 unsigned int type;
1535 unsigned int i;
1536
1537 if (!irqchip)
1538 return 0;
1539
1540 if (gc->irq.parent_handler && gc->can_sleep) {
1541 chip_err(gc, "you cannot have chained interrupts on a chip that may sleep\n");
1542 return -EINVAL;
1543 }
1544
1545 np = gc->gpiodev->dev.of_node;
1546 type = gc->irq.default_type;
1547
1548 /*
1549 * Specifying a default trigger is a terrible idea if DT or ACPI is
1550 * used to configure the interrupts, as you may end up with
1551 * conflicting triggers. Tell the user, and reset to NONE.
1552 */
1553 if (WARN(np && type != IRQ_TYPE_NONE,
1554 "%s: Ignoring %u default trigger\n", np->full_name, type))
1555 type = IRQ_TYPE_NONE;
1556
1557 if (has_acpi_companion(gc->parent) && type != IRQ_TYPE_NONE) {
1558 acpi_handle_warn(ACPI_HANDLE(gc->parent),
1559 "Ignoring %u default trigger\n", type);
1560 type = IRQ_TYPE_NONE;
1561 }
1562
1563 gc->to_irq = gpiochip_to_irq;
1564 gc->irq.default_type = type;
1565 gc->irq.lock_key = lock_key;
1566 gc->irq.request_key = request_key;
1567
1568 /* If a parent irqdomain is provided, let's build a hierarchy */
1569 if (gpiochip_hierarchy_is_hierarchical(gc)) {
1570 int ret = gpiochip_hierarchy_add_domain(gc);
1571 if (ret)
1572 return ret;
1573 } else {
1574 /* Some drivers provide custom irqdomain ops */
1575 if (gc->irq.domain_ops)
1576 ops = gc->irq.domain_ops;
1577
1578 if (!ops)
1579 ops = &gpiochip_domain_ops;
1580 gc->irq.domain = irq_domain_add_simple(np,
1581 gc->ngpio,
1582 gc->irq.first,
1583 ops, gc);
1584 if (!gc->irq.domain)
1585 return -EINVAL;
1586 }
1587
1588 if (gc->irq.parent_handler) {
1589 void *data = gc->irq.parent_handler_data ?: gc;
1590
1591 for (i = 0; i < gc->irq.num_parents; i++) {
1592 /*
1593 * The parent IRQ chip is already using the chip_data
1594 * for this IRQ chip, so our callbacks simply use the
1595 * handler_data.
1596 */
1597 irq_set_chained_handler_and_data(gc->irq.parents[i],
1598 gc->irq.parent_handler,
1599 data);
1600 }
1601 }
1602
1603 gpiochip_set_irq_hooks(gc);
1604
1605 acpi_gpiochip_request_interrupts(gc);
1606
1607 return 0;
1608 }
1609
1610 /**
1611 * gpiochip_irqchip_remove() - removes an irqchip added to a gpiochip
1612 * @gc: the gpiochip to remove the irqchip from
1613 *
1614 * This is called only from gpiochip_remove()
1615 */
gpiochip_irqchip_remove(struct gpio_chip * gc)1616 static void gpiochip_irqchip_remove(struct gpio_chip *gc)
1617 {
1618 struct irq_chip *irqchip = gc->irq.chip;
1619 unsigned int offset;
1620
1621 acpi_gpiochip_free_interrupts(gc);
1622
1623 if (irqchip && gc->irq.parent_handler) {
1624 struct gpio_irq_chip *irq = &gc->irq;
1625 unsigned int i;
1626
1627 for (i = 0; i < irq->num_parents; i++)
1628 irq_set_chained_handler_and_data(irq->parents[i],
1629 NULL, NULL);
1630 }
1631
1632 /* Remove all IRQ mappings and delete the domain */
1633 if (gc->irq.domain) {
1634 unsigned int irq;
1635
1636 for (offset = 0; offset < gc->ngpio; offset++) {
1637 if (!gpiochip_irqchip_irq_valid(gc, offset))
1638 continue;
1639
1640 irq = irq_find_mapping(gc->irq.domain, offset);
1641 irq_dispose_mapping(irq);
1642 }
1643
1644 irq_domain_remove(gc->irq.domain);
1645 }
1646
1647 if (irqchip) {
1648 if (irqchip->irq_request_resources == gpiochip_irq_reqres) {
1649 irqchip->irq_request_resources = NULL;
1650 irqchip->irq_release_resources = NULL;
1651 }
1652 if (irqchip->irq_enable == gpiochip_irq_enable) {
1653 irqchip->irq_enable = gc->irq.irq_enable;
1654 irqchip->irq_disable = gc->irq.irq_disable;
1655 }
1656 }
1657 gc->irq.irq_enable = NULL;
1658 gc->irq.irq_disable = NULL;
1659 gc->irq.chip = NULL;
1660
1661 gpiochip_irqchip_free_valid_mask(gc);
1662 }
1663
1664 /**
1665 * gpiochip_irqchip_add_key() - adds an irqchip to a gpiochip
1666 * @gc: the gpiochip to add the irqchip to
1667 * @irqchip: the irqchip to add to the gpiochip
1668 * @first_irq: if not dynamically assigned, the base (first) IRQ to
1669 * allocate gpiochip irqs from
1670 * @handler: the irq handler to use (often a predefined irq core function)
1671 * @type: the default type for IRQs on this irqchip, pass IRQ_TYPE_NONE
1672 * to have the core avoid setting up any default type in the hardware.
1673 * @threaded: whether this irqchip uses a nested thread handler
1674 * @lock_key: lockdep class for IRQ lock
1675 * @request_key: lockdep class for IRQ request
1676 *
1677 * This function closely associates a certain irqchip with a certain
1678 * gpiochip, providing an irq domain to translate the local IRQs to
1679 * global irqs in the gpiolib core, and making sure that the gpiochip
1680 * is passed as chip data to all related functions. Driver callbacks
1681 * need to use gpiochip_get_data() to get their local state containers back
1682 * from the gpiochip passed as chip data. An irqdomain will be stored
1683 * in the gpiochip that shall be used by the driver to handle IRQ number
1684 * translation. The gpiochip will need to be initialized and registered
1685 * before calling this function.
1686 *
1687 * This function will handle two cell:ed simple IRQs and assumes all
1688 * the pins on the gpiochip can generate a unique IRQ. Everything else
1689 * need to be open coded.
1690 */
gpiochip_irqchip_add_key(struct gpio_chip * gc,struct irq_chip * irqchip,unsigned int first_irq,irq_flow_handler_t handler,unsigned int type,bool threaded,struct lock_class_key * lock_key,struct lock_class_key * request_key)1691 int gpiochip_irqchip_add_key(struct gpio_chip *gc,
1692 struct irq_chip *irqchip,
1693 unsigned int first_irq,
1694 irq_flow_handler_t handler,
1695 unsigned int type,
1696 bool threaded,
1697 struct lock_class_key *lock_key,
1698 struct lock_class_key *request_key)
1699 {
1700 struct device_node *of_node;
1701
1702 if (!gc || !irqchip)
1703 return -EINVAL;
1704
1705 if (!gc->parent) {
1706 chip_err(gc, "missing gpiochip .dev parent pointer\n");
1707 return -EINVAL;
1708 }
1709 gc->irq.threaded = threaded;
1710 of_node = gc->parent->of_node;
1711 #ifdef CONFIG_OF_GPIO
1712 /*
1713 * If the gpiochip has an assigned OF node this takes precedence
1714 * FIXME: get rid of this and use gc->parent->of_node
1715 * everywhere
1716 */
1717 if (gc->of_node)
1718 of_node = gc->of_node;
1719 #endif
1720 /*
1721 * Specifying a default trigger is a terrible idea if DT or ACPI is
1722 * used to configure the interrupts, as you may end-up with
1723 * conflicting triggers. Tell the user, and reset to NONE.
1724 */
1725 if (WARN(of_node && type != IRQ_TYPE_NONE,
1726 "%pOF: Ignoring %d default trigger\n", of_node, type))
1727 type = IRQ_TYPE_NONE;
1728 if (has_acpi_companion(gc->parent) && type != IRQ_TYPE_NONE) {
1729 acpi_handle_warn(ACPI_HANDLE(gc->parent),
1730 "Ignoring %d default trigger\n", type);
1731 type = IRQ_TYPE_NONE;
1732 }
1733
1734 gc->irq.chip = irqchip;
1735 gc->irq.handler = handler;
1736 gc->irq.default_type = type;
1737 gc->to_irq = gpiochip_to_irq;
1738 gc->irq.lock_key = lock_key;
1739 gc->irq.request_key = request_key;
1740 gc->irq.domain = irq_domain_add_simple(of_node,
1741 gc->ngpio, first_irq,
1742 &gpiochip_domain_ops, gc);
1743 if (!gc->irq.domain) {
1744 gc->irq.chip = NULL;
1745 return -EINVAL;
1746 }
1747
1748 gpiochip_set_irq_hooks(gc);
1749
1750 acpi_gpiochip_request_interrupts(gc);
1751
1752 return 0;
1753 }
1754 EXPORT_SYMBOL_GPL(gpiochip_irqchip_add_key);
1755
1756 /**
1757 * gpiochip_irqchip_add_domain() - adds an irqdomain to a gpiochip
1758 * @gc: the gpiochip to add the irqchip to
1759 * @domain: the irqdomain to add to the gpiochip
1760 *
1761 * This function adds an IRQ domain to the gpiochip.
1762 */
gpiochip_irqchip_add_domain(struct gpio_chip * gc,struct irq_domain * domain)1763 int gpiochip_irqchip_add_domain(struct gpio_chip *gc,
1764 struct irq_domain *domain)
1765 {
1766 if (!domain)
1767 return -EINVAL;
1768
1769 gc->to_irq = gpiochip_to_irq;
1770 gc->irq.domain = domain;
1771
1772 return 0;
1773 }
1774 EXPORT_SYMBOL_GPL(gpiochip_irqchip_add_domain);
1775
1776 #else /* CONFIG_GPIOLIB_IRQCHIP */
1777
gpiochip_add_irqchip(struct gpio_chip * gc,struct lock_class_key * lock_key,struct lock_class_key * request_key)1778 static inline int gpiochip_add_irqchip(struct gpio_chip *gc,
1779 struct lock_class_key *lock_key,
1780 struct lock_class_key *request_key)
1781 {
1782 return 0;
1783 }
gpiochip_irqchip_remove(struct gpio_chip * gc)1784 static void gpiochip_irqchip_remove(struct gpio_chip *gc) {}
1785
gpiochip_irqchip_init_hw(struct gpio_chip * gc)1786 static inline int gpiochip_irqchip_init_hw(struct gpio_chip *gc)
1787 {
1788 return 0;
1789 }
1790
gpiochip_irqchip_init_valid_mask(struct gpio_chip * gc)1791 static inline int gpiochip_irqchip_init_valid_mask(struct gpio_chip *gc)
1792 {
1793 return 0;
1794 }
gpiochip_irqchip_free_valid_mask(struct gpio_chip * gc)1795 static inline void gpiochip_irqchip_free_valid_mask(struct gpio_chip *gc)
1796 { }
1797
1798 #endif /* CONFIG_GPIOLIB_IRQCHIP */
1799
1800 /**
1801 * gpiochip_generic_request() - request the gpio function for a pin
1802 * @gc: the gpiochip owning the GPIO
1803 * @offset: the offset of the GPIO to request for GPIO function
1804 */
gpiochip_generic_request(struct gpio_chip * gc,unsigned offset)1805 int gpiochip_generic_request(struct gpio_chip *gc, unsigned offset)
1806 {
1807 #ifdef CONFIG_PINCTRL
1808 if (list_empty(&gc->gpiodev->pin_ranges))
1809 return 0;
1810 #endif
1811
1812 return pinctrl_gpio_request(gc->gpiodev->base + offset);
1813 }
1814 EXPORT_SYMBOL_GPL(gpiochip_generic_request);
1815
1816 /**
1817 * gpiochip_generic_free() - free the gpio function from a pin
1818 * @gc: the gpiochip to request the gpio function for
1819 * @offset: the offset of the GPIO to free from GPIO function
1820 */
gpiochip_generic_free(struct gpio_chip * gc,unsigned offset)1821 void gpiochip_generic_free(struct gpio_chip *gc, unsigned offset)
1822 {
1823 #ifdef CONFIG_PINCTRL
1824 if (list_empty(&gc->gpiodev->pin_ranges))
1825 return;
1826 #endif
1827
1828 pinctrl_gpio_free(gc->gpiodev->base + offset);
1829 }
1830 EXPORT_SYMBOL_GPL(gpiochip_generic_free);
1831
1832 /**
1833 * gpiochip_generic_config() - apply configuration for a pin
1834 * @gc: the gpiochip owning the GPIO
1835 * @offset: the offset of the GPIO to apply the configuration
1836 * @config: the configuration to be applied
1837 */
gpiochip_generic_config(struct gpio_chip * gc,unsigned offset,unsigned long config)1838 int gpiochip_generic_config(struct gpio_chip *gc, unsigned offset,
1839 unsigned long config)
1840 {
1841 return pinctrl_gpio_set_config(gc->gpiodev->base + offset, config);
1842 }
1843 EXPORT_SYMBOL_GPL(gpiochip_generic_config);
1844
1845 #ifdef CONFIG_PINCTRL
1846
1847 /**
1848 * gpiochip_add_pingroup_range() - add a range for GPIO <-> pin mapping
1849 * @gc: the gpiochip to add the range for
1850 * @pctldev: the pin controller to map to
1851 * @gpio_offset: the start offset in the current gpio_chip number space
1852 * @pin_group: name of the pin group inside the pin controller
1853 *
1854 * Calling this function directly from a DeviceTree-supported
1855 * pinctrl driver is DEPRECATED. Please see Section 2.1 of
1856 * Documentation/devicetree/bindings/gpio/gpio.txt on how to
1857 * bind pinctrl and gpio drivers via the "gpio-ranges" property.
1858 */
gpiochip_add_pingroup_range(struct gpio_chip * gc,struct pinctrl_dev * pctldev,unsigned int gpio_offset,const char * pin_group)1859 int gpiochip_add_pingroup_range(struct gpio_chip *gc,
1860 struct pinctrl_dev *pctldev,
1861 unsigned int gpio_offset, const char *pin_group)
1862 {
1863 struct gpio_pin_range *pin_range;
1864 struct gpio_device *gdev = gc->gpiodev;
1865 int ret;
1866
1867 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1868 if (!pin_range) {
1869 chip_err(gc, "failed to allocate pin ranges\n");
1870 return -ENOMEM;
1871 }
1872
1873 /* Use local offset as range ID */
1874 pin_range->range.id = gpio_offset;
1875 pin_range->range.gc = gc;
1876 pin_range->range.name = gc->label;
1877 pin_range->range.base = gdev->base + gpio_offset;
1878 pin_range->pctldev = pctldev;
1879
1880 ret = pinctrl_get_group_pins(pctldev, pin_group,
1881 &pin_range->range.pins,
1882 &pin_range->range.npins);
1883 if (ret < 0) {
1884 kfree(pin_range);
1885 return ret;
1886 }
1887
1888 pinctrl_add_gpio_range(pctldev, &pin_range->range);
1889
1890 chip_dbg(gc, "created GPIO range %d->%d ==> %s PINGRP %s\n",
1891 gpio_offset, gpio_offset + pin_range->range.npins - 1,
1892 pinctrl_dev_get_devname(pctldev), pin_group);
1893
1894 list_add_tail(&pin_range->node, &gdev->pin_ranges);
1895
1896 return 0;
1897 }
1898 EXPORT_SYMBOL_GPL(gpiochip_add_pingroup_range);
1899
1900 /**
1901 * gpiochip_add_pin_range() - add a range for GPIO <-> pin mapping
1902 * @gc: the gpiochip to add the range for
1903 * @pinctl_name: the dev_name() of the pin controller to map to
1904 * @gpio_offset: the start offset in the current gpio_chip number space
1905 * @pin_offset: the start offset in the pin controller number space
1906 * @npins: the number of pins from the offset of each pin space (GPIO and
1907 * pin controller) to accumulate in this range
1908 *
1909 * Returns:
1910 * 0 on success, or a negative error-code on failure.
1911 *
1912 * Calling this function directly from a DeviceTree-supported
1913 * pinctrl driver is DEPRECATED. Please see Section 2.1 of
1914 * Documentation/devicetree/bindings/gpio/gpio.txt on how to
1915 * bind pinctrl and gpio drivers via the "gpio-ranges" property.
1916 */
gpiochip_add_pin_range(struct gpio_chip * gc,const char * pinctl_name,unsigned int gpio_offset,unsigned int pin_offset,unsigned int npins)1917 int gpiochip_add_pin_range(struct gpio_chip *gc, const char *pinctl_name,
1918 unsigned int gpio_offset, unsigned int pin_offset,
1919 unsigned int npins)
1920 {
1921 struct gpio_pin_range *pin_range;
1922 struct gpio_device *gdev = gc->gpiodev;
1923 int ret;
1924
1925 pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1926 if (!pin_range) {
1927 chip_err(gc, "failed to allocate pin ranges\n");
1928 return -ENOMEM;
1929 }
1930
1931 /* Use local offset as range ID */
1932 pin_range->range.id = gpio_offset;
1933 pin_range->range.gc = gc;
1934 pin_range->range.name = gc->label;
1935 pin_range->range.base = gdev->base + gpio_offset;
1936 pin_range->range.pin_base = pin_offset;
1937 pin_range->range.npins = npins;
1938 pin_range->pctldev = pinctrl_find_and_add_gpio_range(pinctl_name,
1939 &pin_range->range);
1940 if (IS_ERR(pin_range->pctldev)) {
1941 ret = PTR_ERR(pin_range->pctldev);
1942 chip_err(gc, "could not create pin range\n");
1943 kfree(pin_range);
1944 return ret;
1945 }
1946 chip_dbg(gc, "created GPIO range %d->%d ==> %s PIN %d->%d\n",
1947 gpio_offset, gpio_offset + npins - 1,
1948 pinctl_name,
1949 pin_offset, pin_offset + npins - 1);
1950
1951 list_add_tail(&pin_range->node, &gdev->pin_ranges);
1952
1953 return 0;
1954 }
1955 EXPORT_SYMBOL_GPL(gpiochip_add_pin_range);
1956
1957 /**
1958 * gpiochip_remove_pin_ranges() - remove all the GPIO <-> pin mappings
1959 * @gc: the chip to remove all the mappings for
1960 */
gpiochip_remove_pin_ranges(struct gpio_chip * gc)1961 void gpiochip_remove_pin_ranges(struct gpio_chip *gc)
1962 {
1963 struct gpio_pin_range *pin_range, *tmp;
1964 struct gpio_device *gdev = gc->gpiodev;
1965
1966 list_for_each_entry_safe(pin_range, tmp, &gdev->pin_ranges, node) {
1967 list_del(&pin_range->node);
1968 pinctrl_remove_gpio_range(pin_range->pctldev,
1969 &pin_range->range);
1970 kfree(pin_range);
1971 }
1972 }
1973 EXPORT_SYMBOL_GPL(gpiochip_remove_pin_ranges);
1974
1975 #endif /* CONFIG_PINCTRL */
1976
1977 /* These "optional" allocation calls help prevent drivers from stomping
1978 * on each other, and help provide better diagnostics in debugfs.
1979 * They're called even less than the "set direction" calls.
1980 */
gpiod_request_commit(struct gpio_desc * desc,const char * label)1981 static int gpiod_request_commit(struct gpio_desc *desc, const char *label)
1982 {
1983 struct gpio_chip *gc = desc->gdev->chip;
1984 int ret;
1985 unsigned long flags;
1986 unsigned offset;
1987
1988 if (label) {
1989 label = kstrdup_const(label, GFP_KERNEL);
1990 if (!label)
1991 return -ENOMEM;
1992 }
1993
1994 spin_lock_irqsave(&gpio_lock, flags);
1995
1996 /* NOTE: gpio_request() can be called in early boot,
1997 * before IRQs are enabled, for non-sleeping (SOC) GPIOs.
1998 */
1999
2000 if (test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0) {
2001 desc_set_label(desc, label ? : "?");
2002 ret = 0;
2003 } else {
2004 kfree_const(label);
2005 ret = -EBUSY;
2006 goto done;
2007 }
2008
2009 if (gc->request) {
2010 /* gc->request may sleep */
2011 spin_unlock_irqrestore(&gpio_lock, flags);
2012 offset = gpio_chip_hwgpio(desc);
2013 if (gpiochip_line_is_valid(gc, offset))
2014 ret = gc->request(gc, offset);
2015 else
2016 ret = -EINVAL;
2017 spin_lock_irqsave(&gpio_lock, flags);
2018
2019 if (ret < 0) {
2020 desc_set_label(desc, NULL);
2021 kfree_const(label);
2022 clear_bit(FLAG_REQUESTED, &desc->flags);
2023 goto done;
2024 }
2025 }
2026 if (gc->get_direction) {
2027 /* gc->get_direction may sleep */
2028 spin_unlock_irqrestore(&gpio_lock, flags);
2029 gpiod_get_direction(desc);
2030 spin_lock_irqsave(&gpio_lock, flags);
2031 }
2032 done:
2033 spin_unlock_irqrestore(&gpio_lock, flags);
2034 return ret;
2035 }
2036
2037 /*
2038 * This descriptor validation needs to be inserted verbatim into each
2039 * function taking a descriptor, so we need to use a preprocessor
2040 * macro to avoid endless duplication. If the desc is NULL it is an
2041 * optional GPIO and calls should just bail out.
2042 */
validate_desc(const struct gpio_desc * desc,const char * func)2043 static int validate_desc(const struct gpio_desc *desc, const char *func)
2044 {
2045 if (!desc)
2046 return 0;
2047 if (IS_ERR(desc)) {
2048 pr_warn("%s: invalid GPIO (errorpointer)\n", func);
2049 return PTR_ERR(desc);
2050 }
2051 if (!desc->gdev) {
2052 pr_warn("%s: invalid GPIO (no device)\n", func);
2053 return -EINVAL;
2054 }
2055 if (!desc->gdev->chip) {
2056 dev_warn(&desc->gdev->dev,
2057 "%s: backing chip is gone\n", func);
2058 return 0;
2059 }
2060 return 1;
2061 }
2062
2063 #define VALIDATE_DESC(desc) do { \
2064 int __valid = validate_desc(desc, __func__); \
2065 if (__valid <= 0) \
2066 return __valid; \
2067 } while (0)
2068
2069 #define VALIDATE_DESC_VOID(desc) do { \
2070 int __valid = validate_desc(desc, __func__); \
2071 if (__valid <= 0) \
2072 return; \
2073 } while (0)
2074
gpiod_request(struct gpio_desc * desc,const char * label)2075 int gpiod_request(struct gpio_desc *desc, const char *label)
2076 {
2077 int ret = -EPROBE_DEFER;
2078 struct gpio_device *gdev;
2079
2080 VALIDATE_DESC(desc);
2081 gdev = desc->gdev;
2082
2083 if (try_module_get(gdev->owner)) {
2084 ret = gpiod_request_commit(desc, label);
2085 if (ret < 0)
2086 module_put(gdev->owner);
2087 else
2088 get_device(&gdev->dev);
2089 }
2090
2091 if (ret)
2092 gpiod_dbg(desc, "%s: status %d\n", __func__, ret);
2093
2094 return ret;
2095 }
2096
gpiod_free_commit(struct gpio_desc * desc)2097 static bool gpiod_free_commit(struct gpio_desc *desc)
2098 {
2099 bool ret = false;
2100 unsigned long flags;
2101 struct gpio_chip *gc;
2102
2103 might_sleep();
2104
2105 gpiod_unexport(desc);
2106
2107 spin_lock_irqsave(&gpio_lock, flags);
2108
2109 gc = desc->gdev->chip;
2110 if (gc && test_bit(FLAG_REQUESTED, &desc->flags)) {
2111 if (gc->free) {
2112 spin_unlock_irqrestore(&gpio_lock, flags);
2113 might_sleep_if(gc->can_sleep);
2114 gc->free(gc, gpio_chip_hwgpio(desc));
2115 spin_lock_irqsave(&gpio_lock, flags);
2116 }
2117 kfree_const(desc->label);
2118 desc_set_label(desc, NULL);
2119 clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
2120 clear_bit(FLAG_REQUESTED, &desc->flags);
2121 clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
2122 clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
2123 clear_bit(FLAG_PULL_UP, &desc->flags);
2124 clear_bit(FLAG_PULL_DOWN, &desc->flags);
2125 clear_bit(FLAG_BIAS_DISABLE, &desc->flags);
2126 clear_bit(FLAG_EDGE_RISING, &desc->flags);
2127 clear_bit(FLAG_EDGE_FALLING, &desc->flags);
2128 clear_bit(FLAG_IS_HOGGED, &desc->flags);
2129 #ifdef CONFIG_OF_DYNAMIC
2130 desc->hog = NULL;
2131 #endif
2132 #ifdef CONFIG_GPIO_CDEV
2133 WRITE_ONCE(desc->debounce_period_us, 0);
2134 #endif
2135 ret = true;
2136 }
2137
2138 spin_unlock_irqrestore(&gpio_lock, flags);
2139 blocking_notifier_call_chain(&desc->gdev->notifier,
2140 GPIOLINE_CHANGED_RELEASED, desc);
2141
2142 return ret;
2143 }
2144
gpiod_free(struct gpio_desc * desc)2145 void gpiod_free(struct gpio_desc *desc)
2146 {
2147 if (desc && desc->gdev && gpiod_free_commit(desc)) {
2148 module_put(desc->gdev->owner);
2149 put_device(&desc->gdev->dev);
2150 } else {
2151 WARN_ON(extra_checks);
2152 }
2153 }
2154
2155 /**
2156 * gpiochip_is_requested - return string iff signal was requested
2157 * @gc: controller managing the signal
2158 * @offset: of signal within controller's 0..(ngpio - 1) range
2159 *
2160 * Returns NULL if the GPIO is not currently requested, else a string.
2161 * The string returned is the label passed to gpio_request(); if none has been
2162 * passed it is a meaningless, non-NULL constant.
2163 *
2164 * This function is for use by GPIO controller drivers. The label can
2165 * help with diagnostics, and knowing that the signal is used as a GPIO
2166 * can help avoid accidentally multiplexing it to another controller.
2167 */
gpiochip_is_requested(struct gpio_chip * gc,unsigned offset)2168 const char *gpiochip_is_requested(struct gpio_chip *gc, unsigned offset)
2169 {
2170 struct gpio_desc *desc;
2171
2172 if (offset >= gc->ngpio)
2173 return NULL;
2174
2175 desc = gpiochip_get_desc(gc, offset);
2176 if (IS_ERR(desc))
2177 return NULL;
2178
2179 if (test_bit(FLAG_REQUESTED, &desc->flags) == 0)
2180 return NULL;
2181 return desc->label;
2182 }
2183 EXPORT_SYMBOL_GPL(gpiochip_is_requested);
2184
2185 /**
2186 * gpiochip_request_own_desc - Allow GPIO chip to request its own descriptor
2187 * @gc: GPIO chip
2188 * @hwnum: hardware number of the GPIO for which to request the descriptor
2189 * @label: label for the GPIO
2190 * @lflags: lookup flags for this GPIO or 0 if default, this can be used to
2191 * specify things like line inversion semantics with the machine flags
2192 * such as GPIO_OUT_LOW
2193 * @dflags: descriptor request flags for this GPIO or 0 if default, this
2194 * can be used to specify consumer semantics such as open drain
2195 *
2196 * Function allows GPIO chip drivers to request and use their own GPIO
2197 * descriptors via gpiolib API. Difference to gpiod_request() is that this
2198 * function will not increase reference count of the GPIO chip module. This
2199 * allows the GPIO chip module to be unloaded as needed (we assume that the
2200 * GPIO chip driver handles freeing the GPIOs it has requested).
2201 *
2202 * Returns:
2203 * A pointer to the GPIO descriptor, or an ERR_PTR()-encoded negative error
2204 * code on failure.
2205 */
gpiochip_request_own_desc(struct gpio_chip * gc,unsigned int hwnum,const char * label,enum gpio_lookup_flags lflags,enum gpiod_flags dflags)2206 struct gpio_desc *gpiochip_request_own_desc(struct gpio_chip *gc,
2207 unsigned int hwnum,
2208 const char *label,
2209 enum gpio_lookup_flags lflags,
2210 enum gpiod_flags dflags)
2211 {
2212 struct gpio_desc *desc = gpiochip_get_desc(gc, hwnum);
2213 int ret;
2214
2215 if (IS_ERR(desc)) {
2216 chip_err(gc, "failed to get GPIO descriptor\n");
2217 return desc;
2218 }
2219
2220 ret = gpiod_request_commit(desc, label);
2221 if (ret < 0)
2222 return ERR_PTR(ret);
2223
2224 ret = gpiod_configure_flags(desc, label, lflags, dflags);
2225 if (ret) {
2226 chip_err(gc, "setup of own GPIO %s failed\n", label);
2227 gpiod_free_commit(desc);
2228 return ERR_PTR(ret);
2229 }
2230
2231 return desc;
2232 }
2233 EXPORT_SYMBOL_GPL(gpiochip_request_own_desc);
2234
2235 /**
2236 * gpiochip_free_own_desc - Free GPIO requested by the chip driver
2237 * @desc: GPIO descriptor to free
2238 *
2239 * Function frees the given GPIO requested previously with
2240 * gpiochip_request_own_desc().
2241 */
gpiochip_free_own_desc(struct gpio_desc * desc)2242 void gpiochip_free_own_desc(struct gpio_desc *desc)
2243 {
2244 if (desc)
2245 gpiod_free_commit(desc);
2246 }
2247 EXPORT_SYMBOL_GPL(gpiochip_free_own_desc);
2248
2249 /*
2250 * Drivers MUST set GPIO direction before making get/set calls. In
2251 * some cases this is done in early boot, before IRQs are enabled.
2252 *
2253 * As a rule these aren't called more than once (except for drivers
2254 * using the open-drain emulation idiom) so these are natural places
2255 * to accumulate extra debugging checks. Note that we can't (yet)
2256 * rely on gpio_request() having been called beforehand.
2257 */
2258
gpio_do_set_config(struct gpio_chip * gc,unsigned int offset,unsigned long config)2259 static int gpio_do_set_config(struct gpio_chip *gc, unsigned int offset,
2260 unsigned long config)
2261 {
2262 if (!gc->set_config)
2263 return -ENOTSUPP;
2264
2265 return gc->set_config(gc, offset, config);
2266 }
2267
gpio_set_config(struct gpio_desc * desc,enum pin_config_param mode)2268 static int gpio_set_config(struct gpio_desc *desc, enum pin_config_param mode)
2269 {
2270 struct gpio_chip *gc = desc->gdev->chip;
2271 unsigned long config;
2272 unsigned arg;
2273
2274 switch (mode) {
2275 case PIN_CONFIG_BIAS_PULL_DOWN:
2276 case PIN_CONFIG_BIAS_PULL_UP:
2277 arg = 1;
2278 break;
2279
2280 default:
2281 arg = 0;
2282 }
2283
2284 config = PIN_CONF_PACKED(mode, arg);
2285 return gpio_do_set_config(gc, gpio_chip_hwgpio(desc), config);
2286 }
2287
gpio_set_bias(struct gpio_desc * desc)2288 static int gpio_set_bias(struct gpio_desc *desc)
2289 {
2290 int bias = 0;
2291 int ret = 0;
2292
2293 if (test_bit(FLAG_BIAS_DISABLE, &desc->flags))
2294 bias = PIN_CONFIG_BIAS_DISABLE;
2295 else if (test_bit(FLAG_PULL_UP, &desc->flags))
2296 bias = PIN_CONFIG_BIAS_PULL_UP;
2297 else if (test_bit(FLAG_PULL_DOWN, &desc->flags))
2298 bias = PIN_CONFIG_BIAS_PULL_DOWN;
2299
2300 if (bias) {
2301 ret = gpio_set_config(desc, bias);
2302 if (ret != -ENOTSUPP)
2303 return ret;
2304 }
2305 return 0;
2306 }
2307
2308 /**
2309 * gpiod_direction_input - set the GPIO direction to input
2310 * @desc: GPIO to set to input
2311 *
2312 * Set the direction of the passed GPIO to input, such as gpiod_get_value() can
2313 * be called safely on it.
2314 *
2315 * Return 0 in case of success, else an error code.
2316 */
gpiod_direction_input(struct gpio_desc * desc)2317 int gpiod_direction_input(struct gpio_desc *desc)
2318 {
2319 struct gpio_chip *gc;
2320 int ret = 0;
2321
2322 VALIDATE_DESC(desc);
2323 gc = desc->gdev->chip;
2324
2325 /*
2326 * It is legal to have no .get() and .direction_input() specified if
2327 * the chip is output-only, but you can't specify .direction_input()
2328 * and not support the .get() operation, that doesn't make sense.
2329 */
2330 if (!gc->get && gc->direction_input) {
2331 gpiod_warn(desc,
2332 "%s: missing get() but have direction_input()\n",
2333 __func__);
2334 return -EIO;
2335 }
2336
2337 /*
2338 * If we have a .direction_input() callback, things are simple,
2339 * just call it. Else we are some input-only chip so try to check the
2340 * direction (if .get_direction() is supported) else we silently
2341 * assume we are in input mode after this.
2342 */
2343 if (gc->direction_input) {
2344 ret = gc->direction_input(gc, gpio_chip_hwgpio(desc));
2345 } else if (gc->get_direction &&
2346 (gc->get_direction(gc, gpio_chip_hwgpio(desc)) != 1)) {
2347 gpiod_warn(desc,
2348 "%s: missing direction_input() operation and line is output\n",
2349 __func__);
2350 return -EIO;
2351 }
2352 if (ret == 0) {
2353 clear_bit(FLAG_IS_OUT, &desc->flags);
2354 ret = gpio_set_bias(desc);
2355 }
2356
2357 trace_gpio_direction(desc_to_gpio(desc), 1, ret);
2358
2359 return ret;
2360 }
2361 EXPORT_SYMBOL_GPL(gpiod_direction_input);
2362
gpiod_direction_output_raw_commit(struct gpio_desc * desc,int value)2363 static int gpiod_direction_output_raw_commit(struct gpio_desc *desc, int value)
2364 {
2365 struct gpio_chip *gc = desc->gdev->chip;
2366 int val = !!value;
2367 int ret = 0;
2368
2369 /*
2370 * It's OK not to specify .direction_output() if the gpiochip is
2371 * output-only, but if there is then not even a .set() operation it
2372 * is pretty tricky to drive the output line.
2373 */
2374 if (!gc->set && !gc->direction_output) {
2375 gpiod_warn(desc,
2376 "%s: missing set() and direction_output() operations\n",
2377 __func__);
2378 return -EIO;
2379 }
2380
2381 if (gc->direction_output) {
2382 ret = gc->direction_output(gc, gpio_chip_hwgpio(desc), val);
2383 } else {
2384 /* Check that we are in output mode if we can */
2385 if (gc->get_direction &&
2386 gc->get_direction(gc, gpio_chip_hwgpio(desc))) {
2387 gpiod_warn(desc,
2388 "%s: missing direction_output() operation\n",
2389 __func__);
2390 return -EIO;
2391 }
2392 /*
2393 * If we can't actively set the direction, we are some
2394 * output-only chip, so just drive the output as desired.
2395 */
2396 gc->set(gc, gpio_chip_hwgpio(desc), val);
2397 }
2398
2399 if (!ret)
2400 set_bit(FLAG_IS_OUT, &desc->flags);
2401 trace_gpio_value(desc_to_gpio(desc), 0, val);
2402 trace_gpio_direction(desc_to_gpio(desc), 0, ret);
2403 return ret;
2404 }
2405
2406 /**
2407 * gpiod_direction_output_raw - set the GPIO direction to output
2408 * @desc: GPIO to set to output
2409 * @value: initial output value of the GPIO
2410 *
2411 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
2412 * be called safely on it. The initial value of the output must be specified
2413 * as raw value on the physical line without regard for the ACTIVE_LOW status.
2414 *
2415 * Return 0 in case of success, else an error code.
2416 */
gpiod_direction_output_raw(struct gpio_desc * desc,int value)2417 int gpiod_direction_output_raw(struct gpio_desc *desc, int value)
2418 {
2419 VALIDATE_DESC(desc);
2420 return gpiod_direction_output_raw_commit(desc, value);
2421 }
2422 EXPORT_SYMBOL_GPL(gpiod_direction_output_raw);
2423
2424 /**
2425 * gpiod_direction_output - set the GPIO direction to output
2426 * @desc: GPIO to set to output
2427 * @value: initial output value of the GPIO
2428 *
2429 * Set the direction of the passed GPIO to output, such as gpiod_set_value() can
2430 * be called safely on it. The initial value of the output must be specified
2431 * as the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
2432 * account.
2433 *
2434 * Return 0 in case of success, else an error code.
2435 */
gpiod_direction_output(struct gpio_desc * desc,int value)2436 int gpiod_direction_output(struct gpio_desc *desc, int value)
2437 {
2438 int ret;
2439
2440 VALIDATE_DESC(desc);
2441 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2442 value = !value;
2443 else
2444 value = !!value;
2445
2446 /* GPIOs used for enabled IRQs shall not be set as output */
2447 if (test_bit(FLAG_USED_AS_IRQ, &desc->flags) &&
2448 test_bit(FLAG_IRQ_IS_ENABLED, &desc->flags)) {
2449 gpiod_err(desc,
2450 "%s: tried to set a GPIO tied to an IRQ as output\n",
2451 __func__);
2452 return -EIO;
2453 }
2454
2455 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
2456 /* First see if we can enable open drain in hardware */
2457 ret = gpio_set_config(desc, PIN_CONFIG_DRIVE_OPEN_DRAIN);
2458 if (!ret)
2459 goto set_output_value;
2460 /* Emulate open drain by not actively driving the line high */
2461 if (value) {
2462 ret = gpiod_direction_input(desc);
2463 goto set_output_flag;
2464 }
2465 }
2466 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags)) {
2467 ret = gpio_set_config(desc, PIN_CONFIG_DRIVE_OPEN_SOURCE);
2468 if (!ret)
2469 goto set_output_value;
2470 /* Emulate open source by not actively driving the line low */
2471 if (!value) {
2472 ret = gpiod_direction_input(desc);
2473 goto set_output_flag;
2474 }
2475 } else {
2476 gpio_set_config(desc, PIN_CONFIG_DRIVE_PUSH_PULL);
2477 }
2478
2479 set_output_value:
2480 ret = gpio_set_bias(desc);
2481 if (ret)
2482 return ret;
2483 return gpiod_direction_output_raw_commit(desc, value);
2484
2485 set_output_flag:
2486 /*
2487 * When emulating open-source or open-drain functionalities by not
2488 * actively driving the line (setting mode to input) we still need to
2489 * set the IS_OUT flag or otherwise we won't be able to set the line
2490 * value anymore.
2491 */
2492 if (ret == 0)
2493 set_bit(FLAG_IS_OUT, &desc->flags);
2494 return ret;
2495 }
2496 EXPORT_SYMBOL_GPL(gpiod_direction_output);
2497
2498 /**
2499 * gpiod_set_config - sets @config for a GPIO
2500 * @desc: descriptor of the GPIO for which to set the configuration
2501 * @config: Same packed config format as generic pinconf
2502 *
2503 * Returns:
2504 * 0 on success, %-ENOTSUPP if the controller doesn't support setting the
2505 * configuration.
2506 */
gpiod_set_config(struct gpio_desc * desc,unsigned long config)2507 int gpiod_set_config(struct gpio_desc *desc, unsigned long config)
2508 {
2509 struct gpio_chip *gc;
2510
2511 VALIDATE_DESC(desc);
2512 gc = desc->gdev->chip;
2513
2514 return gpio_do_set_config(gc, gpio_chip_hwgpio(desc), config);
2515 }
2516 EXPORT_SYMBOL_GPL(gpiod_set_config);
2517
2518 /**
2519 * gpiod_set_debounce - sets @debounce time for a GPIO
2520 * @desc: descriptor of the GPIO for which to set debounce time
2521 * @debounce: debounce time in microseconds
2522 *
2523 * Returns:
2524 * 0 on success, %-ENOTSUPP if the controller doesn't support setting the
2525 * debounce time.
2526 */
gpiod_set_debounce(struct gpio_desc * desc,unsigned debounce)2527 int gpiod_set_debounce(struct gpio_desc *desc, unsigned debounce)
2528 {
2529 unsigned long config;
2530
2531 config = pinconf_to_config_packed(PIN_CONFIG_INPUT_DEBOUNCE, debounce);
2532 return gpiod_set_config(desc, config);
2533 }
2534 EXPORT_SYMBOL_GPL(gpiod_set_debounce);
2535
2536 /**
2537 * gpiod_set_transitory - Lose or retain GPIO state on suspend or reset
2538 * @desc: descriptor of the GPIO for which to configure persistence
2539 * @transitory: True to lose state on suspend or reset, false for persistence
2540 *
2541 * Returns:
2542 * 0 on success, otherwise a negative error code.
2543 */
gpiod_set_transitory(struct gpio_desc * desc,bool transitory)2544 int gpiod_set_transitory(struct gpio_desc *desc, bool transitory)
2545 {
2546 struct gpio_chip *gc;
2547 unsigned long packed;
2548 int gpio;
2549 int rc;
2550
2551 VALIDATE_DESC(desc);
2552 /*
2553 * Handle FLAG_TRANSITORY first, enabling queries to gpiolib for
2554 * persistence state.
2555 */
2556 assign_bit(FLAG_TRANSITORY, &desc->flags, transitory);
2557
2558 /* If the driver supports it, set the persistence state now */
2559 gc = desc->gdev->chip;
2560 if (!gc->set_config)
2561 return 0;
2562
2563 packed = pinconf_to_config_packed(PIN_CONFIG_PERSIST_STATE,
2564 !transitory);
2565 gpio = gpio_chip_hwgpio(desc);
2566 rc = gpio_do_set_config(gc, gpio, packed);
2567 if (rc == -ENOTSUPP) {
2568 dev_dbg(&desc->gdev->dev, "Persistence not supported for GPIO %d\n",
2569 gpio);
2570 return 0;
2571 }
2572
2573 return rc;
2574 }
2575 EXPORT_SYMBOL_GPL(gpiod_set_transitory);
2576
2577 /**
2578 * gpiod_is_active_low - test whether a GPIO is active-low or not
2579 * @desc: the gpio descriptor to test
2580 *
2581 * Returns 1 if the GPIO is active-low, 0 otherwise.
2582 */
gpiod_is_active_low(const struct gpio_desc * desc)2583 int gpiod_is_active_low(const struct gpio_desc *desc)
2584 {
2585 VALIDATE_DESC(desc);
2586 return test_bit(FLAG_ACTIVE_LOW, &desc->flags);
2587 }
2588 EXPORT_SYMBOL_GPL(gpiod_is_active_low);
2589
2590 /**
2591 * gpiod_toggle_active_low - toggle whether a GPIO is active-low or not
2592 * @desc: the gpio descriptor to change
2593 */
gpiod_toggle_active_low(struct gpio_desc * desc)2594 void gpiod_toggle_active_low(struct gpio_desc *desc)
2595 {
2596 VALIDATE_DESC_VOID(desc);
2597 change_bit(FLAG_ACTIVE_LOW, &desc->flags);
2598 }
2599 EXPORT_SYMBOL_GPL(gpiod_toggle_active_low);
2600
2601 /* I/O calls are only valid after configuration completed; the relevant
2602 * "is this a valid GPIO" error checks should already have been done.
2603 *
2604 * "Get" operations are often inlinable as reading a pin value register,
2605 * and masking the relevant bit in that register.
2606 *
2607 * When "set" operations are inlinable, they involve writing that mask to
2608 * one register to set a low value, or a different register to set it high.
2609 * Otherwise locking is needed, so there may be little value to inlining.
2610 *
2611 *------------------------------------------------------------------------
2612 *
2613 * IMPORTANT!!! The hot paths -- get/set value -- assume that callers
2614 * have requested the GPIO. That can include implicit requesting by
2615 * a direction setting call. Marking a gpio as requested locks its chip
2616 * in memory, guaranteeing that these table lookups need no more locking
2617 * and that gpiochip_remove() will fail.
2618 *
2619 * REVISIT when debugging, consider adding some instrumentation to ensure
2620 * that the GPIO was actually requested.
2621 */
2622
gpiod_get_raw_value_commit(const struct gpio_desc * desc)2623 static int gpiod_get_raw_value_commit(const struct gpio_desc *desc)
2624 {
2625 struct gpio_chip *gc;
2626 int offset;
2627 int value;
2628
2629 gc = desc->gdev->chip;
2630 offset = gpio_chip_hwgpio(desc);
2631 value = gc->get ? gc->get(gc, offset) : -EIO;
2632 value = value < 0 ? value : !!value;
2633 trace_gpio_value(desc_to_gpio(desc), 1, value);
2634 return value;
2635 }
2636
gpio_chip_get_multiple(struct gpio_chip * gc,unsigned long * mask,unsigned long * bits)2637 static int gpio_chip_get_multiple(struct gpio_chip *gc,
2638 unsigned long *mask, unsigned long *bits)
2639 {
2640 if (gc->get_multiple) {
2641 return gc->get_multiple(gc, mask, bits);
2642 } else if (gc->get) {
2643 int i, value;
2644
2645 for_each_set_bit(i, mask, gc->ngpio) {
2646 value = gc->get(gc, i);
2647 if (value < 0)
2648 return value;
2649 __assign_bit(i, bits, value);
2650 }
2651 return 0;
2652 }
2653 return -EIO;
2654 }
2655
gpiod_get_array_value_complex(bool raw,bool can_sleep,unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)2656 int gpiod_get_array_value_complex(bool raw, bool can_sleep,
2657 unsigned int array_size,
2658 struct gpio_desc **desc_array,
2659 struct gpio_array *array_info,
2660 unsigned long *value_bitmap)
2661 {
2662 int ret, i = 0;
2663
2664 /*
2665 * Validate array_info against desc_array and its size.
2666 * It should immediately follow desc_array if both
2667 * have been obtained from the same gpiod_get_array() call.
2668 */
2669 if (array_info && array_info->desc == desc_array &&
2670 array_size <= array_info->size &&
2671 (void *)array_info == desc_array + array_info->size) {
2672 if (!can_sleep)
2673 WARN_ON(array_info->chip->can_sleep);
2674
2675 ret = gpio_chip_get_multiple(array_info->chip,
2676 array_info->get_mask,
2677 value_bitmap);
2678 if (ret)
2679 return ret;
2680
2681 if (!raw && !bitmap_empty(array_info->invert_mask, array_size))
2682 bitmap_xor(value_bitmap, value_bitmap,
2683 array_info->invert_mask, array_size);
2684
2685 i = find_first_zero_bit(array_info->get_mask, array_size);
2686 if (i == array_size)
2687 return 0;
2688 } else {
2689 array_info = NULL;
2690 }
2691
2692 while (i < array_size) {
2693 struct gpio_chip *gc = desc_array[i]->gdev->chip;
2694 unsigned long fastpath[2 * BITS_TO_LONGS(FASTPATH_NGPIO)];
2695 unsigned long *mask, *bits;
2696 int first, j, ret;
2697
2698 if (likely(gc->ngpio <= FASTPATH_NGPIO)) {
2699 mask = fastpath;
2700 } else {
2701 mask = kmalloc_array(2 * BITS_TO_LONGS(gc->ngpio),
2702 sizeof(*mask),
2703 can_sleep ? GFP_KERNEL : GFP_ATOMIC);
2704 if (!mask)
2705 return -ENOMEM;
2706 }
2707
2708 bits = mask + BITS_TO_LONGS(gc->ngpio);
2709 bitmap_zero(mask, gc->ngpio);
2710
2711 if (!can_sleep)
2712 WARN_ON(gc->can_sleep);
2713
2714 /* collect all inputs belonging to the same chip */
2715 first = i;
2716 do {
2717 const struct gpio_desc *desc = desc_array[i];
2718 int hwgpio = gpio_chip_hwgpio(desc);
2719
2720 __set_bit(hwgpio, mask);
2721 i++;
2722
2723 if (array_info)
2724 i = find_next_zero_bit(array_info->get_mask,
2725 array_size, i);
2726 } while ((i < array_size) &&
2727 (desc_array[i]->gdev->chip == gc));
2728
2729 ret = gpio_chip_get_multiple(gc, mask, bits);
2730 if (ret) {
2731 if (mask != fastpath)
2732 kfree(mask);
2733 return ret;
2734 }
2735
2736 for (j = first; j < i; ) {
2737 const struct gpio_desc *desc = desc_array[j];
2738 int hwgpio = gpio_chip_hwgpio(desc);
2739 int value = test_bit(hwgpio, bits);
2740
2741 if (!raw && test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2742 value = !value;
2743 __assign_bit(j, value_bitmap, value);
2744 trace_gpio_value(desc_to_gpio(desc), 1, value);
2745 j++;
2746
2747 if (array_info)
2748 j = find_next_zero_bit(array_info->get_mask, i,
2749 j);
2750 }
2751
2752 if (mask != fastpath)
2753 kfree(mask);
2754 }
2755 return 0;
2756 }
2757
2758 /**
2759 * gpiod_get_raw_value() - return a gpio's raw value
2760 * @desc: gpio whose value will be returned
2761 *
2762 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
2763 * its ACTIVE_LOW status, or negative errno on failure.
2764 *
2765 * This function can be called from contexts where we cannot sleep, and will
2766 * complain if the GPIO chip functions potentially sleep.
2767 */
gpiod_get_raw_value(const struct gpio_desc * desc)2768 int gpiod_get_raw_value(const struct gpio_desc *desc)
2769 {
2770 VALIDATE_DESC(desc);
2771 /* Should be using gpiod_get_raw_value_cansleep() */
2772 WARN_ON(desc->gdev->chip->can_sleep);
2773 return gpiod_get_raw_value_commit(desc);
2774 }
2775 EXPORT_SYMBOL_GPL(gpiod_get_raw_value);
2776
2777 /**
2778 * gpiod_get_value() - return a gpio's value
2779 * @desc: gpio whose value will be returned
2780 *
2781 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
2782 * account, or negative errno on failure.
2783 *
2784 * This function can be called from contexts where we cannot sleep, and will
2785 * complain if the GPIO chip functions potentially sleep.
2786 */
gpiod_get_value(const struct gpio_desc * desc)2787 int gpiod_get_value(const struct gpio_desc *desc)
2788 {
2789 int value;
2790
2791 VALIDATE_DESC(desc);
2792 /* Should be using gpiod_get_value_cansleep() */
2793 WARN_ON(desc->gdev->chip->can_sleep);
2794
2795 value = gpiod_get_raw_value_commit(desc);
2796 if (value < 0)
2797 return value;
2798
2799 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
2800 value = !value;
2801
2802 return value;
2803 }
2804 EXPORT_SYMBOL_GPL(gpiod_get_value);
2805
2806 /**
2807 * gpiod_get_raw_array_value() - read raw values from an array of GPIOs
2808 * @array_size: number of elements in the descriptor array / value bitmap
2809 * @desc_array: array of GPIO descriptors whose values will be read
2810 * @array_info: information on applicability of fast bitmap processing path
2811 * @value_bitmap: bitmap to store the read values
2812 *
2813 * Read the raw values of the GPIOs, i.e. the values of the physical lines
2814 * without regard for their ACTIVE_LOW status. Return 0 in case of success,
2815 * else an error code.
2816 *
2817 * This function can be called from contexts where we cannot sleep,
2818 * and it will complain if the GPIO chip functions potentially sleep.
2819 */
gpiod_get_raw_array_value(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)2820 int gpiod_get_raw_array_value(unsigned int array_size,
2821 struct gpio_desc **desc_array,
2822 struct gpio_array *array_info,
2823 unsigned long *value_bitmap)
2824 {
2825 if (!desc_array)
2826 return -EINVAL;
2827 return gpiod_get_array_value_complex(true, false, array_size,
2828 desc_array, array_info,
2829 value_bitmap);
2830 }
2831 EXPORT_SYMBOL_GPL(gpiod_get_raw_array_value);
2832
2833 /**
2834 * gpiod_get_array_value() - read values from an array of GPIOs
2835 * @array_size: number of elements in the descriptor array / value bitmap
2836 * @desc_array: array of GPIO descriptors whose values will be read
2837 * @array_info: information on applicability of fast bitmap processing path
2838 * @value_bitmap: bitmap to store the read values
2839 *
2840 * Read the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
2841 * into account. Return 0 in case of success, else an error code.
2842 *
2843 * This function can be called from contexts where we cannot sleep,
2844 * and it will complain if the GPIO chip functions potentially sleep.
2845 */
gpiod_get_array_value(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)2846 int gpiod_get_array_value(unsigned int array_size,
2847 struct gpio_desc **desc_array,
2848 struct gpio_array *array_info,
2849 unsigned long *value_bitmap)
2850 {
2851 if (!desc_array)
2852 return -EINVAL;
2853 return gpiod_get_array_value_complex(false, false, array_size,
2854 desc_array, array_info,
2855 value_bitmap);
2856 }
2857 EXPORT_SYMBOL_GPL(gpiod_get_array_value);
2858
2859 /*
2860 * gpio_set_open_drain_value_commit() - Set the open drain gpio's value.
2861 * @desc: gpio descriptor whose state need to be set.
2862 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
2863 */
gpio_set_open_drain_value_commit(struct gpio_desc * desc,bool value)2864 static void gpio_set_open_drain_value_commit(struct gpio_desc *desc, bool value)
2865 {
2866 int ret = 0;
2867 struct gpio_chip *gc = desc->gdev->chip;
2868 int offset = gpio_chip_hwgpio(desc);
2869
2870 if (value) {
2871 ret = gc->direction_input(gc, offset);
2872 } else {
2873 ret = gc->direction_output(gc, offset, 0);
2874 if (!ret)
2875 set_bit(FLAG_IS_OUT, &desc->flags);
2876 }
2877 trace_gpio_direction(desc_to_gpio(desc), value, ret);
2878 if (ret < 0)
2879 gpiod_err(desc,
2880 "%s: Error in set_value for open drain err %d\n",
2881 __func__, ret);
2882 }
2883
2884 /*
2885 * _gpio_set_open_source_value() - Set the open source gpio's value.
2886 * @desc: gpio descriptor whose state need to be set.
2887 * @value: Non-zero for setting it HIGH otherwise it will set to LOW.
2888 */
gpio_set_open_source_value_commit(struct gpio_desc * desc,bool value)2889 static void gpio_set_open_source_value_commit(struct gpio_desc *desc, bool value)
2890 {
2891 int ret = 0;
2892 struct gpio_chip *gc = desc->gdev->chip;
2893 int offset = gpio_chip_hwgpio(desc);
2894
2895 if (value) {
2896 ret = gc->direction_output(gc, offset, 1);
2897 if (!ret)
2898 set_bit(FLAG_IS_OUT, &desc->flags);
2899 } else {
2900 ret = gc->direction_input(gc, offset);
2901 }
2902 trace_gpio_direction(desc_to_gpio(desc), !value, ret);
2903 if (ret < 0)
2904 gpiod_err(desc,
2905 "%s: Error in set_value for open source err %d\n",
2906 __func__, ret);
2907 }
2908
gpiod_set_raw_value_commit(struct gpio_desc * desc,bool value)2909 static void gpiod_set_raw_value_commit(struct gpio_desc *desc, bool value)
2910 {
2911 struct gpio_chip *gc;
2912
2913 gc = desc->gdev->chip;
2914 trace_gpio_value(desc_to_gpio(desc), 0, value);
2915 gc->set(gc, gpio_chip_hwgpio(desc), value);
2916 }
2917
2918 /*
2919 * set multiple outputs on the same chip;
2920 * use the chip's set_multiple function if available;
2921 * otherwise set the outputs sequentially;
2922 * @chip: the GPIO chip we operate on
2923 * @mask: bit mask array; one bit per output; BITS_PER_LONG bits per word
2924 * defines which outputs are to be changed
2925 * @bits: bit value array; one bit per output; BITS_PER_LONG bits per word
2926 * defines the values the outputs specified by mask are to be set to
2927 */
gpio_chip_set_multiple(struct gpio_chip * gc,unsigned long * mask,unsigned long * bits)2928 static void gpio_chip_set_multiple(struct gpio_chip *gc,
2929 unsigned long *mask, unsigned long *bits)
2930 {
2931 if (gc->set_multiple) {
2932 gc->set_multiple(gc, mask, bits);
2933 } else {
2934 unsigned int i;
2935
2936 /* set outputs if the corresponding mask bit is set */
2937 for_each_set_bit(i, mask, gc->ngpio)
2938 gc->set(gc, i, test_bit(i, bits));
2939 }
2940 }
2941
gpiod_set_array_value_complex(bool raw,bool can_sleep,unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)2942 int gpiod_set_array_value_complex(bool raw, bool can_sleep,
2943 unsigned int array_size,
2944 struct gpio_desc **desc_array,
2945 struct gpio_array *array_info,
2946 unsigned long *value_bitmap)
2947 {
2948 int i = 0;
2949
2950 /*
2951 * Validate array_info against desc_array and its size.
2952 * It should immediately follow desc_array if both
2953 * have been obtained from the same gpiod_get_array() call.
2954 */
2955 if (array_info && array_info->desc == desc_array &&
2956 array_size <= array_info->size &&
2957 (void *)array_info == desc_array + array_info->size) {
2958 if (!can_sleep)
2959 WARN_ON(array_info->chip->can_sleep);
2960
2961 if (!raw && !bitmap_empty(array_info->invert_mask, array_size))
2962 bitmap_xor(value_bitmap, value_bitmap,
2963 array_info->invert_mask, array_size);
2964
2965 gpio_chip_set_multiple(array_info->chip, array_info->set_mask,
2966 value_bitmap);
2967
2968 i = find_first_zero_bit(array_info->set_mask, array_size);
2969 if (i == array_size)
2970 return 0;
2971 } else {
2972 array_info = NULL;
2973 }
2974
2975 while (i < array_size) {
2976 struct gpio_chip *gc = desc_array[i]->gdev->chip;
2977 unsigned long fastpath[2 * BITS_TO_LONGS(FASTPATH_NGPIO)];
2978 unsigned long *mask, *bits;
2979 int count = 0;
2980
2981 if (likely(gc->ngpio <= FASTPATH_NGPIO)) {
2982 mask = fastpath;
2983 } else {
2984 mask = kmalloc_array(2 * BITS_TO_LONGS(gc->ngpio),
2985 sizeof(*mask),
2986 can_sleep ? GFP_KERNEL : GFP_ATOMIC);
2987 if (!mask)
2988 return -ENOMEM;
2989 }
2990
2991 bits = mask + BITS_TO_LONGS(gc->ngpio);
2992 bitmap_zero(mask, gc->ngpio);
2993
2994 if (!can_sleep)
2995 WARN_ON(gc->can_sleep);
2996
2997 do {
2998 struct gpio_desc *desc = desc_array[i];
2999 int hwgpio = gpio_chip_hwgpio(desc);
3000 int value = test_bit(i, value_bitmap);
3001
3002 /*
3003 * Pins applicable for fast input but not for
3004 * fast output processing may have been already
3005 * inverted inside the fast path, skip them.
3006 */
3007 if (!raw && !(array_info &&
3008 test_bit(i, array_info->invert_mask)) &&
3009 test_bit(FLAG_ACTIVE_LOW, &desc->flags))
3010 value = !value;
3011 trace_gpio_value(desc_to_gpio(desc), 0, value);
3012 /*
3013 * collect all normal outputs belonging to the same chip
3014 * open drain and open source outputs are set individually
3015 */
3016 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags) && !raw) {
3017 gpio_set_open_drain_value_commit(desc, value);
3018 } else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags) && !raw) {
3019 gpio_set_open_source_value_commit(desc, value);
3020 } else {
3021 __set_bit(hwgpio, mask);
3022 __assign_bit(hwgpio, bits, value);
3023 count++;
3024 }
3025 i++;
3026
3027 if (array_info)
3028 i = find_next_zero_bit(array_info->set_mask,
3029 array_size, i);
3030 } while ((i < array_size) &&
3031 (desc_array[i]->gdev->chip == gc));
3032 /* push collected bits to outputs */
3033 if (count != 0)
3034 gpio_chip_set_multiple(gc, mask, bits);
3035
3036 if (mask != fastpath)
3037 kfree(mask);
3038 }
3039 return 0;
3040 }
3041
3042 /**
3043 * gpiod_set_raw_value() - assign a gpio's raw value
3044 * @desc: gpio whose value will be assigned
3045 * @value: value to assign
3046 *
3047 * Set the raw value of the GPIO, i.e. the value of its physical line without
3048 * regard for its ACTIVE_LOW status.
3049 *
3050 * This function can be called from contexts where we cannot sleep, and will
3051 * complain if the GPIO chip functions potentially sleep.
3052 */
gpiod_set_raw_value(struct gpio_desc * desc,int value)3053 void gpiod_set_raw_value(struct gpio_desc *desc, int value)
3054 {
3055 VALIDATE_DESC_VOID(desc);
3056 /* Should be using gpiod_set_raw_value_cansleep() */
3057 WARN_ON(desc->gdev->chip->can_sleep);
3058 gpiod_set_raw_value_commit(desc, value);
3059 }
3060 EXPORT_SYMBOL_GPL(gpiod_set_raw_value);
3061
3062 /**
3063 * gpiod_set_value_nocheck() - set a GPIO line value without checking
3064 * @desc: the descriptor to set the value on
3065 * @value: value to set
3066 *
3067 * This sets the value of a GPIO line backing a descriptor, applying
3068 * different semantic quirks like active low and open drain/source
3069 * handling.
3070 */
gpiod_set_value_nocheck(struct gpio_desc * desc,int value)3071 static void gpiod_set_value_nocheck(struct gpio_desc *desc, int value)
3072 {
3073 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
3074 value = !value;
3075 if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
3076 gpio_set_open_drain_value_commit(desc, value);
3077 else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
3078 gpio_set_open_source_value_commit(desc, value);
3079 else
3080 gpiod_set_raw_value_commit(desc, value);
3081 }
3082
3083 /**
3084 * gpiod_set_value() - assign a gpio's value
3085 * @desc: gpio whose value will be assigned
3086 * @value: value to assign
3087 *
3088 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW,
3089 * OPEN_DRAIN and OPEN_SOURCE flags into account.
3090 *
3091 * This function can be called from contexts where we cannot sleep, and will
3092 * complain if the GPIO chip functions potentially sleep.
3093 */
gpiod_set_value(struct gpio_desc * desc,int value)3094 void gpiod_set_value(struct gpio_desc *desc, int value)
3095 {
3096 VALIDATE_DESC_VOID(desc);
3097 /* Should be using gpiod_set_value_cansleep() */
3098 WARN_ON(desc->gdev->chip->can_sleep);
3099 gpiod_set_value_nocheck(desc, value);
3100 }
3101 EXPORT_SYMBOL_GPL(gpiod_set_value);
3102
3103 /**
3104 * gpiod_set_raw_array_value() - assign values to an array of GPIOs
3105 * @array_size: number of elements in the descriptor array / value bitmap
3106 * @desc_array: array of GPIO descriptors whose values will be assigned
3107 * @array_info: information on applicability of fast bitmap processing path
3108 * @value_bitmap: bitmap of values to assign
3109 *
3110 * Set the raw values of the GPIOs, i.e. the values of the physical lines
3111 * without regard for their ACTIVE_LOW status.
3112 *
3113 * This function can be called from contexts where we cannot sleep, and will
3114 * complain if the GPIO chip functions potentially sleep.
3115 */
gpiod_set_raw_array_value(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)3116 int gpiod_set_raw_array_value(unsigned int array_size,
3117 struct gpio_desc **desc_array,
3118 struct gpio_array *array_info,
3119 unsigned long *value_bitmap)
3120 {
3121 if (!desc_array)
3122 return -EINVAL;
3123 return gpiod_set_array_value_complex(true, false, array_size,
3124 desc_array, array_info, value_bitmap);
3125 }
3126 EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value);
3127
3128 /**
3129 * gpiod_set_array_value() - assign values to an array of GPIOs
3130 * @array_size: number of elements in the descriptor array / value bitmap
3131 * @desc_array: array of GPIO descriptors whose values will be assigned
3132 * @array_info: information on applicability of fast bitmap processing path
3133 * @value_bitmap: bitmap of values to assign
3134 *
3135 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3136 * into account.
3137 *
3138 * This function can be called from contexts where we cannot sleep, and will
3139 * complain if the GPIO chip functions potentially sleep.
3140 */
gpiod_set_array_value(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)3141 int gpiod_set_array_value(unsigned int array_size,
3142 struct gpio_desc **desc_array,
3143 struct gpio_array *array_info,
3144 unsigned long *value_bitmap)
3145 {
3146 if (!desc_array)
3147 return -EINVAL;
3148 return gpiod_set_array_value_complex(false, false, array_size,
3149 desc_array, array_info,
3150 value_bitmap);
3151 }
3152 EXPORT_SYMBOL_GPL(gpiod_set_array_value);
3153
3154 /**
3155 * gpiod_cansleep() - report whether gpio value access may sleep
3156 * @desc: gpio to check
3157 *
3158 */
gpiod_cansleep(const struct gpio_desc * desc)3159 int gpiod_cansleep(const struct gpio_desc *desc)
3160 {
3161 VALIDATE_DESC(desc);
3162 return desc->gdev->chip->can_sleep;
3163 }
3164 EXPORT_SYMBOL_GPL(gpiod_cansleep);
3165
3166 /**
3167 * gpiod_set_consumer_name() - set the consumer name for the descriptor
3168 * @desc: gpio to set the consumer name on
3169 * @name: the new consumer name
3170 */
gpiod_set_consumer_name(struct gpio_desc * desc,const char * name)3171 int gpiod_set_consumer_name(struct gpio_desc *desc, const char *name)
3172 {
3173 VALIDATE_DESC(desc);
3174 if (name) {
3175 name = kstrdup_const(name, GFP_KERNEL);
3176 if (!name)
3177 return -ENOMEM;
3178 }
3179
3180 kfree_const(desc->label);
3181 desc_set_label(desc, name);
3182
3183 return 0;
3184 }
3185 EXPORT_SYMBOL_GPL(gpiod_set_consumer_name);
3186
3187 /**
3188 * gpiod_to_irq() - return the IRQ corresponding to a GPIO
3189 * @desc: gpio whose IRQ will be returned (already requested)
3190 *
3191 * Return the IRQ corresponding to the passed GPIO, or an error code in case of
3192 * error.
3193 */
gpiod_to_irq(const struct gpio_desc * desc)3194 int gpiod_to_irq(const struct gpio_desc *desc)
3195 {
3196 struct gpio_chip *gc;
3197 int offset;
3198
3199 /*
3200 * Cannot VALIDATE_DESC() here as gpiod_to_irq() consumer semantics
3201 * requires this function to not return zero on an invalid descriptor
3202 * but rather a negative error number.
3203 */
3204 if (!desc || IS_ERR(desc) || !desc->gdev || !desc->gdev->chip)
3205 return -EINVAL;
3206
3207 gc = desc->gdev->chip;
3208 offset = gpio_chip_hwgpio(desc);
3209 if (gc->to_irq) {
3210 int retirq = gc->to_irq(gc, offset);
3211
3212 /* Zero means NO_IRQ */
3213 if (!retirq)
3214 return -ENXIO;
3215
3216 return retirq;
3217 }
3218 return -ENXIO;
3219 }
3220 EXPORT_SYMBOL_GPL(gpiod_to_irq);
3221
3222 /**
3223 * gpiochip_lock_as_irq() - lock a GPIO to be used as IRQ
3224 * @gc: the chip the GPIO to lock belongs to
3225 * @offset: the offset of the GPIO to lock as IRQ
3226 *
3227 * This is used directly by GPIO drivers that want to lock down
3228 * a certain GPIO line to be used for IRQs.
3229 */
gpiochip_lock_as_irq(struct gpio_chip * gc,unsigned int offset)3230 int gpiochip_lock_as_irq(struct gpio_chip *gc, unsigned int offset)
3231 {
3232 struct gpio_desc *desc;
3233
3234 desc = gpiochip_get_desc(gc, offset);
3235 if (IS_ERR(desc))
3236 return PTR_ERR(desc);
3237
3238 /*
3239 * If it's fast: flush the direction setting if something changed
3240 * behind our back
3241 */
3242 if (!gc->can_sleep && gc->get_direction) {
3243 int dir = gpiod_get_direction(desc);
3244
3245 if (dir < 0) {
3246 chip_err(gc, "%s: cannot get GPIO direction\n",
3247 __func__);
3248 return dir;
3249 }
3250 }
3251
3252 /* To be valid for IRQ the line needs to be input or open drain */
3253 if (test_bit(FLAG_IS_OUT, &desc->flags) &&
3254 !test_bit(FLAG_OPEN_DRAIN, &desc->flags)) {
3255 chip_err(gc,
3256 "%s: tried to flag a GPIO set as output for IRQ\n",
3257 __func__);
3258 return -EIO;
3259 }
3260
3261 set_bit(FLAG_USED_AS_IRQ, &desc->flags);
3262 set_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3263
3264 /*
3265 * If the consumer has not set up a label (such as when the
3266 * IRQ is referenced from .to_irq()) we set up a label here
3267 * so it is clear this is used as an interrupt.
3268 */
3269 if (!desc->label)
3270 desc_set_label(desc, "interrupt");
3271
3272 return 0;
3273 }
3274 EXPORT_SYMBOL_GPL(gpiochip_lock_as_irq);
3275
3276 /**
3277 * gpiochip_unlock_as_irq() - unlock a GPIO used as IRQ
3278 * @gc: the chip the GPIO to lock belongs to
3279 * @offset: the offset of the GPIO to lock as IRQ
3280 *
3281 * This is used directly by GPIO drivers that want to indicate
3282 * that a certain GPIO is no longer used exclusively for IRQ.
3283 */
gpiochip_unlock_as_irq(struct gpio_chip * gc,unsigned int offset)3284 void gpiochip_unlock_as_irq(struct gpio_chip *gc, unsigned int offset)
3285 {
3286 struct gpio_desc *desc;
3287
3288 desc = gpiochip_get_desc(gc, offset);
3289 if (IS_ERR(desc))
3290 return;
3291
3292 clear_bit(FLAG_USED_AS_IRQ, &desc->flags);
3293 clear_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3294
3295 /* If we only had this marking, erase it */
3296 if (desc->label && !strcmp(desc->label, "interrupt"))
3297 desc_set_label(desc, NULL);
3298 }
3299 EXPORT_SYMBOL_GPL(gpiochip_unlock_as_irq);
3300
gpiochip_disable_irq(struct gpio_chip * gc,unsigned int offset)3301 void gpiochip_disable_irq(struct gpio_chip *gc, unsigned int offset)
3302 {
3303 struct gpio_desc *desc = gpiochip_get_desc(gc, offset);
3304
3305 if (!IS_ERR(desc) &&
3306 !WARN_ON(!test_bit(FLAG_USED_AS_IRQ, &desc->flags)))
3307 clear_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3308 }
3309 EXPORT_SYMBOL_GPL(gpiochip_disable_irq);
3310
gpiochip_enable_irq(struct gpio_chip * gc,unsigned int offset)3311 void gpiochip_enable_irq(struct gpio_chip *gc, unsigned int offset)
3312 {
3313 struct gpio_desc *desc = gpiochip_get_desc(gc, offset);
3314
3315 if (!IS_ERR(desc) &&
3316 !WARN_ON(!test_bit(FLAG_USED_AS_IRQ, &desc->flags))) {
3317 /*
3318 * We must not be output when using IRQ UNLESS we are
3319 * open drain.
3320 */
3321 WARN_ON(test_bit(FLAG_IS_OUT, &desc->flags) &&
3322 !test_bit(FLAG_OPEN_DRAIN, &desc->flags));
3323 set_bit(FLAG_IRQ_IS_ENABLED, &desc->flags);
3324 }
3325 }
3326 EXPORT_SYMBOL_GPL(gpiochip_enable_irq);
3327
gpiochip_line_is_irq(struct gpio_chip * gc,unsigned int offset)3328 bool gpiochip_line_is_irq(struct gpio_chip *gc, unsigned int offset)
3329 {
3330 if (offset >= gc->ngpio)
3331 return false;
3332
3333 return test_bit(FLAG_USED_AS_IRQ, &gc->gpiodev->descs[offset].flags);
3334 }
3335 EXPORT_SYMBOL_GPL(gpiochip_line_is_irq);
3336
gpiochip_reqres_irq(struct gpio_chip * gc,unsigned int offset)3337 int gpiochip_reqres_irq(struct gpio_chip *gc, unsigned int offset)
3338 {
3339 int ret;
3340
3341 if (!try_module_get(gc->gpiodev->owner))
3342 return -ENODEV;
3343
3344 ret = gpiochip_lock_as_irq(gc, offset);
3345 if (ret) {
3346 chip_err(gc, "unable to lock HW IRQ %u for IRQ\n", offset);
3347 module_put(gc->gpiodev->owner);
3348 return ret;
3349 }
3350 return 0;
3351 }
3352 EXPORT_SYMBOL_GPL(gpiochip_reqres_irq);
3353
gpiochip_relres_irq(struct gpio_chip * gc,unsigned int offset)3354 void gpiochip_relres_irq(struct gpio_chip *gc, unsigned int offset)
3355 {
3356 gpiochip_unlock_as_irq(gc, offset);
3357 module_put(gc->gpiodev->owner);
3358 }
3359 EXPORT_SYMBOL_GPL(gpiochip_relres_irq);
3360
gpiochip_line_is_open_drain(struct gpio_chip * gc,unsigned int offset)3361 bool gpiochip_line_is_open_drain(struct gpio_chip *gc, unsigned int offset)
3362 {
3363 if (offset >= gc->ngpio)
3364 return false;
3365
3366 return test_bit(FLAG_OPEN_DRAIN, &gc->gpiodev->descs[offset].flags);
3367 }
3368 EXPORT_SYMBOL_GPL(gpiochip_line_is_open_drain);
3369
gpiochip_line_is_open_source(struct gpio_chip * gc,unsigned int offset)3370 bool gpiochip_line_is_open_source(struct gpio_chip *gc, unsigned int offset)
3371 {
3372 if (offset >= gc->ngpio)
3373 return false;
3374
3375 return test_bit(FLAG_OPEN_SOURCE, &gc->gpiodev->descs[offset].flags);
3376 }
3377 EXPORT_SYMBOL_GPL(gpiochip_line_is_open_source);
3378
gpiochip_line_is_persistent(struct gpio_chip * gc,unsigned int offset)3379 bool gpiochip_line_is_persistent(struct gpio_chip *gc, unsigned int offset)
3380 {
3381 if (offset >= gc->ngpio)
3382 return false;
3383
3384 return !test_bit(FLAG_TRANSITORY, &gc->gpiodev->descs[offset].flags);
3385 }
3386 EXPORT_SYMBOL_GPL(gpiochip_line_is_persistent);
3387
3388 /**
3389 * gpiod_get_raw_value_cansleep() - return a gpio's raw value
3390 * @desc: gpio whose value will be returned
3391 *
3392 * Return the GPIO's raw value, i.e. the value of the physical line disregarding
3393 * its ACTIVE_LOW status, or negative errno on failure.
3394 *
3395 * This function is to be called from contexts that can sleep.
3396 */
gpiod_get_raw_value_cansleep(const struct gpio_desc * desc)3397 int gpiod_get_raw_value_cansleep(const struct gpio_desc *desc)
3398 {
3399 might_sleep_if(extra_checks);
3400 VALIDATE_DESC(desc);
3401 return gpiod_get_raw_value_commit(desc);
3402 }
3403 EXPORT_SYMBOL_GPL(gpiod_get_raw_value_cansleep);
3404
3405 /**
3406 * gpiod_get_value_cansleep() - return a gpio's value
3407 * @desc: gpio whose value will be returned
3408 *
3409 * Return the GPIO's logical value, i.e. taking the ACTIVE_LOW status into
3410 * account, or negative errno on failure.
3411 *
3412 * This function is to be called from contexts that can sleep.
3413 */
gpiod_get_value_cansleep(const struct gpio_desc * desc)3414 int gpiod_get_value_cansleep(const struct gpio_desc *desc)
3415 {
3416 int value;
3417
3418 might_sleep_if(extra_checks);
3419 VALIDATE_DESC(desc);
3420 value = gpiod_get_raw_value_commit(desc);
3421 if (value < 0)
3422 return value;
3423
3424 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
3425 value = !value;
3426
3427 return value;
3428 }
3429 EXPORT_SYMBOL_GPL(gpiod_get_value_cansleep);
3430
3431 /**
3432 * gpiod_get_raw_array_value_cansleep() - read raw values from an array of GPIOs
3433 * @array_size: number of elements in the descriptor array / value bitmap
3434 * @desc_array: array of GPIO descriptors whose values will be read
3435 * @array_info: information on applicability of fast bitmap processing path
3436 * @value_bitmap: bitmap to store the read values
3437 *
3438 * Read the raw values of the GPIOs, i.e. the values of the physical lines
3439 * without regard for their ACTIVE_LOW status. Return 0 in case of success,
3440 * else an error code.
3441 *
3442 * This function is to be called from contexts that can sleep.
3443 */
gpiod_get_raw_array_value_cansleep(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)3444 int gpiod_get_raw_array_value_cansleep(unsigned int array_size,
3445 struct gpio_desc **desc_array,
3446 struct gpio_array *array_info,
3447 unsigned long *value_bitmap)
3448 {
3449 might_sleep_if(extra_checks);
3450 if (!desc_array)
3451 return -EINVAL;
3452 return gpiod_get_array_value_complex(true, true, array_size,
3453 desc_array, array_info,
3454 value_bitmap);
3455 }
3456 EXPORT_SYMBOL_GPL(gpiod_get_raw_array_value_cansleep);
3457
3458 /**
3459 * gpiod_get_array_value_cansleep() - read values from an array of GPIOs
3460 * @array_size: number of elements in the descriptor array / value bitmap
3461 * @desc_array: array of GPIO descriptors whose values will be read
3462 * @array_info: information on applicability of fast bitmap processing path
3463 * @value_bitmap: bitmap to store the read values
3464 *
3465 * Read the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3466 * into account. Return 0 in case of success, else an error code.
3467 *
3468 * This function is to be called from contexts that can sleep.
3469 */
gpiod_get_array_value_cansleep(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)3470 int gpiod_get_array_value_cansleep(unsigned int array_size,
3471 struct gpio_desc **desc_array,
3472 struct gpio_array *array_info,
3473 unsigned long *value_bitmap)
3474 {
3475 might_sleep_if(extra_checks);
3476 if (!desc_array)
3477 return -EINVAL;
3478 return gpiod_get_array_value_complex(false, true, array_size,
3479 desc_array, array_info,
3480 value_bitmap);
3481 }
3482 EXPORT_SYMBOL_GPL(gpiod_get_array_value_cansleep);
3483
3484 /**
3485 * gpiod_set_raw_value_cansleep() - assign a gpio's raw value
3486 * @desc: gpio whose value will be assigned
3487 * @value: value to assign
3488 *
3489 * Set the raw value of the GPIO, i.e. the value of its physical line without
3490 * regard for its ACTIVE_LOW status.
3491 *
3492 * This function is to be called from contexts that can sleep.
3493 */
gpiod_set_raw_value_cansleep(struct gpio_desc * desc,int value)3494 void gpiod_set_raw_value_cansleep(struct gpio_desc *desc, int value)
3495 {
3496 might_sleep_if(extra_checks);
3497 VALIDATE_DESC_VOID(desc);
3498 gpiod_set_raw_value_commit(desc, value);
3499 }
3500 EXPORT_SYMBOL_GPL(gpiod_set_raw_value_cansleep);
3501
3502 /**
3503 * gpiod_set_value_cansleep() - assign a gpio's value
3504 * @desc: gpio whose value will be assigned
3505 * @value: value to assign
3506 *
3507 * Set the logical value of the GPIO, i.e. taking its ACTIVE_LOW status into
3508 * account
3509 *
3510 * This function is to be called from contexts that can sleep.
3511 */
gpiod_set_value_cansleep(struct gpio_desc * desc,int value)3512 void gpiod_set_value_cansleep(struct gpio_desc *desc, int value)
3513 {
3514 might_sleep_if(extra_checks);
3515 VALIDATE_DESC_VOID(desc);
3516 gpiod_set_value_nocheck(desc, value);
3517 }
3518 EXPORT_SYMBOL_GPL(gpiod_set_value_cansleep);
3519
3520 /**
3521 * gpiod_set_raw_array_value_cansleep() - assign values to an array of GPIOs
3522 * @array_size: number of elements in the descriptor array / value bitmap
3523 * @desc_array: array of GPIO descriptors whose values will be assigned
3524 * @array_info: information on applicability of fast bitmap processing path
3525 * @value_bitmap: bitmap of values to assign
3526 *
3527 * Set the raw values of the GPIOs, i.e. the values of the physical lines
3528 * without regard for their ACTIVE_LOW status.
3529 *
3530 * This function is to be called from contexts that can sleep.
3531 */
gpiod_set_raw_array_value_cansleep(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)3532 int gpiod_set_raw_array_value_cansleep(unsigned int array_size,
3533 struct gpio_desc **desc_array,
3534 struct gpio_array *array_info,
3535 unsigned long *value_bitmap)
3536 {
3537 might_sleep_if(extra_checks);
3538 if (!desc_array)
3539 return -EINVAL;
3540 return gpiod_set_array_value_complex(true, true, array_size, desc_array,
3541 array_info, value_bitmap);
3542 }
3543 EXPORT_SYMBOL_GPL(gpiod_set_raw_array_value_cansleep);
3544
3545 /**
3546 * gpiod_add_lookup_tables() - register GPIO device consumers
3547 * @tables: list of tables of consumers to register
3548 * @n: number of tables in the list
3549 */
gpiod_add_lookup_tables(struct gpiod_lookup_table ** tables,size_t n)3550 void gpiod_add_lookup_tables(struct gpiod_lookup_table **tables, size_t n)
3551 {
3552 unsigned int i;
3553
3554 mutex_lock(&gpio_lookup_lock);
3555
3556 for (i = 0; i < n; i++)
3557 list_add_tail(&tables[i]->list, &gpio_lookup_list);
3558
3559 mutex_unlock(&gpio_lookup_lock);
3560 }
3561
3562 /**
3563 * gpiod_set_array_value_cansleep() - assign values to an array of GPIOs
3564 * @array_size: number of elements in the descriptor array / value bitmap
3565 * @desc_array: array of GPIO descriptors whose values will be assigned
3566 * @array_info: information on applicability of fast bitmap processing path
3567 * @value_bitmap: bitmap of values to assign
3568 *
3569 * Set the logical values of the GPIOs, i.e. taking their ACTIVE_LOW status
3570 * into account.
3571 *
3572 * This function is to be called from contexts that can sleep.
3573 */
gpiod_set_array_value_cansleep(unsigned int array_size,struct gpio_desc ** desc_array,struct gpio_array * array_info,unsigned long * value_bitmap)3574 int gpiod_set_array_value_cansleep(unsigned int array_size,
3575 struct gpio_desc **desc_array,
3576 struct gpio_array *array_info,
3577 unsigned long *value_bitmap)
3578 {
3579 might_sleep_if(extra_checks);
3580 if (!desc_array)
3581 return -EINVAL;
3582 return gpiod_set_array_value_complex(false, true, array_size,
3583 desc_array, array_info,
3584 value_bitmap);
3585 }
3586 EXPORT_SYMBOL_GPL(gpiod_set_array_value_cansleep);
3587
3588 /**
3589 * gpiod_add_lookup_table() - register GPIO device consumers
3590 * @table: table of consumers to register
3591 */
gpiod_add_lookup_table(struct gpiod_lookup_table * table)3592 void gpiod_add_lookup_table(struct gpiod_lookup_table *table)
3593 {
3594 mutex_lock(&gpio_lookup_lock);
3595
3596 list_add_tail(&table->list, &gpio_lookup_list);
3597
3598 mutex_unlock(&gpio_lookup_lock);
3599 }
3600 EXPORT_SYMBOL_GPL(gpiod_add_lookup_table);
3601
3602 /**
3603 * gpiod_remove_lookup_table() - unregister GPIO device consumers
3604 * @table: table of consumers to unregister
3605 */
gpiod_remove_lookup_table(struct gpiod_lookup_table * table)3606 void gpiod_remove_lookup_table(struct gpiod_lookup_table *table)
3607 {
3608 mutex_lock(&gpio_lookup_lock);
3609
3610 list_del(&table->list);
3611
3612 mutex_unlock(&gpio_lookup_lock);
3613 }
3614 EXPORT_SYMBOL_GPL(gpiod_remove_lookup_table);
3615
3616 /**
3617 * gpiod_add_hogs() - register a set of GPIO hogs from machine code
3618 * @hogs: table of gpio hog entries with a zeroed sentinel at the end
3619 */
gpiod_add_hogs(struct gpiod_hog * hogs)3620 void gpiod_add_hogs(struct gpiod_hog *hogs)
3621 {
3622 struct gpio_chip *gc;
3623 struct gpiod_hog *hog;
3624
3625 mutex_lock(&gpio_machine_hogs_mutex);
3626
3627 for (hog = &hogs[0]; hog->chip_label; hog++) {
3628 list_add_tail(&hog->list, &gpio_machine_hogs);
3629
3630 /*
3631 * The chip may have been registered earlier, so check if it
3632 * exists and, if so, try to hog the line now.
3633 */
3634 gc = find_chip_by_name(hog->chip_label);
3635 if (gc)
3636 gpiochip_machine_hog(gc, hog);
3637 }
3638
3639 mutex_unlock(&gpio_machine_hogs_mutex);
3640 }
3641 EXPORT_SYMBOL_GPL(gpiod_add_hogs);
3642
gpiod_find_lookup_table(struct device * dev)3643 static struct gpiod_lookup_table *gpiod_find_lookup_table(struct device *dev)
3644 {
3645 const char *dev_id = dev ? dev_name(dev) : NULL;
3646 struct gpiod_lookup_table *table;
3647
3648 mutex_lock(&gpio_lookup_lock);
3649
3650 list_for_each_entry(table, &gpio_lookup_list, list) {
3651 if (table->dev_id && dev_id) {
3652 /*
3653 * Valid strings on both ends, must be identical to have
3654 * a match
3655 */
3656 if (!strcmp(table->dev_id, dev_id))
3657 goto found;
3658 } else {
3659 /*
3660 * One of the pointers is NULL, so both must be to have
3661 * a match
3662 */
3663 if (dev_id == table->dev_id)
3664 goto found;
3665 }
3666 }
3667 table = NULL;
3668
3669 found:
3670 mutex_unlock(&gpio_lookup_lock);
3671 return table;
3672 }
3673
gpiod_find(struct device * dev,const char * con_id,unsigned int idx,unsigned long * flags)3674 static struct gpio_desc *gpiod_find(struct device *dev, const char *con_id,
3675 unsigned int idx, unsigned long *flags)
3676 {
3677 struct gpio_desc *desc = ERR_PTR(-ENOENT);
3678 struct gpiod_lookup_table *table;
3679 struct gpiod_lookup *p;
3680
3681 table = gpiod_find_lookup_table(dev);
3682 if (!table)
3683 return desc;
3684
3685 for (p = &table->table[0]; p->key; p++) {
3686 struct gpio_chip *gc;
3687
3688 /* idx must always match exactly */
3689 if (p->idx != idx)
3690 continue;
3691
3692 /* If the lookup entry has a con_id, require exact match */
3693 if (p->con_id && (!con_id || strcmp(p->con_id, con_id)))
3694 continue;
3695
3696 if (p->chip_hwnum == U16_MAX) {
3697 desc = gpio_name_to_desc(p->key);
3698 if (desc) {
3699 *flags = p->flags;
3700 return desc;
3701 }
3702
3703 dev_warn(dev, "cannot find GPIO line %s, deferring\n",
3704 p->key);
3705 return ERR_PTR(-EPROBE_DEFER);
3706 }
3707
3708 gc = find_chip_by_name(p->key);
3709
3710 if (!gc) {
3711 /*
3712 * As the lookup table indicates a chip with
3713 * p->key should exist, assume it may
3714 * still appear later and let the interested
3715 * consumer be probed again or let the Deferred
3716 * Probe infrastructure handle the error.
3717 */
3718 dev_warn(dev, "cannot find GPIO chip %s, deferring\n",
3719 p->key);
3720 return ERR_PTR(-EPROBE_DEFER);
3721 }
3722
3723 if (gc->ngpio <= p->chip_hwnum) {
3724 dev_err(dev,
3725 "requested GPIO %u (%u) is out of range [0..%u] for chip %s\n",
3726 idx, p->chip_hwnum, gc->ngpio - 1,
3727 gc->label);
3728 return ERR_PTR(-EINVAL);
3729 }
3730
3731 desc = gpiochip_get_desc(gc, p->chip_hwnum);
3732 *flags = p->flags;
3733
3734 return desc;
3735 }
3736
3737 return desc;
3738 }
3739
platform_gpio_count(struct device * dev,const char * con_id)3740 static int platform_gpio_count(struct device *dev, const char *con_id)
3741 {
3742 struct gpiod_lookup_table *table;
3743 struct gpiod_lookup *p;
3744 unsigned int count = 0;
3745
3746 table = gpiod_find_lookup_table(dev);
3747 if (!table)
3748 return -ENOENT;
3749
3750 for (p = &table->table[0]; p->key; p++) {
3751 if ((con_id && p->con_id && !strcmp(con_id, p->con_id)) ||
3752 (!con_id && !p->con_id))
3753 count++;
3754 }
3755 if (!count)
3756 return -ENOENT;
3757
3758 return count;
3759 }
3760
3761 /**
3762 * fwnode_gpiod_get_index - obtain a GPIO from firmware node
3763 * @fwnode: handle of the firmware node
3764 * @con_id: function within the GPIO consumer
3765 * @index: index of the GPIO to obtain for the consumer
3766 * @flags: GPIO initialization flags
3767 * @label: label to attach to the requested GPIO
3768 *
3769 * This function can be used for drivers that get their configuration
3770 * from opaque firmware.
3771 *
3772 * The function properly finds the corresponding GPIO using whatever is the
3773 * underlying firmware interface and then makes sure that the GPIO
3774 * descriptor is requested before it is returned to the caller.
3775 *
3776 * Returns:
3777 * On successful request the GPIO pin is configured in accordance with
3778 * provided @flags.
3779 *
3780 * In case of error an ERR_PTR() is returned.
3781 */
fwnode_gpiod_get_index(struct fwnode_handle * fwnode,const char * con_id,int index,enum gpiod_flags flags,const char * label)3782 struct gpio_desc *fwnode_gpiod_get_index(struct fwnode_handle *fwnode,
3783 const char *con_id, int index,
3784 enum gpiod_flags flags,
3785 const char *label)
3786 {
3787 struct gpio_desc *desc;
3788 char prop_name[32]; /* 32 is max size of property name */
3789 unsigned int i;
3790
3791 for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) {
3792 if (con_id)
3793 snprintf(prop_name, sizeof(prop_name), "%s-%s",
3794 con_id, gpio_suffixes[i]);
3795 else
3796 snprintf(prop_name, sizeof(prop_name), "%s",
3797 gpio_suffixes[i]);
3798
3799 desc = fwnode_get_named_gpiod(fwnode, prop_name, index, flags,
3800 label);
3801 if (!IS_ERR(desc) || (PTR_ERR(desc) != -ENOENT))
3802 break;
3803 }
3804
3805 return desc;
3806 }
3807 EXPORT_SYMBOL_GPL(fwnode_gpiod_get_index);
3808
3809 /**
3810 * gpiod_count - return the number of GPIOs associated with a device / function
3811 * or -ENOENT if no GPIO has been assigned to the requested function
3812 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3813 * @con_id: function within the GPIO consumer
3814 */
gpiod_count(struct device * dev,const char * con_id)3815 int gpiod_count(struct device *dev, const char *con_id)
3816 {
3817 int count = -ENOENT;
3818
3819 if (IS_ENABLED(CONFIG_OF) && dev && dev->of_node)
3820 count = of_gpio_get_count(dev, con_id);
3821 else if (IS_ENABLED(CONFIG_ACPI) && dev && ACPI_HANDLE(dev))
3822 count = acpi_gpio_count(dev, con_id);
3823
3824 if (count < 0)
3825 count = platform_gpio_count(dev, con_id);
3826
3827 return count;
3828 }
3829 EXPORT_SYMBOL_GPL(gpiod_count);
3830
3831 /**
3832 * gpiod_get - obtain a GPIO for a given GPIO function
3833 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3834 * @con_id: function within the GPIO consumer
3835 * @flags: optional GPIO initialization flags
3836 *
3837 * Return the GPIO descriptor corresponding to the function con_id of device
3838 * dev, -ENOENT if no GPIO has been assigned to the requested function, or
3839 * another IS_ERR() code if an error occurred while trying to acquire the GPIO.
3840 */
gpiod_get(struct device * dev,const char * con_id,enum gpiod_flags flags)3841 struct gpio_desc *__must_check gpiod_get(struct device *dev, const char *con_id,
3842 enum gpiod_flags flags)
3843 {
3844 return gpiod_get_index(dev, con_id, 0, flags);
3845 }
3846 EXPORT_SYMBOL_GPL(gpiod_get);
3847
3848 /**
3849 * gpiod_get_optional - obtain an optional GPIO for a given GPIO function
3850 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3851 * @con_id: function within the GPIO consumer
3852 * @flags: optional GPIO initialization flags
3853 *
3854 * This is equivalent to gpiod_get(), except that when no GPIO was assigned to
3855 * the requested function it will return NULL. This is convenient for drivers
3856 * that need to handle optional GPIOs.
3857 */
gpiod_get_optional(struct device * dev,const char * con_id,enum gpiod_flags flags)3858 struct gpio_desc *__must_check gpiod_get_optional(struct device *dev,
3859 const char *con_id,
3860 enum gpiod_flags flags)
3861 {
3862 return gpiod_get_index_optional(dev, con_id, 0, flags);
3863 }
3864 EXPORT_SYMBOL_GPL(gpiod_get_optional);
3865
3866
3867 /**
3868 * gpiod_configure_flags - helper function to configure a given GPIO
3869 * @desc: gpio whose value will be assigned
3870 * @con_id: function within the GPIO consumer
3871 * @lflags: bitmask of gpio_lookup_flags GPIO_* values - returned from
3872 * of_find_gpio() or of_get_gpio_hog()
3873 * @dflags: gpiod_flags - optional GPIO initialization flags
3874 *
3875 * Return 0 on success, -ENOENT if no GPIO has been assigned to the
3876 * requested function and/or index, or another IS_ERR() code if an error
3877 * occurred while trying to acquire the GPIO.
3878 */
gpiod_configure_flags(struct gpio_desc * desc,const char * con_id,unsigned long lflags,enum gpiod_flags dflags)3879 int gpiod_configure_flags(struct gpio_desc *desc, const char *con_id,
3880 unsigned long lflags, enum gpiod_flags dflags)
3881 {
3882 int ret;
3883
3884 if (lflags & GPIO_ACTIVE_LOW)
3885 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
3886
3887 if (lflags & GPIO_OPEN_DRAIN)
3888 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
3889 else if (dflags & GPIOD_FLAGS_BIT_OPEN_DRAIN) {
3890 /*
3891 * This enforces open drain mode from the consumer side.
3892 * This is necessary for some busses like I2C, but the lookup
3893 * should *REALLY* have specified them as open drain in the
3894 * first place, so print a little warning here.
3895 */
3896 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
3897 gpiod_warn(desc,
3898 "enforced open drain please flag it properly in DT/ACPI DSDT/board file\n");
3899 }
3900
3901 if (lflags & GPIO_OPEN_SOURCE)
3902 set_bit(FLAG_OPEN_SOURCE, &desc->flags);
3903
3904 if ((lflags & GPIO_PULL_UP) && (lflags & GPIO_PULL_DOWN)) {
3905 gpiod_err(desc,
3906 "both pull-up and pull-down enabled, invalid configuration\n");
3907 return -EINVAL;
3908 }
3909
3910 if (lflags & GPIO_PULL_UP)
3911 set_bit(FLAG_PULL_UP, &desc->flags);
3912 else if (lflags & GPIO_PULL_DOWN)
3913 set_bit(FLAG_PULL_DOWN, &desc->flags);
3914
3915 ret = gpiod_set_transitory(desc, (lflags & GPIO_TRANSITORY));
3916 if (ret < 0)
3917 return ret;
3918
3919 /* No particular flag request, return here... */
3920 if (!(dflags & GPIOD_FLAGS_BIT_DIR_SET)) {
3921 gpiod_dbg(desc, "no flags found for %s\n", con_id);
3922 return 0;
3923 }
3924
3925 /* Process flags */
3926 if (dflags & GPIOD_FLAGS_BIT_DIR_OUT)
3927 ret = gpiod_direction_output(desc,
3928 !!(dflags & GPIOD_FLAGS_BIT_DIR_VAL));
3929 else
3930 ret = gpiod_direction_input(desc);
3931
3932 return ret;
3933 }
3934
3935 /**
3936 * gpiod_get_index - obtain a GPIO from a multi-index GPIO function
3937 * @dev: GPIO consumer, can be NULL for system-global GPIOs
3938 * @con_id: function within the GPIO consumer
3939 * @idx: index of the GPIO to obtain in the consumer
3940 * @flags: optional GPIO initialization flags
3941 *
3942 * This variant of gpiod_get() allows to access GPIOs other than the first
3943 * defined one for functions that define several GPIOs.
3944 *
3945 * Return a valid GPIO descriptor, -ENOENT if no GPIO has been assigned to the
3946 * requested function and/or index, or another IS_ERR() code if an error
3947 * occurred while trying to acquire the GPIO.
3948 */
gpiod_get_index(struct device * dev,const char * con_id,unsigned int idx,enum gpiod_flags flags)3949 struct gpio_desc *__must_check gpiod_get_index(struct device *dev,
3950 const char *con_id,
3951 unsigned int idx,
3952 enum gpiod_flags flags)
3953 {
3954 unsigned long lookupflags = GPIO_LOOKUP_FLAGS_DEFAULT;
3955 struct gpio_desc *desc = NULL;
3956 int ret;
3957 /* Maybe we have a device name, maybe not */
3958 const char *devname = dev ? dev_name(dev) : "?";
3959
3960 dev_dbg(dev, "GPIO lookup for consumer %s\n", con_id);
3961
3962 if (dev) {
3963 /* Using device tree? */
3964 if (IS_ENABLED(CONFIG_OF) && dev->of_node) {
3965 dev_dbg(dev, "using device tree for GPIO lookup\n");
3966 desc = of_find_gpio(dev, con_id, idx, &lookupflags);
3967 } else if (ACPI_COMPANION(dev)) {
3968 dev_dbg(dev, "using ACPI for GPIO lookup\n");
3969 desc = acpi_find_gpio(dev, con_id, idx, &flags, &lookupflags);
3970 }
3971 }
3972
3973 /*
3974 * Either we are not using DT or ACPI, or their lookup did not return
3975 * a result. In that case, use platform lookup as a fallback.
3976 */
3977 if (!desc || desc == ERR_PTR(-ENOENT)) {
3978 dev_dbg(dev, "using lookup tables for GPIO lookup\n");
3979 desc = gpiod_find(dev, con_id, idx, &lookupflags);
3980 }
3981
3982 if (IS_ERR(desc)) {
3983 dev_dbg(dev, "No GPIO consumer %s found\n", con_id);
3984 return desc;
3985 }
3986
3987 /*
3988 * If a connection label was passed use that, else attempt to use
3989 * the device name as label
3990 */
3991 ret = gpiod_request(desc, con_id ? con_id : devname);
3992 if (ret < 0) {
3993 if (ret == -EBUSY && flags & GPIOD_FLAGS_BIT_NONEXCLUSIVE) {
3994 /*
3995 * This happens when there are several consumers for
3996 * the same GPIO line: we just return here without
3997 * further initialization. It is a bit if a hack.
3998 * This is necessary to support fixed regulators.
3999 *
4000 * FIXME: Make this more sane and safe.
4001 */
4002 dev_info(dev, "nonexclusive access to GPIO for %s\n",
4003 con_id ? con_id : devname);
4004 return desc;
4005 } else {
4006 return ERR_PTR(ret);
4007 }
4008 }
4009
4010 ret = gpiod_configure_flags(desc, con_id, lookupflags, flags);
4011 if (ret < 0) {
4012 dev_dbg(dev, "setup of GPIO %s failed\n", con_id);
4013 gpiod_put(desc);
4014 return ERR_PTR(ret);
4015 }
4016
4017 blocking_notifier_call_chain(&desc->gdev->notifier,
4018 GPIOLINE_CHANGED_REQUESTED, desc);
4019
4020 return desc;
4021 }
4022 EXPORT_SYMBOL_GPL(gpiod_get_index);
4023
4024 /**
4025 * fwnode_get_named_gpiod - obtain a GPIO from firmware node
4026 * @fwnode: handle of the firmware node
4027 * @propname: name of the firmware property representing the GPIO
4028 * @index: index of the GPIO to obtain for the consumer
4029 * @dflags: GPIO initialization flags
4030 * @label: label to attach to the requested GPIO
4031 *
4032 * This function can be used for drivers that get their configuration
4033 * from opaque firmware.
4034 *
4035 * The function properly finds the corresponding GPIO using whatever is the
4036 * underlying firmware interface and then makes sure that the GPIO
4037 * descriptor is requested before it is returned to the caller.
4038 *
4039 * Returns:
4040 * On successful request the GPIO pin is configured in accordance with
4041 * provided @dflags.
4042 *
4043 * In case of error an ERR_PTR() is returned.
4044 */
fwnode_get_named_gpiod(struct fwnode_handle * fwnode,const char * propname,int index,enum gpiod_flags dflags,const char * label)4045 struct gpio_desc *fwnode_get_named_gpiod(struct fwnode_handle *fwnode,
4046 const char *propname, int index,
4047 enum gpiod_flags dflags,
4048 const char *label)
4049 {
4050 unsigned long lflags = GPIO_LOOKUP_FLAGS_DEFAULT;
4051 struct gpio_desc *desc = ERR_PTR(-ENODEV);
4052 int ret;
4053
4054 if (!fwnode)
4055 return ERR_PTR(-EINVAL);
4056
4057 if (is_of_node(fwnode)) {
4058 desc = gpiod_get_from_of_node(to_of_node(fwnode),
4059 propname, index,
4060 dflags,
4061 label);
4062 return desc;
4063 } else if (is_acpi_node(fwnode)) {
4064 struct acpi_gpio_info info;
4065
4066 desc = acpi_node_get_gpiod(fwnode, propname, index, &info);
4067 if (IS_ERR(desc))
4068 return desc;
4069
4070 acpi_gpio_update_gpiod_flags(&dflags, &info);
4071 acpi_gpio_update_gpiod_lookup_flags(&lflags, &info);
4072 }
4073
4074 /* Currently only ACPI takes this path */
4075 ret = gpiod_request(desc, label);
4076 if (ret)
4077 return ERR_PTR(ret);
4078
4079 ret = gpiod_configure_flags(desc, propname, lflags, dflags);
4080 if (ret < 0) {
4081 gpiod_put(desc);
4082 return ERR_PTR(ret);
4083 }
4084
4085 blocking_notifier_call_chain(&desc->gdev->notifier,
4086 GPIOLINE_CHANGED_REQUESTED, desc);
4087
4088 return desc;
4089 }
4090 EXPORT_SYMBOL_GPL(fwnode_get_named_gpiod);
4091
4092 /**
4093 * gpiod_get_index_optional - obtain an optional GPIO from a multi-index GPIO
4094 * function
4095 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4096 * @con_id: function within the GPIO consumer
4097 * @index: index of the GPIO to obtain in the consumer
4098 * @flags: optional GPIO initialization flags
4099 *
4100 * This is equivalent to gpiod_get_index(), except that when no GPIO with the
4101 * specified index was assigned to the requested function it will return NULL.
4102 * This is convenient for drivers that need to handle optional GPIOs.
4103 */
gpiod_get_index_optional(struct device * dev,const char * con_id,unsigned int index,enum gpiod_flags flags)4104 struct gpio_desc *__must_check gpiod_get_index_optional(struct device *dev,
4105 const char *con_id,
4106 unsigned int index,
4107 enum gpiod_flags flags)
4108 {
4109 struct gpio_desc *desc;
4110
4111 desc = gpiod_get_index(dev, con_id, index, flags);
4112 if (IS_ERR(desc)) {
4113 if (PTR_ERR(desc) == -ENOENT)
4114 return NULL;
4115 }
4116
4117 return desc;
4118 }
4119 EXPORT_SYMBOL_GPL(gpiod_get_index_optional);
4120
4121 /**
4122 * gpiod_hog - Hog the specified GPIO desc given the provided flags
4123 * @desc: gpio whose value will be assigned
4124 * @name: gpio line name
4125 * @lflags: bitmask of gpio_lookup_flags GPIO_* values - returned from
4126 * of_find_gpio() or of_get_gpio_hog()
4127 * @dflags: gpiod_flags - optional GPIO initialization flags
4128 */
gpiod_hog(struct gpio_desc * desc,const char * name,unsigned long lflags,enum gpiod_flags dflags)4129 int gpiod_hog(struct gpio_desc *desc, const char *name,
4130 unsigned long lflags, enum gpiod_flags dflags)
4131 {
4132 struct gpio_chip *gc;
4133 struct gpio_desc *local_desc;
4134 int hwnum;
4135 int ret;
4136
4137 gc = gpiod_to_chip(desc);
4138 hwnum = gpio_chip_hwgpio(desc);
4139
4140 local_desc = gpiochip_request_own_desc(gc, hwnum, name,
4141 lflags, dflags);
4142 if (IS_ERR(local_desc)) {
4143 ret = PTR_ERR(local_desc);
4144 pr_err("requesting hog GPIO %s (chip %s, offset %d) failed, %d\n",
4145 name, gc->label, hwnum, ret);
4146 return ret;
4147 }
4148
4149 /* Mark GPIO as hogged so it can be identified and removed later */
4150 set_bit(FLAG_IS_HOGGED, &desc->flags);
4151
4152 gpiod_info(desc, "hogged as %s%s\n",
4153 (dflags & GPIOD_FLAGS_BIT_DIR_OUT) ? "output" : "input",
4154 (dflags & GPIOD_FLAGS_BIT_DIR_OUT) ?
4155 (dflags & GPIOD_FLAGS_BIT_DIR_VAL) ? "/high" : "/low" : "");
4156
4157 return 0;
4158 }
4159
4160 /**
4161 * gpiochip_free_hogs - Scan gpio-controller chip and release GPIO hog
4162 * @gc: gpio chip to act on
4163 */
gpiochip_free_hogs(struct gpio_chip * gc)4164 static void gpiochip_free_hogs(struct gpio_chip *gc)
4165 {
4166 int id;
4167
4168 for (id = 0; id < gc->ngpio; id++) {
4169 if (test_bit(FLAG_IS_HOGGED, &gc->gpiodev->descs[id].flags))
4170 gpiochip_free_own_desc(&gc->gpiodev->descs[id]);
4171 }
4172 }
4173
4174 /**
4175 * gpiod_get_array - obtain multiple GPIOs from a multi-index GPIO function
4176 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4177 * @con_id: function within the GPIO consumer
4178 * @flags: optional GPIO initialization flags
4179 *
4180 * This function acquires all the GPIOs defined under a given function.
4181 *
4182 * Return a struct gpio_descs containing an array of descriptors, -ENOENT if
4183 * no GPIO has been assigned to the requested function, or another IS_ERR()
4184 * code if an error occurred while trying to acquire the GPIOs.
4185 */
gpiod_get_array(struct device * dev,const char * con_id,enum gpiod_flags flags)4186 struct gpio_descs *__must_check gpiod_get_array(struct device *dev,
4187 const char *con_id,
4188 enum gpiod_flags flags)
4189 {
4190 struct gpio_desc *desc;
4191 struct gpio_descs *descs;
4192 struct gpio_array *array_info = NULL;
4193 struct gpio_chip *gc;
4194 int count, bitmap_size;
4195
4196 count = gpiod_count(dev, con_id);
4197 if (count < 0)
4198 return ERR_PTR(count);
4199
4200 descs = kzalloc(struct_size(descs, desc, count), GFP_KERNEL);
4201 if (!descs)
4202 return ERR_PTR(-ENOMEM);
4203
4204 for (descs->ndescs = 0; descs->ndescs < count; ) {
4205 desc = gpiod_get_index(dev, con_id, descs->ndescs, flags);
4206 if (IS_ERR(desc)) {
4207 gpiod_put_array(descs);
4208 return ERR_CAST(desc);
4209 }
4210
4211 descs->desc[descs->ndescs] = desc;
4212
4213 gc = gpiod_to_chip(desc);
4214 /*
4215 * If pin hardware number of array member 0 is also 0, select
4216 * its chip as a candidate for fast bitmap processing path.
4217 */
4218 if (descs->ndescs == 0 && gpio_chip_hwgpio(desc) == 0) {
4219 struct gpio_descs *array;
4220
4221 bitmap_size = BITS_TO_LONGS(gc->ngpio > count ?
4222 gc->ngpio : count);
4223
4224 array = kzalloc(struct_size(descs, desc, count) +
4225 struct_size(array_info, invert_mask,
4226 3 * bitmap_size), GFP_KERNEL);
4227 if (!array) {
4228 gpiod_put_array(descs);
4229 return ERR_PTR(-ENOMEM);
4230 }
4231
4232 memcpy(array, descs,
4233 struct_size(descs, desc, descs->ndescs + 1));
4234 kfree(descs);
4235
4236 descs = array;
4237 array_info = (void *)(descs->desc + count);
4238 array_info->get_mask = array_info->invert_mask +
4239 bitmap_size;
4240 array_info->set_mask = array_info->get_mask +
4241 bitmap_size;
4242
4243 array_info->desc = descs->desc;
4244 array_info->size = count;
4245 array_info->chip = gc;
4246 bitmap_set(array_info->get_mask, descs->ndescs,
4247 count - descs->ndescs);
4248 bitmap_set(array_info->set_mask, descs->ndescs,
4249 count - descs->ndescs);
4250 descs->info = array_info;
4251 }
4252 /* Unmark array members which don't belong to the 'fast' chip */
4253 if (array_info && array_info->chip != gc) {
4254 __clear_bit(descs->ndescs, array_info->get_mask);
4255 __clear_bit(descs->ndescs, array_info->set_mask);
4256 }
4257 /*
4258 * Detect array members which belong to the 'fast' chip
4259 * but their pins are not in hardware order.
4260 */
4261 else if (array_info &&
4262 gpio_chip_hwgpio(desc) != descs->ndescs) {
4263 /*
4264 * Don't use fast path if all array members processed so
4265 * far belong to the same chip as this one but its pin
4266 * hardware number is different from its array index.
4267 */
4268 if (bitmap_full(array_info->get_mask, descs->ndescs)) {
4269 array_info = NULL;
4270 } else {
4271 __clear_bit(descs->ndescs,
4272 array_info->get_mask);
4273 __clear_bit(descs->ndescs,
4274 array_info->set_mask);
4275 }
4276 } else if (array_info) {
4277 /* Exclude open drain or open source from fast output */
4278 if (gpiochip_line_is_open_drain(gc, descs->ndescs) ||
4279 gpiochip_line_is_open_source(gc, descs->ndescs))
4280 __clear_bit(descs->ndescs,
4281 array_info->set_mask);
4282 /* Identify 'fast' pins which require invertion */
4283 if (gpiod_is_active_low(desc))
4284 __set_bit(descs->ndescs,
4285 array_info->invert_mask);
4286 }
4287
4288 descs->ndescs++;
4289 }
4290 if (array_info)
4291 dev_dbg(dev,
4292 "GPIO array info: chip=%s, size=%d, get_mask=%lx, set_mask=%lx, invert_mask=%lx\n",
4293 array_info->chip->label, array_info->size,
4294 *array_info->get_mask, *array_info->set_mask,
4295 *array_info->invert_mask);
4296 return descs;
4297 }
4298 EXPORT_SYMBOL_GPL(gpiod_get_array);
4299
4300 /**
4301 * gpiod_get_array_optional - obtain multiple GPIOs from a multi-index GPIO
4302 * function
4303 * @dev: GPIO consumer, can be NULL for system-global GPIOs
4304 * @con_id: function within the GPIO consumer
4305 * @flags: optional GPIO initialization flags
4306 *
4307 * This is equivalent to gpiod_get_array(), except that when no GPIO was
4308 * assigned to the requested function it will return NULL.
4309 */
gpiod_get_array_optional(struct device * dev,const char * con_id,enum gpiod_flags flags)4310 struct gpio_descs *__must_check gpiod_get_array_optional(struct device *dev,
4311 const char *con_id,
4312 enum gpiod_flags flags)
4313 {
4314 struct gpio_descs *descs;
4315
4316 descs = gpiod_get_array(dev, con_id, flags);
4317 if (PTR_ERR(descs) == -ENOENT)
4318 return NULL;
4319
4320 return descs;
4321 }
4322 EXPORT_SYMBOL_GPL(gpiod_get_array_optional);
4323
4324 /**
4325 * gpiod_put - dispose of a GPIO descriptor
4326 * @desc: GPIO descriptor to dispose of
4327 *
4328 * No descriptor can be used after gpiod_put() has been called on it.
4329 */
gpiod_put(struct gpio_desc * desc)4330 void gpiod_put(struct gpio_desc *desc)
4331 {
4332 if (desc)
4333 gpiod_free(desc);
4334 }
4335 EXPORT_SYMBOL_GPL(gpiod_put);
4336
4337 /**
4338 * gpiod_put_array - dispose of multiple GPIO descriptors
4339 * @descs: struct gpio_descs containing an array of descriptors
4340 */
gpiod_put_array(struct gpio_descs * descs)4341 void gpiod_put_array(struct gpio_descs *descs)
4342 {
4343 unsigned int i;
4344
4345 for (i = 0; i < descs->ndescs; i++)
4346 gpiod_put(descs->desc[i]);
4347
4348 kfree(descs);
4349 }
4350 EXPORT_SYMBOL_GPL(gpiod_put_array);
4351
gpiolib_dev_init(void)4352 static int __init gpiolib_dev_init(void)
4353 {
4354 int ret;
4355
4356 /* Register GPIO sysfs bus */
4357 ret = bus_register(&gpio_bus_type);
4358 if (ret < 0) {
4359 pr_err("gpiolib: could not register GPIO bus type\n");
4360 return ret;
4361 }
4362
4363 ret = alloc_chrdev_region(&gpio_devt, 0, GPIO_DEV_MAX, GPIOCHIP_NAME);
4364 if (ret < 0) {
4365 pr_err("gpiolib: failed to allocate char dev region\n");
4366 bus_unregister(&gpio_bus_type);
4367 return ret;
4368 }
4369
4370 gpiolib_initialized = true;
4371 gpiochip_setup_devs();
4372
4373 #if IS_ENABLED(CONFIG_OF_DYNAMIC) && IS_ENABLED(CONFIG_OF_GPIO)
4374 WARN_ON(of_reconfig_notifier_register(&gpio_of_notifier));
4375 #endif /* CONFIG_OF_DYNAMIC && CONFIG_OF_GPIO */
4376
4377 return ret;
4378 }
4379 core_initcall(gpiolib_dev_init);
4380
4381 #ifdef CONFIG_DEBUG_FS
4382
gpiolib_dbg_show(struct seq_file * s,struct gpio_device * gdev)4383 static void gpiolib_dbg_show(struct seq_file *s, struct gpio_device *gdev)
4384 {
4385 unsigned i;
4386 struct gpio_chip *gc = gdev->chip;
4387 unsigned gpio = gdev->base;
4388 struct gpio_desc *gdesc = &gdev->descs[0];
4389 bool is_out;
4390 bool is_irq;
4391 bool active_low;
4392
4393 for (i = 0; i < gdev->ngpio; i++, gpio++, gdesc++) {
4394 if (!test_bit(FLAG_REQUESTED, &gdesc->flags)) {
4395 if (gdesc->name) {
4396 seq_printf(s, " gpio-%-3d (%-20.20s)\n",
4397 gpio, gdesc->name);
4398 }
4399 continue;
4400 }
4401
4402 gpiod_get_direction(gdesc);
4403 is_out = test_bit(FLAG_IS_OUT, &gdesc->flags);
4404 is_irq = test_bit(FLAG_USED_AS_IRQ, &gdesc->flags);
4405 active_low = test_bit(FLAG_ACTIVE_LOW, &gdesc->flags);
4406 seq_printf(s, " gpio-%-3d (%-20.20s|%-20.20s) %s %s %s%s",
4407 gpio, gdesc->name ? gdesc->name : "", gdesc->label,
4408 is_out ? "out" : "in ",
4409 gc->get ? (gc->get(gc, i) ? "hi" : "lo") : "? ",
4410 is_irq ? "IRQ " : "",
4411 active_low ? "ACTIVE LOW" : "");
4412 seq_printf(s, "\n");
4413 }
4414 }
4415
gpiolib_seq_start(struct seq_file * s,loff_t * pos)4416 static void *gpiolib_seq_start(struct seq_file *s, loff_t *pos)
4417 {
4418 unsigned long flags;
4419 struct gpio_device *gdev = NULL;
4420 loff_t index = *pos;
4421
4422 s->private = "";
4423
4424 spin_lock_irqsave(&gpio_lock, flags);
4425 list_for_each_entry(gdev, &gpio_devices, list)
4426 if (index-- == 0) {
4427 spin_unlock_irqrestore(&gpio_lock, flags);
4428 return gdev;
4429 }
4430 spin_unlock_irqrestore(&gpio_lock, flags);
4431
4432 return NULL;
4433 }
4434
gpiolib_seq_next(struct seq_file * s,void * v,loff_t * pos)4435 static void *gpiolib_seq_next(struct seq_file *s, void *v, loff_t *pos)
4436 {
4437 unsigned long flags;
4438 struct gpio_device *gdev = v;
4439 void *ret = NULL;
4440
4441 spin_lock_irqsave(&gpio_lock, flags);
4442 if (list_is_last(&gdev->list, &gpio_devices))
4443 ret = NULL;
4444 else
4445 ret = list_entry(gdev->list.next, struct gpio_device, list);
4446 spin_unlock_irqrestore(&gpio_lock, flags);
4447
4448 s->private = "\n";
4449 ++*pos;
4450
4451 return ret;
4452 }
4453
gpiolib_seq_stop(struct seq_file * s,void * v)4454 static void gpiolib_seq_stop(struct seq_file *s, void *v)
4455 {
4456 }
4457
gpiolib_seq_show(struct seq_file * s,void * v)4458 static int gpiolib_seq_show(struct seq_file *s, void *v)
4459 {
4460 struct gpio_device *gdev = v;
4461 struct gpio_chip *gc = gdev->chip;
4462 struct device *parent;
4463
4464 if (!gc) {
4465 seq_printf(s, "%s%s: (dangling chip)", (char *)s->private,
4466 dev_name(&gdev->dev));
4467 return 0;
4468 }
4469
4470 seq_printf(s, "%s%s: GPIOs %d-%d", (char *)s->private,
4471 dev_name(&gdev->dev),
4472 gdev->base, gdev->base + gdev->ngpio - 1);
4473 parent = gc->parent;
4474 if (parent)
4475 seq_printf(s, ", parent: %s/%s",
4476 parent->bus ? parent->bus->name : "no-bus",
4477 dev_name(parent));
4478 if (gc->label)
4479 seq_printf(s, ", %s", gc->label);
4480 if (gc->can_sleep)
4481 seq_printf(s, ", can sleep");
4482 seq_printf(s, ":\n");
4483
4484 if (gc->dbg_show)
4485 gc->dbg_show(s, gc);
4486 else
4487 gpiolib_dbg_show(s, gdev);
4488
4489 return 0;
4490 }
4491
4492 static const struct seq_operations gpiolib_sops = {
4493 .start = gpiolib_seq_start,
4494 .next = gpiolib_seq_next,
4495 .stop = gpiolib_seq_stop,
4496 .show = gpiolib_seq_show,
4497 };
4498 DEFINE_SEQ_ATTRIBUTE(gpiolib);
4499
gpiolib_debugfs_init(void)4500 static int __init gpiolib_debugfs_init(void)
4501 {
4502 /* /sys/kernel/debug/gpio */
4503 debugfs_create_file("gpio", 0444, NULL, NULL, &gpiolib_fops);
4504 return 0;
4505 }
4506 subsys_initcall(gpiolib_debugfs_init);
4507
4508 #endif /* DEBUG_FS */
4509