Merge tag 'v3.10.68' into linux-linaro-lsk
[firefly-linux-kernel-4.4.55.git] / drivers / gpio / gpiolib.c
1 #include <linux/kernel.h>
2 #include <linux/module.h>
3 #include <linux/interrupt.h>
4 #include <linux/irq.h>
5 #include <linux/spinlock.h>
6 #include <linux/list.h>
7 #include <linux/device.h>
8 #include <linux/err.h>
9 #include <linux/debugfs.h>
10 #include <linux/seq_file.h>
11 #include <linux/gpio.h>
12 #include <linux/of_gpio.h>
13 #include <linux/idr.h>
14 #include <linux/slab.h>
15
16 #define CREATE_TRACE_POINTS
17 #include <trace/events/gpio.h>
18
19 /* Optional implementation infrastructure for GPIO interfaces.
20  *
21  * Platforms may want to use this if they tend to use very many GPIOs
22  * that aren't part of a System-On-Chip core; or across I2C/SPI/etc.
23  *
24  * When kernel footprint or instruction count is an issue, simpler
25  * implementations may be preferred.  The GPIO programming interface
26  * allows for inlining speed-critical get/set operations for common
27  * cases, so that access to SOC-integrated GPIOs can sometimes cost
28  * only an instruction or two per bit.
29  */
30
31
32 /* When debugging, extend minimal trust to callers and platform code.
33  * Also emit diagnostic messages that may help initial bringup, when
34  * board setup or driver bugs are most common.
35  *
36  * Otherwise, minimize overhead in what may be bitbanging codepaths.
37  */
38 #ifdef  DEBUG
39 #define extra_checks    1
40 #else
41 #define extra_checks    0
42 #endif
43
44 /* gpio_lock prevents conflicts during gpio_desc[] table updates.
45  * While any GPIO is requested, its gpio_chip is not removable;
46  * each GPIO's "requested" flag serves as a lock and refcount.
47  */
48 static DEFINE_SPINLOCK(gpio_lock);
49
50 struct gpio_desc {
51         struct gpio_chip        *chip;
52         unsigned long           flags;
53 /* flag symbols are bit numbers */
54 #define FLAG_REQUESTED  0
55 #define FLAG_IS_OUT     1
56 #define FLAG_EXPORT     2       /* protected by sysfs_lock */
57 #define FLAG_SYSFS      3       /* exported via /sys/class/gpio/control */
58 #define FLAG_TRIG_FALL  4       /* trigger on falling edge */
59 #define FLAG_TRIG_RISE  5       /* trigger on rising edge */
60 #define FLAG_ACTIVE_LOW 6       /* sysfs value has active low */
61 #define FLAG_OPEN_DRAIN 7       /* Gpio is open drain type */
62 #define FLAG_OPEN_SOURCE 8      /* Gpio is open source type */
63
64 #define ID_SHIFT        16      /* add new flags before this one */
65
66 #define GPIO_FLAGS_MASK         ((1 << ID_SHIFT) - 1)
67 #define GPIO_TRIGGER_MASK       (BIT(FLAG_TRIG_FALL) | BIT(FLAG_TRIG_RISE))
68
69 #ifdef CONFIG_DEBUG_FS
70         const char              *label;
71 #endif
72 };
73 static struct gpio_desc gpio_desc[ARCH_NR_GPIOS];
74
75 #define GPIO_OFFSET_VALID(chip, offset) (offset >= 0 && offset < chip->ngpio)
76
77 static LIST_HEAD(gpio_chips);
78
79 #ifdef CONFIG_GPIO_SYSFS
80 static DEFINE_IDR(dirent_idr);
81 #endif
82
83 /*
84  * Internal gpiod_* API using descriptors instead of the integer namespace.
85  * Most of this should eventually go public.
86  */
87 static int gpiod_request(struct gpio_desc *desc, const char *label);
88 static void gpiod_free(struct gpio_desc *desc);
89 static int gpiod_direction_input(struct gpio_desc *desc);
90 static int gpiod_direction_output(struct gpio_desc *desc, int value);
91 static int gpiod_get_direction(const struct gpio_desc *desc);
92 static int gpiod_set_debounce(struct gpio_desc *desc, unsigned debounce);
93 static int gpiod_get_value_cansleep(const struct gpio_desc *desc);
94 static void gpiod_set_value_cansleep(struct gpio_desc *desc, int value);
95 static int gpiod_get_value(const struct gpio_desc *desc);
96 static void gpiod_set_value(struct gpio_desc *desc, int value);
97 static int gpiod_cansleep(const struct gpio_desc *desc);
98 static int gpiod_to_irq(const struct gpio_desc *desc);
99 static int gpiod_export(struct gpio_desc *desc, bool direction_may_change);
100 static int gpiod_export_link(struct device *dev, const char *name,
101                              struct gpio_desc *desc);
102 static int gpiod_sysfs_set_active_low(struct gpio_desc *desc, int value);
103 static void gpiod_unexport(struct gpio_desc *desc);
104
105
106 static inline void desc_set_label(struct gpio_desc *d, const char *label)
107 {
108 #ifdef CONFIG_DEBUG_FS
109         d->label = label;
110 #endif
111 }
112
113 /*
114  * Return the GPIO number of the passed descriptor relative to its chip
115  */
116 static int gpio_chip_hwgpio(const struct gpio_desc *desc)
117 {
118         return desc - &desc->chip->desc[0];
119 }
120
121 /**
122  * Convert a GPIO number to its descriptor
123  */
124 static struct gpio_desc *gpio_to_desc(unsigned gpio)
125 {
126         if (WARN(!gpio_is_valid(gpio), "invalid GPIO %d\n", gpio))
127                 return NULL;
128         else
129                 return &gpio_desc[gpio];
130 }
131
132 /**
133  * Convert a GPIO descriptor to the integer namespace.
134  * This should disappear in the future but is needed since we still
135  * use GPIO numbers for error messages and sysfs nodes
136  */
137 static int desc_to_gpio(const struct gpio_desc *desc)
138 {
139         return desc->chip->base + gpio_chip_hwgpio(desc);
140 }
141
142
143 /* Warn when drivers omit gpio_request() calls -- legal but ill-advised
144  * when setting direction, and otherwise illegal.  Until board setup code
145  * and drivers use explicit requests everywhere (which won't happen when
146  * those calls have no teeth) we can't avoid autorequesting.  This nag
147  * message should motivate switching to explicit requests... so should
148  * the weaker cleanup after faults, compared to gpio_request().
149  *
150  * NOTE: the autorequest mechanism is going away; at this point it's
151  * only "legal" in the sense that (old) code using it won't break yet,
152  * but instead only triggers a WARN() stack dump.
153  */
154 static int gpio_ensure_requested(struct gpio_desc *desc)
155 {
156         const struct gpio_chip *chip = desc->chip;
157         const int gpio = desc_to_gpio(desc);
158
159         if (WARN(test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0,
160                         "autorequest GPIO-%d\n", gpio)) {
161                 if (!try_module_get(chip->owner)) {
162                         pr_err("GPIO-%d: module can't be gotten \n", gpio);
163                         clear_bit(FLAG_REQUESTED, &desc->flags);
164                         /* lose */
165                         return -EIO;
166                 }
167                 desc_set_label(desc, "[auto]");
168                 /* caller must chip->request() w/o spinlock */
169                 if (chip->request)
170                         return 1;
171         }
172         return 0;
173 }
174
175 static struct gpio_chip *gpiod_to_chip(const struct gpio_desc *desc)
176 {
177         return desc ? desc->chip : NULL;
178 }
179
180 /* caller holds gpio_lock *OR* gpio is marked as requested */
181 struct gpio_chip *gpio_to_chip(unsigned gpio)
182 {
183         return gpiod_to_chip(gpio_to_desc(gpio));
184 }
185
186 /* dynamic allocation of GPIOs, e.g. on a hotplugged device */
187 static int gpiochip_find_base(int ngpio)
188 {
189         struct gpio_chip *chip;
190         int base = ARCH_NR_GPIOS - ngpio;
191
192         list_for_each_entry_reverse(chip, &gpio_chips, list) {
193                 /* found a free space? */
194                 if (chip->base + chip->ngpio <= base)
195                         break;
196                 else
197                         /* nope, check the space right before the chip */
198                         base = chip->base - ngpio;
199         }
200
201         if (gpio_is_valid(base)) {
202                 pr_debug("%s: found new base at %d\n", __func__, base);
203                 return base;
204         } else {
205                 pr_err("%s: cannot find free range\n", __func__);
206                 return -ENOSPC;
207         }
208 }
209
210 /* caller ensures gpio is valid and requested, chip->get_direction may sleep  */
211 static int gpiod_get_direction(const struct gpio_desc *desc)
212 {
213         struct gpio_chip        *chip;
214         unsigned                offset;
215         int                     status = -EINVAL;
216
217         chip = gpiod_to_chip(desc);
218         offset = gpio_chip_hwgpio(desc);
219
220         if (!chip->get_direction)
221                 return status;
222
223         status = chip->get_direction(chip, offset);
224         if (status > 0) {
225                 /* GPIOF_DIR_IN, or other positive */
226                 status = 1;
227                 /* FLAG_IS_OUT is just a cache of the result of get_direction(),
228                  * so it does not affect constness per se */
229                 clear_bit(FLAG_IS_OUT, &((struct gpio_desc *)desc)->flags);
230         }
231         if (status == 0) {
232                 /* GPIOF_DIR_OUT */
233                 set_bit(FLAG_IS_OUT, &((struct gpio_desc *)desc)->flags);
234         }
235         return status;
236 }
237
238 #ifdef CONFIG_GPIO_SYSFS
239
240 /* lock protects against unexport_gpio() being called while
241  * sysfs files are active.
242  */
243 static DEFINE_MUTEX(sysfs_lock);
244
245 /*
246  * /sys/class/gpio/gpioN... only for GPIOs that are exported
247  *   /direction
248  *      * MAY BE OMITTED if kernel won't allow direction changes
249  *      * is read/write as "in" or "out"
250  *      * may also be written as "high" or "low", initializing
251  *        output value as specified ("out" implies "low")
252  *   /value
253  *      * always readable, subject to hardware behavior
254  *      * may be writable, as zero/nonzero
255  *   /edge
256  *      * configures behavior of poll(2) on /value
257  *      * available only if pin can generate IRQs on input
258  *      * is read/write as "none", "falling", "rising", or "both"
259  *   /active_low
260  *      * configures polarity of /value
261  *      * is read/write as zero/nonzero
262  *      * also affects existing and subsequent "falling" and "rising"
263  *        /edge configuration
264  */
265
266 static ssize_t gpio_direction_show(struct device *dev,
267                 struct device_attribute *attr, char *buf)
268 {
269         const struct gpio_desc  *desc = dev_get_drvdata(dev);
270         ssize_t                 status;
271
272         mutex_lock(&sysfs_lock);
273
274         if (!test_bit(FLAG_EXPORT, &desc->flags)) {
275                 status = -EIO;
276         } else {
277                 gpiod_get_direction(desc);
278                 status = sprintf(buf, "%s\n",
279                         test_bit(FLAG_IS_OUT, &desc->flags)
280                                 ? "out" : "in");
281         }
282
283         mutex_unlock(&sysfs_lock);
284         return status;
285 }
286
287 static ssize_t gpio_direction_store(struct device *dev,
288                 struct device_attribute *attr, const char *buf, size_t size)
289 {
290         struct gpio_desc        *desc = dev_get_drvdata(dev);
291         ssize_t                 status;
292
293         mutex_lock(&sysfs_lock);
294
295         if (!test_bit(FLAG_EXPORT, &desc->flags))
296                 status = -EIO;
297         else if (sysfs_streq(buf, "high"))
298                 status = gpiod_direction_output(desc, 1);
299         else if (sysfs_streq(buf, "out") || sysfs_streq(buf, "low"))
300                 status = gpiod_direction_output(desc, 0);
301         else if (sysfs_streq(buf, "in"))
302                 status = gpiod_direction_input(desc);
303         else
304                 status = -EINVAL;
305
306         mutex_unlock(&sysfs_lock);
307         return status ? : size;
308 }
309
310 static /* const */ DEVICE_ATTR(direction, 0644,
311                 gpio_direction_show, gpio_direction_store);
312
313 static ssize_t gpio_value_show(struct device *dev,
314                 struct device_attribute *attr, char *buf)
315 {
316         struct gpio_desc        *desc = dev_get_drvdata(dev);
317         ssize_t                 status;
318
319         mutex_lock(&sysfs_lock);
320
321         if (!test_bit(FLAG_EXPORT, &desc->flags)) {
322                 status = -EIO;
323         } else {
324                 int value;
325
326                 value = !!gpiod_get_value_cansleep(desc);
327                 if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
328                         value = !value;
329
330                 status = sprintf(buf, "%d\n", value);
331         }
332
333         mutex_unlock(&sysfs_lock);
334         return status;
335 }
336
337 static ssize_t gpio_value_store(struct device *dev,
338                 struct device_attribute *attr, const char *buf, size_t size)
339 {
340         struct gpio_desc        *desc = dev_get_drvdata(dev);
341         ssize_t                 status;
342
343         mutex_lock(&sysfs_lock);
344
345         if (!test_bit(FLAG_EXPORT, &desc->flags))
346                 status = -EIO;
347         else if (!test_bit(FLAG_IS_OUT, &desc->flags))
348                 status = -EPERM;
349         else {
350                 long            value;
351
352                 status = strict_strtol(buf, 0, &value);
353                 if (status == 0) {
354                         if (test_bit(FLAG_ACTIVE_LOW, &desc->flags))
355                                 value = !value;
356                         gpiod_set_value_cansleep(desc, value != 0);
357                         status = size;
358                 }
359         }
360
361         mutex_unlock(&sysfs_lock);
362         return status;
363 }
364
365 static DEVICE_ATTR(value, 0644,
366                 gpio_value_show, gpio_value_store);
367
368 static irqreturn_t gpio_sysfs_irq(int irq, void *priv)
369 {
370         struct sysfs_dirent     *value_sd = priv;
371
372         sysfs_notify_dirent(value_sd);
373         return IRQ_HANDLED;
374 }
375
376 static int gpio_setup_irq(struct gpio_desc *desc, struct device *dev,
377                 unsigned long gpio_flags)
378 {
379         struct sysfs_dirent     *value_sd;
380         unsigned long           irq_flags;
381         int                     ret, irq, id;
382
383         if ((desc->flags & GPIO_TRIGGER_MASK) == gpio_flags)
384                 return 0;
385
386         irq = gpiod_to_irq(desc);
387         if (irq < 0)
388                 return -EIO;
389
390         id = desc->flags >> ID_SHIFT;
391         value_sd = idr_find(&dirent_idr, id);
392         if (value_sd)
393                 free_irq(irq, value_sd);
394
395         desc->flags &= ~GPIO_TRIGGER_MASK;
396
397         if (!gpio_flags) {
398                 ret = 0;
399                 goto free_id;
400         }
401
402         irq_flags = IRQF_SHARED;
403         if (test_bit(FLAG_TRIG_FALL, &gpio_flags))
404                 irq_flags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ?
405                         IRQF_TRIGGER_RISING : IRQF_TRIGGER_FALLING;
406         if (test_bit(FLAG_TRIG_RISE, &gpio_flags))
407                 irq_flags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ?
408                         IRQF_TRIGGER_FALLING : IRQF_TRIGGER_RISING;
409
410         if (!value_sd) {
411                 value_sd = sysfs_get_dirent(dev->kobj.sd, NULL, "value");
412                 if (!value_sd) {
413                         ret = -ENODEV;
414                         goto err_out;
415                 }
416
417                 ret = idr_alloc(&dirent_idr, value_sd, 1, 0, GFP_KERNEL);
418                 if (ret < 0)
419                         goto free_sd;
420                 id = ret;
421
422                 desc->flags &= GPIO_FLAGS_MASK;
423                 desc->flags |= (unsigned long)id << ID_SHIFT;
424
425                 if (desc->flags >> ID_SHIFT != id) {
426                         ret = -ERANGE;
427                         goto free_id;
428                 }
429         }
430
431         ret = request_any_context_irq(irq, gpio_sysfs_irq, irq_flags,
432                                 "gpiolib", value_sd);
433         if (ret < 0)
434                 goto free_id;
435
436         desc->flags |= gpio_flags;
437         return 0;
438
439 free_id:
440         idr_remove(&dirent_idr, id);
441         desc->flags &= GPIO_FLAGS_MASK;
442 free_sd:
443         if (value_sd)
444                 sysfs_put(value_sd);
445 err_out:
446         return ret;
447 }
448
449 static const struct {
450         const char *name;
451         unsigned long flags;
452 } trigger_types[] = {
453         { "none",    0 },
454         { "falling", BIT(FLAG_TRIG_FALL) },
455         { "rising",  BIT(FLAG_TRIG_RISE) },
456         { "both",    BIT(FLAG_TRIG_FALL) | BIT(FLAG_TRIG_RISE) },
457 };
458
459 static ssize_t gpio_edge_show(struct device *dev,
460                 struct device_attribute *attr, char *buf)
461 {
462         const struct gpio_desc  *desc = dev_get_drvdata(dev);
463         ssize_t                 status;
464
465         mutex_lock(&sysfs_lock);
466
467         if (!test_bit(FLAG_EXPORT, &desc->flags))
468                 status = -EIO;
469         else {
470                 int i;
471
472                 status = 0;
473                 for (i = 0; i < ARRAY_SIZE(trigger_types); i++)
474                         if ((desc->flags & GPIO_TRIGGER_MASK)
475                                         == trigger_types[i].flags) {
476                                 status = sprintf(buf, "%s\n",
477                                                  trigger_types[i].name);
478                                 break;
479                         }
480         }
481
482         mutex_unlock(&sysfs_lock);
483         return status;
484 }
485
486 static ssize_t gpio_edge_store(struct device *dev,
487                 struct device_attribute *attr, const char *buf, size_t size)
488 {
489         struct gpio_desc        *desc = dev_get_drvdata(dev);
490         ssize_t                 status;
491         int                     i;
492
493         for (i = 0; i < ARRAY_SIZE(trigger_types); i++)
494                 if (sysfs_streq(trigger_types[i].name, buf))
495                         goto found;
496         return -EINVAL;
497
498 found:
499         mutex_lock(&sysfs_lock);
500
501         if (!test_bit(FLAG_EXPORT, &desc->flags))
502                 status = -EIO;
503         else {
504                 status = gpio_setup_irq(desc, dev, trigger_types[i].flags);
505                 if (!status)
506                         status = size;
507         }
508
509         mutex_unlock(&sysfs_lock);
510
511         return status;
512 }
513
514 static DEVICE_ATTR(edge, 0644, gpio_edge_show, gpio_edge_store);
515
516 static int sysfs_set_active_low(struct gpio_desc *desc, struct device *dev,
517                                 int value)
518 {
519         int                     status = 0;
520
521         if (!!test_bit(FLAG_ACTIVE_LOW, &desc->flags) == !!value)
522                 return 0;
523
524         if (value)
525                 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
526         else
527                 clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
528
529         /* reconfigure poll(2) support if enabled on one edge only */
530         if (dev != NULL && (!!test_bit(FLAG_TRIG_RISE, &desc->flags) ^
531                                 !!test_bit(FLAG_TRIG_FALL, &desc->flags))) {
532                 unsigned long trigger_flags = desc->flags & GPIO_TRIGGER_MASK;
533
534                 gpio_setup_irq(desc, dev, 0);
535                 status = gpio_setup_irq(desc, dev, trigger_flags);
536         }
537
538         return status;
539 }
540
541 static ssize_t gpio_active_low_show(struct device *dev,
542                 struct device_attribute *attr, char *buf)
543 {
544         const struct gpio_desc  *desc = dev_get_drvdata(dev);
545         ssize_t                 status;
546
547         mutex_lock(&sysfs_lock);
548
549         if (!test_bit(FLAG_EXPORT, &desc->flags))
550                 status = -EIO;
551         else
552                 status = sprintf(buf, "%d\n",
553                                 !!test_bit(FLAG_ACTIVE_LOW, &desc->flags));
554
555         mutex_unlock(&sysfs_lock);
556
557         return status;
558 }
559
560 static ssize_t gpio_active_low_store(struct device *dev,
561                 struct device_attribute *attr, const char *buf, size_t size)
562 {
563         struct gpio_desc        *desc = dev_get_drvdata(dev);
564         ssize_t                 status;
565
566         mutex_lock(&sysfs_lock);
567
568         if (!test_bit(FLAG_EXPORT, &desc->flags)) {
569                 status = -EIO;
570         } else {
571                 long            value;
572
573                 status = strict_strtol(buf, 0, &value);
574                 if (status == 0)
575                         status = sysfs_set_active_low(desc, dev, value != 0);
576         }
577
578         mutex_unlock(&sysfs_lock);
579
580         return status ? : size;
581 }
582
583 static DEVICE_ATTR(active_low, 0644,
584                 gpio_active_low_show, gpio_active_low_store);
585
586 static struct attribute *gpio_attrs[] = {
587         &dev_attr_value.attr,
588         &dev_attr_active_low.attr,
589         NULL,
590 };
591
592 static const struct attribute_group gpio_attr_group = {
593         .attrs = gpio_attrs,
594 };
595
596 /*
597  * /sys/class/gpio/gpiochipN/
598  *   /base ... matching gpio_chip.base (N)
599  *   /label ... matching gpio_chip.label
600  *   /ngpio ... matching gpio_chip.ngpio
601  */
602
603 static ssize_t chip_base_show(struct device *dev,
604                                struct device_attribute *attr, char *buf)
605 {
606         const struct gpio_chip  *chip = dev_get_drvdata(dev);
607
608         return sprintf(buf, "%d\n", chip->base);
609 }
610 static DEVICE_ATTR(base, 0444, chip_base_show, NULL);
611
612 static ssize_t chip_label_show(struct device *dev,
613                                struct device_attribute *attr, char *buf)
614 {
615         const struct gpio_chip  *chip = dev_get_drvdata(dev);
616
617         return sprintf(buf, "%s\n", chip->label ? : "");
618 }
619 static DEVICE_ATTR(label, 0444, chip_label_show, NULL);
620
621 static ssize_t chip_ngpio_show(struct device *dev,
622                                struct device_attribute *attr, char *buf)
623 {
624         const struct gpio_chip  *chip = dev_get_drvdata(dev);
625
626         return sprintf(buf, "%u\n", chip->ngpio);
627 }
628 static DEVICE_ATTR(ngpio, 0444, chip_ngpio_show, NULL);
629
630 static struct attribute *gpiochip_attrs[] = {
631         &dev_attr_base.attr,
632         &dev_attr_label.attr,
633         &dev_attr_ngpio.attr,
634         NULL,
635 };
636
637 static const struct attribute_group gpiochip_attr_group = {
638         .attrs = gpiochip_attrs,
639 };
640
641 /*
642  * /sys/class/gpio/export ... write-only
643  *      integer N ... number of GPIO to export (full access)
644  * /sys/class/gpio/unexport ... write-only
645  *      integer N ... number of GPIO to unexport
646  */
647 static ssize_t export_store(struct class *class,
648                                 struct class_attribute *attr,
649                                 const char *buf, size_t len)
650 {
651         long                    gpio;
652         struct gpio_desc        *desc;
653         int                     status;
654
655         status = strict_strtol(buf, 0, &gpio);
656         if (status < 0)
657                 goto done;
658
659         desc = gpio_to_desc(gpio);
660         /* reject invalid GPIOs */
661         if (!desc) {
662                 pr_warn("%s: invalid GPIO %ld\n", __func__, gpio);
663                 return -EINVAL;
664         }
665
666         /* No extra locking here; FLAG_SYSFS just signifies that the
667          * request and export were done by on behalf of userspace, so
668          * they may be undone on its behalf too.
669          */
670
671         status = gpiod_request(desc, "sysfs");
672         if (status < 0) {
673                 if (status == -EPROBE_DEFER)
674                         status = -ENODEV;
675                 goto done;
676         }
677         status = gpiod_export(desc, true);
678         if (status < 0)
679                 gpiod_free(desc);
680         else
681                 set_bit(FLAG_SYSFS, &desc->flags);
682
683 done:
684         if (status)
685                 pr_debug("%s: status %d\n", __func__, status);
686         return status ? : len;
687 }
688
689 static ssize_t unexport_store(struct class *class,
690                                 struct class_attribute *attr,
691                                 const char *buf, size_t len)
692 {
693         long                    gpio;
694         struct gpio_desc        *desc;
695         int                     status;
696
697         status = strict_strtol(buf, 0, &gpio);
698         if (status < 0)
699                 goto done;
700
701         desc = gpio_to_desc(gpio);
702         /* reject bogus commands (gpio_unexport ignores them) */
703         if (!desc) {
704                 pr_warn("%s: invalid GPIO %ld\n", __func__, gpio);
705                 return -EINVAL;
706         }
707
708         status = -EINVAL;
709
710         /* No extra locking here; FLAG_SYSFS just signifies that the
711          * request and export were done by on behalf of userspace, so
712          * they may be undone on its behalf too.
713          */
714         if (test_and_clear_bit(FLAG_SYSFS, &desc->flags)) {
715                 status = 0;
716                 gpiod_free(desc);
717         }
718 done:
719         if (status)
720                 pr_debug("%s: status %d\n", __func__, status);
721         return status ? : len;
722 }
723
724 static struct class_attribute gpio_class_attrs[] = {
725         __ATTR(export, 0200, NULL, export_store),
726         __ATTR(unexport, 0200, NULL, unexport_store),
727         __ATTR_NULL,
728 };
729
730 static struct class gpio_class = {
731         .name =         "gpio",
732         .owner =        THIS_MODULE,
733
734         .class_attrs =  gpio_class_attrs,
735 };
736
737
738 /**
739  * gpio_export - export a GPIO through sysfs
740  * @gpio: gpio to make available, already requested
741  * @direction_may_change: true if userspace may change gpio direction
742  * Context: arch_initcall or later
743  *
744  * When drivers want to make a GPIO accessible to userspace after they
745  * have requested it -- perhaps while debugging, or as part of their
746  * public interface -- they may use this routine.  If the GPIO can
747  * change direction (some can't) and the caller allows it, userspace
748  * will see "direction" sysfs attribute which may be used to change
749  * the gpio's direction.  A "value" attribute will always be provided.
750  *
751  * Returns zero on success, else an error.
752  */
753 static int gpiod_export(struct gpio_desc *desc, bool direction_may_change)
754 {
755         unsigned long           flags;
756         int                     status;
757         const char              *ioname = NULL;
758         struct device           *dev;
759         int                     offset;
760
761         /* can't export until sysfs is available ... */
762         if (!gpio_class.p) {
763                 pr_debug("%s: called too early!\n", __func__);
764                 return -ENOENT;
765         }
766
767         if (!desc) {
768                 pr_debug("%s: invalid gpio descriptor\n", __func__);
769                 return -EINVAL;
770         }
771
772         mutex_lock(&sysfs_lock);
773
774         spin_lock_irqsave(&gpio_lock, flags);
775         if (!test_bit(FLAG_REQUESTED, &desc->flags) ||
776              test_bit(FLAG_EXPORT, &desc->flags)) {
777                 spin_unlock_irqrestore(&gpio_lock, flags);
778                 pr_debug("%s: gpio %d unavailable (requested=%d, exported=%d)\n",
779                                 __func__, desc_to_gpio(desc),
780                                 test_bit(FLAG_REQUESTED, &desc->flags),
781                                 test_bit(FLAG_EXPORT, &desc->flags));
782                 status = -EPERM;
783                 goto fail_unlock;
784         }
785
786         if (!desc->chip->direction_input || !desc->chip->direction_output)
787                 direction_may_change = false;
788         spin_unlock_irqrestore(&gpio_lock, flags);
789
790         offset = gpio_chip_hwgpio(desc);
791         if (desc->chip->names && desc->chip->names[offset])
792                 ioname = desc->chip->names[offset];
793
794         dev = device_create(&gpio_class, desc->chip->dev, MKDEV(0, 0),
795                             desc, ioname ? ioname : "gpio%u",
796                             desc_to_gpio(desc));
797         if (IS_ERR(dev)) {
798                 status = PTR_ERR(dev);
799                 goto fail_unlock;
800         }
801
802         status = sysfs_create_group(&dev->kobj, &gpio_attr_group);
803         if (status)
804                 goto fail_unregister_device;
805
806         if (direction_may_change) {
807                 status = device_create_file(dev, &dev_attr_direction);
808                 if (status)
809                         goto fail_remove_attr_group;
810         }
811
812         if (gpiod_to_irq(desc) >= 0 && (direction_may_change ||
813                                        !test_bit(FLAG_IS_OUT, &desc->flags))) {
814                 status = device_create_file(dev, &dev_attr_edge);
815                 if (status)
816                         goto fail_remove_attr_direction;
817         }
818
819         set_bit(FLAG_EXPORT, &desc->flags);
820         mutex_unlock(&sysfs_lock);
821         return 0;
822
823 fail_remove_attr_direction:
824         device_remove_file(dev, &dev_attr_direction);
825 fail_remove_attr_group:
826         sysfs_remove_group(&dev->kobj, &gpio_attr_group);
827 fail_unregister_device:
828         device_unregister(dev);
829 fail_unlock:
830         mutex_unlock(&sysfs_lock);
831         pr_debug("%s: gpio%d status %d\n", __func__, desc_to_gpio(desc),
832                  status);
833         return status;
834 }
835
836 int gpio_export(unsigned gpio, bool direction_may_change)
837 {
838         return gpiod_export(gpio_to_desc(gpio), direction_may_change);
839 }
840 EXPORT_SYMBOL_GPL(gpio_export);
841
842 static int match_export(struct device *dev, const void *data)
843 {
844         return dev_get_drvdata(dev) == data;
845 }
846
847 /**
848  * gpio_export_link - create a sysfs link to an exported GPIO node
849  * @dev: device under which to create symlink
850  * @name: name of the symlink
851  * @gpio: gpio to create symlink to, already exported
852  *
853  * Set up a symlink from /sys/.../dev/name to /sys/class/gpio/gpioN
854  * node. Caller is responsible for unlinking.
855  *
856  * Returns zero on success, else an error.
857  */
858 static int gpiod_export_link(struct device *dev, const char *name,
859                              struct gpio_desc *desc)
860 {
861         int                     status = -EINVAL;
862
863         if (!desc) {
864                 pr_warn("%s: invalid GPIO\n", __func__);
865                 return -EINVAL;
866         }
867
868         mutex_lock(&sysfs_lock);
869
870         if (test_bit(FLAG_EXPORT, &desc->flags)) {
871                 struct device *tdev;
872
873                 tdev = class_find_device(&gpio_class, NULL, desc, match_export);
874                 if (tdev != NULL) {
875                         status = sysfs_create_link(&dev->kobj, &tdev->kobj,
876                                                 name);
877                 } else {
878                         status = -ENODEV;
879                 }
880         }
881
882         mutex_unlock(&sysfs_lock);
883
884         if (status)
885                 pr_debug("%s: gpio%d status %d\n", __func__, desc_to_gpio(desc),
886                          status);
887
888         return status;
889 }
890
891 int gpio_export_link(struct device *dev, const char *name, unsigned gpio)
892 {
893         return gpiod_export_link(dev, name, gpio_to_desc(gpio));
894 }
895 EXPORT_SYMBOL_GPL(gpio_export_link);
896
897 /**
898  * gpio_sysfs_set_active_low - set the polarity of gpio sysfs value
899  * @gpio: gpio to change
900  * @value: non-zero to use active low, i.e. inverted values
901  *
902  * Set the polarity of /sys/class/gpio/gpioN/value sysfs attribute.
903  * The GPIO does not have to be exported yet.  If poll(2) support has
904  * been enabled for either rising or falling edge, it will be
905  * reconfigured to follow the new polarity.
906  *
907  * Returns zero on success, else an error.
908  */
909 static int gpiod_sysfs_set_active_low(struct gpio_desc *desc, int value)
910 {
911         struct device           *dev = NULL;
912         int                     status = -EINVAL;
913
914         if (!desc) {
915                 pr_warn("%s: invalid GPIO\n", __func__);
916                 return -EINVAL;
917         }
918
919         mutex_lock(&sysfs_lock);
920
921         if (test_bit(FLAG_EXPORT, &desc->flags)) {
922                 dev = class_find_device(&gpio_class, NULL, desc, match_export);
923                 if (dev == NULL) {
924                         status = -ENODEV;
925                         goto unlock;
926                 }
927         }
928
929         status = sysfs_set_active_low(desc, dev, value);
930
931 unlock:
932         mutex_unlock(&sysfs_lock);
933
934         if (status)
935                 pr_debug("%s: gpio%d status %d\n", __func__, desc_to_gpio(desc),
936                          status);
937
938         return status;
939 }
940
941 int gpio_sysfs_set_active_low(unsigned gpio, int value)
942 {
943         return gpiod_sysfs_set_active_low(gpio_to_desc(gpio), value);
944 }
945 EXPORT_SYMBOL_GPL(gpio_sysfs_set_active_low);
946
947 /**
948  * gpio_unexport - reverse effect of gpio_export()
949  * @gpio: gpio to make unavailable
950  *
951  * This is implicit on gpio_free().
952  */
953 static void gpiod_unexport(struct gpio_desc *desc)
954 {
955         int                     status = 0;
956         struct device           *dev = NULL;
957
958         if (!desc) {
959                 pr_warn("%s: invalid GPIO\n", __func__);
960                 return;
961         }
962
963         mutex_lock(&sysfs_lock);
964
965         if (test_bit(FLAG_EXPORT, &desc->flags)) {
966
967                 dev = class_find_device(&gpio_class, NULL, desc, match_export);
968                 if (dev) {
969                         gpio_setup_irq(desc, dev, 0);
970                         clear_bit(FLAG_EXPORT, &desc->flags);
971                 } else
972                         status = -ENODEV;
973         }
974
975         mutex_unlock(&sysfs_lock);
976
977         if (dev) {
978                 device_remove_file(dev, &dev_attr_edge);
979                 device_remove_file(dev, &dev_attr_direction);
980                 sysfs_remove_group(&dev->kobj, &gpio_attr_group);
981                 device_unregister(dev);
982                 put_device(dev);
983         }
984
985         if (status)
986                 pr_debug("%s: gpio%d status %d\n", __func__, desc_to_gpio(desc),
987                          status);
988 }
989
990 void gpio_unexport(unsigned gpio)
991 {
992         gpiod_unexport(gpio_to_desc(gpio));
993 }
994 EXPORT_SYMBOL_GPL(gpio_unexport);
995
996 static int gpiochip_export(struct gpio_chip *chip)
997 {
998         int             status;
999         struct device   *dev;
1000
1001         /* Many systems register gpio chips for SOC support very early,
1002          * before driver model support is available.  In those cases we
1003          * export this later, in gpiolib_sysfs_init() ... here we just
1004          * verify that _some_ field of gpio_class got initialized.
1005          */
1006         if (!gpio_class.p)
1007                 return 0;
1008
1009         /* use chip->base for the ID; it's already known to be unique */
1010         mutex_lock(&sysfs_lock);
1011         dev = device_create(&gpio_class, chip->dev, MKDEV(0, 0), chip,
1012                                 "gpiochip%d", chip->base);
1013         if (!IS_ERR(dev)) {
1014                 status = sysfs_create_group(&dev->kobj,
1015                                 &gpiochip_attr_group);
1016         } else
1017                 status = PTR_ERR(dev);
1018         chip->exported = (status == 0);
1019         mutex_unlock(&sysfs_lock);
1020
1021         if (status) {
1022                 unsigned long   flags;
1023                 unsigned        gpio;
1024
1025                 spin_lock_irqsave(&gpio_lock, flags);
1026                 gpio = 0;
1027                 while (gpio < chip->ngpio)
1028                         chip->desc[gpio++].chip = NULL;
1029                 spin_unlock_irqrestore(&gpio_lock, flags);
1030
1031                 pr_debug("%s: chip %s status %d\n", __func__,
1032                                 chip->label, status);
1033         }
1034
1035         return status;
1036 }
1037
1038 static void gpiochip_unexport(struct gpio_chip *chip)
1039 {
1040         int                     status;
1041         struct device           *dev;
1042
1043         mutex_lock(&sysfs_lock);
1044         dev = class_find_device(&gpio_class, NULL, chip, match_export);
1045         if (dev) {
1046                 sysfs_remove_group(&dev->kobj, &gpiochip_attr_group);
1047                 put_device(dev);
1048                 device_unregister(dev);
1049                 chip->exported = 0;
1050                 status = 0;
1051         } else
1052                 status = -ENODEV;
1053         mutex_unlock(&sysfs_lock);
1054
1055         if (status)
1056                 pr_debug("%s: chip %s status %d\n", __func__,
1057                                 chip->label, status);
1058 }
1059
1060 static int __init gpiolib_sysfs_init(void)
1061 {
1062         int             status;
1063         unsigned long   flags;
1064         struct gpio_chip *chip;
1065
1066         status = class_register(&gpio_class);
1067         if (status < 0)
1068                 return status;
1069
1070         /* Scan and register the gpio_chips which registered very
1071          * early (e.g. before the class_register above was called).
1072          *
1073          * We run before arch_initcall() so chip->dev nodes can have
1074          * registered, and so arch_initcall() can always gpio_export().
1075          */
1076         spin_lock_irqsave(&gpio_lock, flags);
1077         list_for_each_entry(chip, &gpio_chips, list) {
1078                 if (!chip || chip->exported)
1079                         continue;
1080
1081                 spin_unlock_irqrestore(&gpio_lock, flags);
1082                 status = gpiochip_export(chip);
1083                 spin_lock_irqsave(&gpio_lock, flags);
1084         }
1085         spin_unlock_irqrestore(&gpio_lock, flags);
1086
1087
1088         return status;
1089 }
1090 postcore_initcall(gpiolib_sysfs_init);
1091
1092 #else
1093 static inline int gpiochip_export(struct gpio_chip *chip)
1094 {
1095         return 0;
1096 }
1097
1098 static inline void gpiochip_unexport(struct gpio_chip *chip)
1099 {
1100 }
1101
1102 static inline int gpiod_export(struct gpio_desc *desc,
1103                                bool direction_may_change)
1104 {
1105         return -ENOSYS;
1106 }
1107
1108 static inline int gpiod_export_link(struct device *dev, const char *name,
1109                                     struct gpio_desc *desc)
1110 {
1111         return -ENOSYS;
1112 }
1113
1114 static inline int gpiod_sysfs_set_active_low(struct gpio_desc *desc, int value)
1115 {
1116         return -ENOSYS;
1117 }
1118
1119 static inline void gpiod_unexport(struct gpio_desc *desc)
1120 {
1121 }
1122
1123 #endif /* CONFIG_GPIO_SYSFS */
1124
1125 /*
1126  * Add a new chip to the global chips list, keeping the list of chips sorted
1127  * by base order.
1128  *
1129  * Return -EBUSY if the new chip overlaps with some other chip's integer
1130  * space.
1131  */
1132 static int gpiochip_add_to_list(struct gpio_chip *chip)
1133 {
1134         struct list_head *pos = &gpio_chips;
1135         struct gpio_chip *_chip;
1136         int err = 0;
1137
1138         /* find where to insert our chip */
1139         list_for_each(pos, &gpio_chips) {
1140                 _chip = list_entry(pos, struct gpio_chip, list);
1141                 /* shall we insert before _chip? */
1142                 if (_chip->base >= chip->base + chip->ngpio)
1143                         break;
1144         }
1145
1146         /* are we stepping on the chip right before? */
1147         if (pos != &gpio_chips && pos->prev != &gpio_chips) {
1148                 _chip = list_entry(pos->prev, struct gpio_chip, list);
1149                 if (_chip->base + _chip->ngpio > chip->base) {
1150                         dev_err(chip->dev,
1151                                "GPIO integer space overlap, cannot add chip\n");
1152                         err = -EBUSY;
1153                 }
1154         }
1155
1156         if (!err)
1157                 list_add_tail(&chip->list, pos);
1158
1159         return err;
1160 }
1161
1162 /**
1163  * gpiochip_add() - register a gpio_chip
1164  * @chip: the chip to register, with chip->base initialized
1165  * Context: potentially before irqs or kmalloc will work
1166  *
1167  * Returns a negative errno if the chip can't be registered, such as
1168  * because the chip->base is invalid or already associated with a
1169  * different chip.  Otherwise it returns zero as a success code.
1170  *
1171  * When gpiochip_add() is called very early during boot, so that GPIOs
1172  * can be freely used, the chip->dev device must be registered before
1173  * the gpio framework's arch_initcall().  Otherwise sysfs initialization
1174  * for GPIOs will fail rudely.
1175  *
1176  * If chip->base is negative, this requests dynamic assignment of
1177  * a range of valid GPIOs.
1178  */
1179 int gpiochip_add(struct gpio_chip *chip)
1180 {
1181         unsigned long   flags;
1182         int             status = 0;
1183         unsigned        id;
1184         int             base = chip->base;
1185
1186         if ((!gpio_is_valid(base) || !gpio_is_valid(base + chip->ngpio - 1))
1187                         && base >= 0) {
1188                 status = -EINVAL;
1189                 goto fail;
1190         }
1191
1192         spin_lock_irqsave(&gpio_lock, flags);
1193
1194         if (base < 0) {
1195                 base = gpiochip_find_base(chip->ngpio);
1196                 if (base < 0) {
1197                         status = base;
1198                         goto unlock;
1199                 }
1200                 chip->base = base;
1201         }
1202
1203         status = gpiochip_add_to_list(chip);
1204
1205         if (status == 0) {
1206                 chip->desc = &gpio_desc[chip->base];
1207
1208                 for (id = 0; id < chip->ngpio; id++) {
1209                         struct gpio_desc *desc = &chip->desc[id];
1210                         desc->chip = chip;
1211
1212                         /* REVISIT:  most hardware initializes GPIOs as
1213                          * inputs (often with pullups enabled) so power
1214                          * usage is minimized.  Linux code should set the
1215                          * gpio direction first thing; but until it does,
1216                          * and in case chip->get_direction is not set,
1217                          * we may expose the wrong direction in sysfs.
1218                          */
1219                         desc->flags = !chip->direction_input
1220                                 ? (1 << FLAG_IS_OUT)
1221                                 : 0;
1222                 }
1223         }
1224
1225 #ifdef CONFIG_PINCTRL
1226         INIT_LIST_HEAD(&chip->pin_ranges);
1227 #endif
1228
1229         of_gpiochip_add(chip);
1230
1231 unlock:
1232         spin_unlock_irqrestore(&gpio_lock, flags);
1233
1234         if (status)
1235                 goto fail;
1236
1237         status = gpiochip_export(chip);
1238         if (status)
1239                 goto fail;
1240
1241         pr_debug("gpiochip_add: registered GPIOs %d to %d on device: %s\n",
1242                 chip->base, chip->base + chip->ngpio - 1,
1243                 chip->label ? : "generic");
1244
1245         return 0;
1246 fail:
1247         /* failures here can mean systems won't boot... */
1248         pr_err("gpiochip_add: gpios %d..%d (%s) failed to register\n",
1249                 chip->base, chip->base + chip->ngpio - 1,
1250                 chip->label ? : "generic");
1251         return status;
1252 }
1253 EXPORT_SYMBOL_GPL(gpiochip_add);
1254
1255 /**
1256  * gpiochip_remove() - unregister a gpio_chip
1257  * @chip: the chip to unregister
1258  *
1259  * A gpio_chip with any GPIOs still requested may not be removed.
1260  */
1261 int gpiochip_remove(struct gpio_chip *chip)
1262 {
1263         unsigned long   flags;
1264         int             status = 0;
1265         unsigned        id;
1266
1267         spin_lock_irqsave(&gpio_lock, flags);
1268
1269         gpiochip_remove_pin_ranges(chip);
1270         of_gpiochip_remove(chip);
1271
1272         for (id = 0; id < chip->ngpio; id++) {
1273                 if (test_bit(FLAG_REQUESTED, &chip->desc[id].flags)) {
1274                         status = -EBUSY;
1275                         break;
1276                 }
1277         }
1278         if (status == 0) {
1279                 for (id = 0; id < chip->ngpio; id++)
1280                         chip->desc[id].chip = NULL;
1281
1282                 list_del(&chip->list);
1283         }
1284
1285         spin_unlock_irqrestore(&gpio_lock, flags);
1286
1287         if (status == 0)
1288                 gpiochip_unexport(chip);
1289
1290         return status;
1291 }
1292 EXPORT_SYMBOL_GPL(gpiochip_remove);
1293
1294 /**
1295  * gpiochip_find() - iterator for locating a specific gpio_chip
1296  * @data: data to pass to match function
1297  * @callback: Callback function to check gpio_chip
1298  *
1299  * Similar to bus_find_device.  It returns a reference to a gpio_chip as
1300  * determined by a user supplied @match callback.  The callback should return
1301  * 0 if the device doesn't match and non-zero if it does.  If the callback is
1302  * non-zero, this function will return to the caller and not iterate over any
1303  * more gpio_chips.
1304  */
1305 struct gpio_chip *gpiochip_find(void *data,
1306                                 int (*match)(struct gpio_chip *chip,
1307                                              void *data))
1308 {
1309         struct gpio_chip *chip;
1310         unsigned long flags;
1311
1312         spin_lock_irqsave(&gpio_lock, flags);
1313         list_for_each_entry(chip, &gpio_chips, list)
1314                 if (match(chip, data))
1315                         break;
1316
1317         /* No match? */
1318         if (&chip->list == &gpio_chips)
1319                 chip = NULL;
1320         spin_unlock_irqrestore(&gpio_lock, flags);
1321
1322         return chip;
1323 }
1324 EXPORT_SYMBOL_GPL(gpiochip_find);
1325
1326 #ifdef CONFIG_PINCTRL
1327
1328 /**
1329  * gpiochip_add_pin_range() - add a range for GPIO <-> pin mapping
1330  * @chip: the gpiochip to add the range for
1331  * @pinctrl_name: the dev_name() of the pin controller to map to
1332  * @gpio_offset: the start offset in the current gpio_chip number space
1333  * @pin_offset: the start offset in the pin controller number space
1334  * @npins: the number of pins from the offset of each pin space (GPIO and
1335  *      pin controller) to accumulate in this range
1336  */
1337 int gpiochip_add_pin_range(struct gpio_chip *chip, const char *pinctl_name,
1338                            unsigned int gpio_offset, unsigned int pin_offset,
1339                            unsigned int npins)
1340 {
1341         struct gpio_pin_range *pin_range;
1342         int ret;
1343
1344         pin_range = kzalloc(sizeof(*pin_range), GFP_KERNEL);
1345         if (!pin_range) {
1346                 pr_err("%s: GPIO chip: failed to allocate pin ranges\n",
1347                                 chip->label);
1348                 return -ENOMEM;
1349         }
1350
1351         /* Use local offset as range ID */
1352         pin_range->range.id = gpio_offset;
1353         pin_range->range.gc = chip;
1354         pin_range->range.name = chip->label;
1355         pin_range->range.base = chip->base + gpio_offset;
1356         pin_range->range.pin_base = pin_offset;
1357         pin_range->range.npins = npins;
1358         pin_range->pctldev = pinctrl_find_and_add_gpio_range(pinctl_name,
1359                         &pin_range->range);
1360         if (IS_ERR(pin_range->pctldev)) {
1361                 ret = PTR_ERR(pin_range->pctldev);
1362                 pr_err("%s: GPIO chip: could not create pin range\n",
1363                        chip->label);
1364                 kfree(pin_range);
1365                 return ret;
1366         }
1367         pr_debug("GPIO chip %s: created GPIO range %d->%d ==> %s PIN %d->%d\n",
1368                  chip->label, gpio_offset, gpio_offset + npins - 1,
1369                  pinctl_name,
1370                  pin_offset, pin_offset + npins - 1);
1371
1372         list_add_tail(&pin_range->node, &chip->pin_ranges);
1373
1374         return 0;
1375 }
1376 EXPORT_SYMBOL_GPL(gpiochip_add_pin_range);
1377
1378 /**
1379  * gpiochip_remove_pin_ranges() - remove all the GPIO <-> pin mappings
1380  * @chip: the chip to remove all the mappings for
1381  */
1382 void gpiochip_remove_pin_ranges(struct gpio_chip *chip)
1383 {
1384         struct gpio_pin_range *pin_range, *tmp;
1385
1386         list_for_each_entry_safe(pin_range, tmp, &chip->pin_ranges, node) {
1387                 list_del(&pin_range->node);
1388                 pinctrl_remove_gpio_range(pin_range->pctldev,
1389                                 &pin_range->range);
1390                 kfree(pin_range);
1391         }
1392 }
1393 EXPORT_SYMBOL_GPL(gpiochip_remove_pin_ranges);
1394
1395 #endif /* CONFIG_PINCTRL */
1396
1397 /* These "optional" allocation calls help prevent drivers from stomping
1398  * on each other, and help provide better diagnostics in debugfs.
1399  * They're called even less than the "set direction" calls.
1400  */
1401 static int gpiod_request(struct gpio_desc *desc, const char *label)
1402 {
1403         struct gpio_chip        *chip;
1404         int                     status = -EPROBE_DEFER;
1405         unsigned long           flags;
1406
1407         if (!desc) {
1408                 pr_warn("%s: invalid GPIO\n", __func__);
1409                 return -EINVAL;
1410         }
1411
1412         spin_lock_irqsave(&gpio_lock, flags);
1413
1414         chip = desc->chip;
1415         if (chip == NULL)
1416                 goto done;
1417
1418         if (!try_module_get(chip->owner))
1419                 goto done;
1420
1421         /* NOTE:  gpio_request() can be called in early boot,
1422          * before IRQs are enabled, for non-sleeping (SOC) GPIOs.
1423          */
1424
1425         if (test_and_set_bit(FLAG_REQUESTED, &desc->flags) == 0) {
1426                 desc_set_label(desc, label ? : "?");
1427                 status = 0;
1428         } else {
1429                 status = -EBUSY;
1430                 module_put(chip->owner);
1431                 goto done;
1432         }
1433
1434         if (chip->request) {
1435                 /* chip->request may sleep */
1436                 spin_unlock_irqrestore(&gpio_lock, flags);
1437                 status = chip->request(chip, gpio_chip_hwgpio(desc));
1438                 spin_lock_irqsave(&gpio_lock, flags);
1439
1440                 if (status < 0) {
1441                         desc_set_label(desc, NULL);
1442                         module_put(chip->owner);
1443                         clear_bit(FLAG_REQUESTED, &desc->flags);
1444                         goto done;
1445                 }
1446         }
1447         if (chip->get_direction) {
1448                 /* chip->get_direction may sleep */
1449                 spin_unlock_irqrestore(&gpio_lock, flags);
1450                 gpiod_get_direction(desc);
1451                 spin_lock_irqsave(&gpio_lock, flags);
1452         }
1453 done:
1454         if (status)
1455                 pr_debug("_gpio_request: gpio-%d (%s) status %d\n",
1456                          desc_to_gpio(desc), label ? : "?", status);
1457         spin_unlock_irqrestore(&gpio_lock, flags);
1458         return status;
1459 }
1460
1461 int gpio_request(unsigned gpio, const char *label)
1462 {
1463         return gpiod_request(gpio_to_desc(gpio), label);
1464 }
1465 EXPORT_SYMBOL_GPL(gpio_request);
1466
1467 static void gpiod_free(struct gpio_desc *desc)
1468 {
1469         unsigned long           flags;
1470         struct gpio_chip        *chip;
1471
1472         might_sleep();
1473
1474         if (!desc) {
1475                 WARN_ON(extra_checks);
1476                 return;
1477         }
1478
1479         gpiod_unexport(desc);
1480
1481         spin_lock_irqsave(&gpio_lock, flags);
1482
1483         chip = desc->chip;
1484         if (chip && test_bit(FLAG_REQUESTED, &desc->flags)) {
1485                 if (chip->free) {
1486                         spin_unlock_irqrestore(&gpio_lock, flags);
1487                         might_sleep_if(chip->can_sleep);
1488                         chip->free(chip, gpio_chip_hwgpio(desc));
1489                         spin_lock_irqsave(&gpio_lock, flags);
1490                 }
1491                 desc_set_label(desc, NULL);
1492                 module_put(desc->chip->owner);
1493                 clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
1494                 clear_bit(FLAG_REQUESTED, &desc->flags);
1495                 clear_bit(FLAG_OPEN_DRAIN, &desc->flags);
1496                 clear_bit(FLAG_OPEN_SOURCE, &desc->flags);
1497         } else
1498                 WARN_ON(extra_checks);
1499
1500         spin_unlock_irqrestore(&gpio_lock, flags);
1501 }
1502
1503 void gpio_free(unsigned gpio)
1504 {
1505         gpiod_free(gpio_to_desc(gpio));
1506 }
1507 EXPORT_SYMBOL_GPL(gpio_free);
1508
1509 /**
1510  * gpio_request_one - request a single GPIO with initial configuration
1511  * @gpio:       the GPIO number
1512  * @flags:      GPIO configuration as specified by GPIOF_*
1513  * @label:      a literal description string of this GPIO
1514  */
1515 int gpio_request_one(unsigned gpio, unsigned long flags, const char *label)
1516 {
1517         struct gpio_desc *desc;
1518         int err;
1519
1520         desc = gpio_to_desc(gpio);
1521
1522         err = gpiod_request(desc, label);
1523         if (err)
1524                 return err;
1525
1526         if (flags & GPIOF_OPEN_DRAIN)
1527                 set_bit(FLAG_OPEN_DRAIN, &desc->flags);
1528
1529         if (flags & GPIOF_OPEN_SOURCE)
1530                 set_bit(FLAG_OPEN_SOURCE, &desc->flags);
1531
1532         if (flags & GPIOF_DIR_IN)
1533                 err = gpiod_direction_input(desc);
1534         else
1535                 err = gpiod_direction_output(desc,
1536                                 (flags & GPIOF_INIT_HIGH) ? 1 : 0);
1537
1538         if (err)
1539                 goto free_gpio;
1540
1541         if (flags & GPIOF_EXPORT) {
1542                 err = gpiod_export(desc, flags & GPIOF_EXPORT_CHANGEABLE);
1543                 if (err)
1544                         goto free_gpio;
1545         }
1546
1547         return 0;
1548
1549  free_gpio:
1550         gpiod_free(desc);
1551         return err;
1552 }
1553 EXPORT_SYMBOL_GPL(gpio_request_one);
1554
1555 /**
1556  * gpio_request_array - request multiple GPIOs in a single call
1557  * @array:      array of the 'struct gpio'
1558  * @num:        how many GPIOs in the array
1559  */
1560 int gpio_request_array(const struct gpio *array, size_t num)
1561 {
1562         int i, err;
1563
1564         for (i = 0; i < num; i++, array++) {
1565                 err = gpio_request_one(array->gpio, array->flags, array->label);
1566                 if (err)
1567                         goto err_free;
1568         }
1569         return 0;
1570
1571 err_free:
1572         while (i--)
1573                 gpio_free((--array)->gpio);
1574         return err;
1575 }
1576 EXPORT_SYMBOL_GPL(gpio_request_array);
1577
1578 /**
1579  * gpio_free_array - release multiple GPIOs in a single call
1580  * @array:      array of the 'struct gpio'
1581  * @num:        how many GPIOs in the array
1582  */
1583 void gpio_free_array(const struct gpio *array, size_t num)
1584 {
1585         while (num--)
1586                 gpio_free((array++)->gpio);
1587 }
1588 EXPORT_SYMBOL_GPL(gpio_free_array);
1589
1590 /**
1591  * gpiochip_is_requested - return string iff signal was requested
1592  * @chip: controller managing the signal
1593  * @offset: of signal within controller's 0..(ngpio - 1) range
1594  *
1595  * Returns NULL if the GPIO is not currently requested, else a string.
1596  * If debugfs support is enabled, the string returned is the label passed
1597  * to gpio_request(); otherwise it is a meaningless constant.
1598  *
1599  * This function is for use by GPIO controller drivers.  The label can
1600  * help with diagnostics, and knowing that the signal is used as a GPIO
1601  * can help avoid accidentally multiplexing it to another controller.
1602  */
1603 const char *gpiochip_is_requested(struct gpio_chip *chip, unsigned offset)
1604 {
1605         struct gpio_desc *desc;
1606
1607         if (!GPIO_OFFSET_VALID(chip, offset))
1608                 return NULL;
1609
1610         desc = &chip->desc[offset];
1611
1612         if (test_bit(FLAG_REQUESTED, &desc->flags) == 0)
1613                 return NULL;
1614 #ifdef CONFIG_DEBUG_FS
1615         return desc->label;
1616 #else
1617         return "?";
1618 #endif
1619 }
1620 EXPORT_SYMBOL_GPL(gpiochip_is_requested);
1621
1622
1623 /* Drivers MUST set GPIO direction before making get/set calls.  In
1624  * some cases this is done in early boot, before IRQs are enabled.
1625  *
1626  * As a rule these aren't called more than once (except for drivers
1627  * using the open-drain emulation idiom) so these are natural places
1628  * to accumulate extra debugging checks.  Note that we can't (yet)
1629  * rely on gpio_request() having been called beforehand.
1630  */
1631
1632 static int gpiod_direction_input(struct gpio_desc *desc)
1633 {
1634         unsigned long           flags;
1635         struct gpio_chip        *chip;
1636         int                     status = -EINVAL;
1637         int                     offset;
1638
1639         if (!desc) {
1640                 pr_warn("%s: invalid GPIO\n", __func__);
1641                 return -EINVAL;
1642         }
1643
1644         spin_lock_irqsave(&gpio_lock, flags);
1645
1646         chip = desc->chip;
1647         if (!chip || !chip->get || !chip->direction_input)
1648                 goto fail;
1649         status = gpio_ensure_requested(desc);
1650         if (status < 0)
1651                 goto fail;
1652
1653         /* now we know the gpio is valid and chip won't vanish */
1654
1655         spin_unlock_irqrestore(&gpio_lock, flags);
1656
1657         might_sleep_if(chip->can_sleep);
1658
1659         offset = gpio_chip_hwgpio(desc);
1660         if (status) {
1661                 status = chip->request(chip, offset);
1662                 if (status < 0) {
1663                         pr_debug("GPIO-%d: chip request fail, %d\n",
1664                                 desc_to_gpio(desc), status);
1665                         /* and it's not available to anyone else ...
1666                          * gpio_request() is the fully clean solution.
1667                          */
1668                         goto lose;
1669                 }
1670         }
1671
1672         status = chip->direction_input(chip, offset);
1673         if (status == 0)
1674                 clear_bit(FLAG_IS_OUT, &desc->flags);
1675
1676         trace_gpio_direction(desc_to_gpio(desc), 1, status);
1677 lose:
1678         return status;
1679 fail:
1680         spin_unlock_irqrestore(&gpio_lock, flags);
1681         if (status)
1682                 pr_debug("%s: gpio-%d status %d\n", __func__,
1683                          desc_to_gpio(desc), status);
1684         return status;
1685 }
1686
1687 int gpio_direction_input(unsigned gpio)
1688 {
1689         return gpiod_direction_input(gpio_to_desc(gpio));
1690 }
1691 EXPORT_SYMBOL_GPL(gpio_direction_input);
1692
1693 static int gpiod_direction_output(struct gpio_desc *desc, int value)
1694 {
1695         unsigned long           flags;
1696         struct gpio_chip        *chip;
1697         int                     status = -EINVAL;
1698         int offset;
1699
1700         if (!desc) {
1701                 pr_warn("%s: invalid GPIO\n", __func__);
1702                 return -EINVAL;
1703         }
1704
1705         /* Open drain pin should not be driven to 1 */
1706         if (value && test_bit(FLAG_OPEN_DRAIN,  &desc->flags))
1707                 return gpiod_direction_input(desc);
1708
1709         /* Open source pin should not be driven to 0 */
1710         if (!value && test_bit(FLAG_OPEN_SOURCE,  &desc->flags))
1711                 return gpiod_direction_input(desc);
1712
1713         spin_lock_irqsave(&gpio_lock, flags);
1714
1715         chip = desc->chip;
1716         if (!chip || !chip->set || !chip->direction_output)
1717                 goto fail;
1718         status = gpio_ensure_requested(desc);
1719         if (status < 0)
1720                 goto fail;
1721
1722         /* now we know the gpio is valid and chip won't vanish */
1723
1724         spin_unlock_irqrestore(&gpio_lock, flags);
1725
1726         might_sleep_if(chip->can_sleep);
1727
1728         offset = gpio_chip_hwgpio(desc);
1729         if (status) {
1730                 status = chip->request(chip, offset);
1731                 if (status < 0) {
1732                         pr_debug("GPIO-%d: chip request fail, %d\n",
1733                                 desc_to_gpio(desc), status);
1734                         /* and it's not available to anyone else ...
1735                          * gpio_request() is the fully clean solution.
1736                          */
1737                         goto lose;
1738                 }
1739         }
1740
1741         status = chip->direction_output(chip, offset, value);
1742         if (status == 0)
1743                 set_bit(FLAG_IS_OUT, &desc->flags);
1744         trace_gpio_value(desc_to_gpio(desc), 0, value);
1745         trace_gpio_direction(desc_to_gpio(desc), 0, status);
1746 lose:
1747         return status;
1748 fail:
1749         spin_unlock_irqrestore(&gpio_lock, flags);
1750         if (status)
1751                 pr_debug("%s: gpio-%d status %d\n", __func__,
1752                          desc_to_gpio(desc), status);
1753         return status;
1754 }
1755
1756 int gpio_direction_output(unsigned gpio, int value)
1757 {
1758         return gpiod_direction_output(gpio_to_desc(gpio), value);
1759 }
1760 EXPORT_SYMBOL_GPL(gpio_direction_output);
1761
1762 /**
1763  * gpio_set_debounce - sets @debounce time for a @gpio
1764  * @gpio: the gpio to set debounce time
1765  * @debounce: debounce time is microseconds
1766  */
1767 static int gpiod_set_debounce(struct gpio_desc *desc, unsigned debounce)
1768 {
1769         unsigned long           flags;
1770         struct gpio_chip        *chip;
1771         int                     status = -EINVAL;
1772         int                     offset;
1773
1774         if (!desc) {
1775                 pr_warn("%s: invalid GPIO\n", __func__);
1776                 return -EINVAL;
1777         }
1778
1779         spin_lock_irqsave(&gpio_lock, flags);
1780
1781         chip = desc->chip;
1782         if (!chip || !chip->set || !chip->set_debounce)
1783                 goto fail;
1784
1785         status = gpio_ensure_requested(desc);
1786         if (status < 0)
1787                 goto fail;
1788
1789         /* now we know the gpio is valid and chip won't vanish */
1790
1791         spin_unlock_irqrestore(&gpio_lock, flags);
1792
1793         might_sleep_if(chip->can_sleep);
1794
1795         offset = gpio_chip_hwgpio(desc);
1796         return chip->set_debounce(chip, offset, debounce);
1797
1798 fail:
1799         spin_unlock_irqrestore(&gpio_lock, flags);
1800         if (status)
1801                 pr_debug("%s: gpio-%d status %d\n", __func__,
1802                          desc_to_gpio(desc), status);
1803
1804         return status;
1805 }
1806
1807 int gpio_set_debounce(unsigned gpio, unsigned debounce)
1808 {
1809         return gpiod_set_debounce(gpio_to_desc(gpio), debounce);
1810 }
1811 EXPORT_SYMBOL_GPL(gpio_set_debounce);
1812
1813 /* I/O calls are only valid after configuration completed; the relevant
1814  * "is this a valid GPIO" error checks should already have been done.
1815  *
1816  * "Get" operations are often inlinable as reading a pin value register,
1817  * and masking the relevant bit in that register.
1818  *
1819  * When "set" operations are inlinable, they involve writing that mask to
1820  * one register to set a low value, or a different register to set it high.
1821  * Otherwise locking is needed, so there may be little value to inlining.
1822  *
1823  *------------------------------------------------------------------------
1824  *
1825  * IMPORTANT!!!  The hot paths -- get/set value -- assume that callers
1826  * have requested the GPIO.  That can include implicit requesting by
1827  * a direction setting call.  Marking a gpio as requested locks its chip
1828  * in memory, guaranteeing that these table lookups need no more locking
1829  * and that gpiochip_remove() will fail.
1830  *
1831  * REVISIT when debugging, consider adding some instrumentation to ensure
1832  * that the GPIO was actually requested.
1833  */
1834
1835 /**
1836  * __gpio_get_value() - return a gpio's value
1837  * @gpio: gpio whose value will be returned
1838  * Context: any
1839  *
1840  * This is used directly or indirectly to implement gpio_get_value().
1841  * It returns the zero or nonzero value provided by the associated
1842  * gpio_chip.get() method; or zero if no such method is provided.
1843  */
1844 static int gpiod_get_value(const struct gpio_desc *desc)
1845 {
1846         struct gpio_chip        *chip;
1847         int value;
1848         int offset;
1849
1850         if (!desc)
1851                 return 0;
1852         chip = desc->chip;
1853         offset = gpio_chip_hwgpio(desc);
1854         /* Should be using gpio_get_value_cansleep() */
1855         WARN_ON(chip->can_sleep);
1856         value = chip->get ? chip->get(chip, offset) : 0;
1857         trace_gpio_value(desc_to_gpio(desc), 1, value);
1858         return value;
1859 }
1860
1861 int __gpio_get_value(unsigned gpio)
1862 {
1863         return gpiod_get_value(gpio_to_desc(gpio));
1864 }
1865 EXPORT_SYMBOL_GPL(__gpio_get_value);
1866
1867 /*
1868  *  _gpio_set_open_drain_value() - Set the open drain gpio's value.
1869  * @gpio: Gpio whose state need to be set.
1870  * @chip: Gpio chip.
1871  * @value: Non-zero for setting it HIGH otherise it will set to LOW.
1872  */
1873 static void _gpio_set_open_drain_value(struct gpio_desc *desc, int value)
1874 {
1875         int err = 0;
1876         struct gpio_chip *chip = desc->chip;
1877         int offset = gpio_chip_hwgpio(desc);
1878
1879         if (value) {
1880                 err = chip->direction_input(chip, offset);
1881                 if (!err)
1882                         clear_bit(FLAG_IS_OUT, &desc->flags);
1883         } else {
1884                 err = chip->direction_output(chip, offset, 0);
1885                 if (!err)
1886                         set_bit(FLAG_IS_OUT, &desc->flags);
1887         }
1888         trace_gpio_direction(desc_to_gpio(desc), value, err);
1889         if (err < 0)
1890                 pr_err("%s: Error in set_value for open drain gpio%d err %d\n",
1891                                         __func__, desc_to_gpio(desc), err);
1892 }
1893
1894 /*
1895  *  _gpio_set_open_source() - Set the open source gpio's value.
1896  * @gpio: Gpio whose state need to be set.
1897  * @chip: Gpio chip.
1898  * @value: Non-zero for setting it HIGH otherise it will set to LOW.
1899  */
1900 static void _gpio_set_open_source_value(struct gpio_desc *desc, int value)
1901 {
1902         int err = 0;
1903         struct gpio_chip *chip = desc->chip;
1904         int offset = gpio_chip_hwgpio(desc);
1905
1906         if (value) {
1907                 err = chip->direction_output(chip, offset, 1);
1908                 if (!err)
1909                         set_bit(FLAG_IS_OUT, &desc->flags);
1910         } else {
1911                 err = chip->direction_input(chip, offset);
1912                 if (!err)
1913                         clear_bit(FLAG_IS_OUT, &desc->flags);
1914         }
1915         trace_gpio_direction(desc_to_gpio(desc), !value, err);
1916         if (err < 0)
1917                 pr_err("%s: Error in set_value for open source gpio%d err %d\n",
1918                                         __func__, desc_to_gpio(desc), err);
1919 }
1920
1921 /**
1922  * __gpio_set_value() - assign a gpio's value
1923  * @gpio: gpio whose value will be assigned
1924  * @value: value to assign
1925  * Context: any
1926  *
1927  * This is used directly or indirectly to implement gpio_set_value().
1928  * It invokes the associated gpio_chip.set() method.
1929  */
1930 static void gpiod_set_value(struct gpio_desc *desc, int value)
1931 {
1932         struct gpio_chip        *chip;
1933
1934         if (!desc)
1935                 return;
1936         chip = desc->chip;
1937         /* Should be using gpio_set_value_cansleep() */
1938         WARN_ON(chip->can_sleep);
1939         trace_gpio_value(desc_to_gpio(desc), 0, value);
1940         if (test_bit(FLAG_OPEN_DRAIN, &desc->flags))
1941                 _gpio_set_open_drain_value(desc, value);
1942         else if (test_bit(FLAG_OPEN_SOURCE, &desc->flags))
1943                 _gpio_set_open_source_value(desc, value);
1944         else
1945                 chip->set(chip, gpio_chip_hwgpio(desc), value);
1946 }
1947
1948 void __gpio_set_value(unsigned gpio, int value)
1949 {
1950         return gpiod_set_value(gpio_to_desc(gpio), value);
1951 }
1952 EXPORT_SYMBOL_GPL(__gpio_set_value);
1953
1954 /**
1955  * __gpio_cansleep() - report whether gpio value access will sleep
1956  * @gpio: gpio in question
1957  * Context: any
1958  *
1959  * This is used directly or indirectly to implement gpio_cansleep().  It
1960  * returns nonzero if access reading or writing the GPIO value can sleep.
1961  */
1962 static int gpiod_cansleep(const struct gpio_desc *desc)
1963 {
1964         if (!desc)
1965                 return 0;
1966         /* only call this on GPIOs that are valid! */
1967         return desc->chip->can_sleep;
1968 }
1969
1970 int __gpio_cansleep(unsigned gpio)
1971 {
1972         return gpiod_cansleep(gpio_to_desc(gpio));
1973 }
1974 EXPORT_SYMBOL_GPL(__gpio_cansleep);
1975
1976 /**
1977  * __gpio_to_irq() - return the IRQ corresponding to a GPIO
1978  * @gpio: gpio whose IRQ will be returned (already requested)
1979  * Context: any
1980  *
1981  * This is used directly or indirectly to implement gpio_to_irq().
1982  * It returns the number of the IRQ signaled by this (input) GPIO,
1983  * or a negative errno.
1984  */
1985 static int gpiod_to_irq(const struct gpio_desc *desc)
1986 {
1987         struct gpio_chip        *chip;
1988         int                     offset;
1989
1990         if (!desc)
1991                 return -EINVAL;
1992         chip = desc->chip;
1993         offset = gpio_chip_hwgpio(desc);
1994         return chip->to_irq ? chip->to_irq(chip, offset) : -ENXIO;
1995 }
1996
1997 int __gpio_to_irq(unsigned gpio)
1998 {
1999         return gpiod_to_irq(gpio_to_desc(gpio));
2000 }
2001 EXPORT_SYMBOL_GPL(__gpio_to_irq);
2002
2003
2004 /* There's no value in making it easy to inline GPIO calls that may sleep.
2005  * Common examples include ones connected to I2C or SPI chips.
2006  */
2007
2008 static int gpiod_get_value_cansleep(const struct gpio_desc *desc)
2009 {
2010         struct gpio_chip        *chip;
2011         int value;
2012         int offset;
2013
2014         might_sleep_if(extra_checks);
2015         if (!desc)
2016                 return 0;
2017         chip = desc->chip;
2018         offset = gpio_chip_hwgpio(desc);
2019         value = chip->get ? chip->get(chip, offset) : 0;
2020         trace_gpio_value(desc_to_gpio(desc), 1, value);
2021         return value;
2022 }
2023
2024 int gpio_get_value_cansleep(unsigned gpio)
2025 {
2026         return gpiod_get_value_cansleep(gpio_to_desc(gpio));
2027 }
2028 EXPORT_SYMBOL_GPL(gpio_get_value_cansleep);
2029
2030 static void gpiod_set_value_cansleep(struct gpio_desc *desc, int value)
2031 {
2032         struct gpio_chip        *chip;
2033
2034         might_sleep_if(extra_checks);
2035         if (!desc)
2036                 return;
2037         chip = desc->chip;
2038         trace_gpio_value(desc_to_gpio(desc), 0, value);
2039         if (test_bit(FLAG_OPEN_DRAIN,  &desc->flags))
2040                 _gpio_set_open_drain_value(desc, value);
2041         else if (test_bit(FLAG_OPEN_SOURCE,  &desc->flags))
2042                 _gpio_set_open_source_value(desc, value);
2043         else
2044                 chip->set(chip, gpio_chip_hwgpio(desc), value);
2045 }
2046
2047 void gpio_set_value_cansleep(unsigned gpio, int value)
2048 {
2049         return gpiod_set_value_cansleep(gpio_to_desc(gpio), value);
2050 }
2051 EXPORT_SYMBOL_GPL(gpio_set_value_cansleep);
2052
2053 #ifdef CONFIG_DEBUG_FS
2054
2055 static void gpiolib_dbg_show(struct seq_file *s, struct gpio_chip *chip)
2056 {
2057         unsigned                i;
2058         unsigned                gpio = chip->base;
2059         struct gpio_desc        *gdesc = &chip->desc[0];
2060         int                     is_out;
2061
2062         for (i = 0; i < chip->ngpio; i++, gpio++, gdesc++) {
2063                 if (!test_bit(FLAG_REQUESTED, &gdesc->flags))
2064                         continue;
2065
2066                 gpiod_get_direction(gdesc);
2067                 is_out = test_bit(FLAG_IS_OUT, &gdesc->flags);
2068                 seq_printf(s, " gpio-%-3d (%-20.20s) %s %s",
2069                         gpio, gdesc->label,
2070                         is_out ? "out" : "in ",
2071                         chip->get
2072                                 ? (chip->get(chip, i) ? "hi" : "lo")
2073                                 : "?  ");
2074                 seq_printf(s, "\n");
2075         }
2076 }
2077
2078 static void *gpiolib_seq_start(struct seq_file *s, loff_t *pos)
2079 {
2080         unsigned long flags;
2081         struct gpio_chip *chip = NULL;
2082         loff_t index = *pos;
2083
2084         s->private = "";
2085
2086         spin_lock_irqsave(&gpio_lock, flags);
2087         list_for_each_entry(chip, &gpio_chips, list)
2088                 if (index-- == 0) {
2089                         spin_unlock_irqrestore(&gpio_lock, flags);
2090                         return chip;
2091                 }
2092         spin_unlock_irqrestore(&gpio_lock, flags);
2093
2094         return NULL;
2095 }
2096
2097 static void *gpiolib_seq_next(struct seq_file *s, void *v, loff_t *pos)
2098 {
2099         unsigned long flags;
2100         struct gpio_chip *chip = v;
2101         void *ret = NULL;
2102
2103         spin_lock_irqsave(&gpio_lock, flags);
2104         if (list_is_last(&chip->list, &gpio_chips))
2105                 ret = NULL;
2106         else
2107                 ret = list_entry(chip->list.next, struct gpio_chip, list);
2108         spin_unlock_irqrestore(&gpio_lock, flags);
2109
2110         s->private = "\n";
2111         ++*pos;
2112
2113         return ret;
2114 }
2115
2116 static void gpiolib_seq_stop(struct seq_file *s, void *v)
2117 {
2118 }
2119
2120 static int gpiolib_seq_show(struct seq_file *s, void *v)
2121 {
2122         struct gpio_chip *chip = v;
2123         struct device *dev;
2124
2125         seq_printf(s, "%sGPIOs %d-%d", (char *)s->private,
2126                         chip->base, chip->base + chip->ngpio - 1);
2127         dev = chip->dev;
2128         if (dev)
2129                 seq_printf(s, ", %s/%s", dev->bus ? dev->bus->name : "no-bus",
2130                         dev_name(dev));
2131         if (chip->label)
2132                 seq_printf(s, ", %s", chip->label);
2133         if (chip->can_sleep)
2134                 seq_printf(s, ", can sleep");
2135         seq_printf(s, ":\n");
2136
2137         if (chip->dbg_show)
2138                 chip->dbg_show(s, chip);
2139         else
2140                 gpiolib_dbg_show(s, chip);
2141
2142         return 0;
2143 }
2144
2145 static const struct seq_operations gpiolib_seq_ops = {
2146         .start = gpiolib_seq_start,
2147         .next = gpiolib_seq_next,
2148         .stop = gpiolib_seq_stop,
2149         .show = gpiolib_seq_show,
2150 };
2151
2152 static int gpiolib_open(struct inode *inode, struct file *file)
2153 {
2154         return seq_open(file, &gpiolib_seq_ops);
2155 }
2156
2157 static const struct file_operations gpiolib_operations = {
2158         .owner          = THIS_MODULE,
2159         .open           = gpiolib_open,
2160         .read           = seq_read,
2161         .llseek         = seq_lseek,
2162         .release        = seq_release,
2163 };
2164
2165 static int __init gpiolib_debugfs_init(void)
2166 {
2167         /* /sys/kernel/debug/gpio */
2168         (void) debugfs_create_file("gpio", S_IFREG | S_IRUGO,
2169                                 NULL, NULL, &gpiolib_operations);
2170         return 0;
2171 }
2172 subsys_initcall(gpiolib_debugfs_init);
2173
2174 #endif  /* DEBUG_FS */