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