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