1 #include <linux/idr.h>
2 #include <linux/mutex.h>
3 #include <linux/device.h>
4 #include <linux/sysfs.h>
5 #include <linux/gpio/consumer.h>
6 #include <linux/gpio/driver.h>
7 #include <linux/interrupt.h>
8 #include <linux/kdev_t.h>
9
10 #include "gpiolib.h"
11
12 static DEFINE_IDR(dirent_idr);
13
14
15 /* lock protects against unexport_gpio() being called while
16 * sysfs files are active.
17 */
18 static DEFINE_MUTEX(sysfs_lock);
19
20 /*
21 * /sys/class/gpio/gpioN... only for GPIOs that are exported
22 * /direction
23 * * MAY BE OMITTED if kernel won't allow direction changes
24 * * is read/write as "in" or "out"
25 * * may also be written as "high" or "low", initializing
26 * output value as specified ("out" implies "low")
27 * /value
28 * * always readable, subject to hardware behavior
29 * * may be writable, as zero/nonzero
30 * /edge
31 * * configures behavior of poll(2) on /value
32 * * available only if pin can generate IRQs on input
33 * * is read/write as "none", "falling", "rising", or "both"
34 * /active_low
35 * * configures polarity of /value
36 * * is read/write as zero/nonzero
37 * * also affects existing and subsequent "falling" and "rising"
38 * /edge configuration
39 */
40
gpio_direction_show(struct device * dev,struct device_attribute * attr,char * buf)41 static ssize_t gpio_direction_show(struct device *dev,
42 struct device_attribute *attr, char *buf)
43 {
44 const struct gpio_desc *desc = dev_get_drvdata(dev);
45 ssize_t status;
46
47 mutex_lock(&sysfs_lock);
48
49 if (!test_bit(FLAG_EXPORT, &desc->flags)) {
50 status = -EIO;
51 } else {
52 gpiod_get_direction(desc);
53 status = sprintf(buf, "%s\n",
54 test_bit(FLAG_IS_OUT, &desc->flags)
55 ? "out" : "in");
56 }
57
58 mutex_unlock(&sysfs_lock);
59 return status;
60 }
61
gpio_direction_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)62 static ssize_t gpio_direction_store(struct device *dev,
63 struct device_attribute *attr, const char *buf, size_t size)
64 {
65 struct gpio_desc *desc = dev_get_drvdata(dev);
66 ssize_t status;
67
68 mutex_lock(&sysfs_lock);
69
70 if (!test_bit(FLAG_EXPORT, &desc->flags))
71 status = -EIO;
72 else if (sysfs_streq(buf, "high"))
73 status = gpiod_direction_output_raw(desc, 1);
74 else if (sysfs_streq(buf, "out") || sysfs_streq(buf, "low"))
75 status = gpiod_direction_output_raw(desc, 0);
76 else if (sysfs_streq(buf, "in"))
77 status = gpiod_direction_input(desc);
78 else
79 status = -EINVAL;
80
81 mutex_unlock(&sysfs_lock);
82 return status ? : size;
83 }
84
85 static /* const */ DEVICE_ATTR(direction, 0644,
86 gpio_direction_show, gpio_direction_store);
87
gpio_value_show(struct device * dev,struct device_attribute * attr,char * buf)88 static ssize_t gpio_value_show(struct device *dev,
89 struct device_attribute *attr, char *buf)
90 {
91 struct gpio_desc *desc = dev_get_drvdata(dev);
92 ssize_t status;
93
94 mutex_lock(&sysfs_lock);
95
96 if (!test_bit(FLAG_EXPORT, &desc->flags))
97 status = -EIO;
98 else
99 status = sprintf(buf, "%d\n", gpiod_get_value_cansleep(desc));
100
101 mutex_unlock(&sysfs_lock);
102 return status;
103 }
104
gpio_value_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)105 static ssize_t gpio_value_store(struct device *dev,
106 struct device_attribute *attr, const char *buf, size_t size)
107 {
108 struct gpio_desc *desc = dev_get_drvdata(dev);
109 ssize_t status;
110
111 mutex_lock(&sysfs_lock);
112
113 if (!test_bit(FLAG_EXPORT, &desc->flags))
114 status = -EIO;
115 else if (!test_bit(FLAG_IS_OUT, &desc->flags))
116 status = -EPERM;
117 else {
118 long value;
119
120 status = kstrtol(buf, 0, &value);
121 if (status == 0) {
122 gpiod_set_value_cansleep(desc, value);
123 status = size;
124 }
125 }
126
127 mutex_unlock(&sysfs_lock);
128 return status;
129 }
130
131 static DEVICE_ATTR(value, 0644,
132 gpio_value_show, gpio_value_store);
133
gpio_sysfs_irq(int irq,void * priv)134 static irqreturn_t gpio_sysfs_irq(int irq, void *priv)
135 {
136 struct kernfs_node *value_sd = priv;
137
138 sysfs_notify_dirent(value_sd);
139 return IRQ_HANDLED;
140 }
141
gpio_setup_irq(struct gpio_desc * desc,struct device * dev,unsigned long gpio_flags)142 static int gpio_setup_irq(struct gpio_desc *desc, struct device *dev,
143 unsigned long gpio_flags)
144 {
145 struct kernfs_node *value_sd;
146 unsigned long irq_flags;
147 int ret, irq, id;
148
149 if ((desc->flags & GPIO_TRIGGER_MASK) == gpio_flags)
150 return 0;
151
152 irq = gpiod_to_irq(desc);
153 if (irq < 0)
154 return -EIO;
155
156 id = desc->flags >> ID_SHIFT;
157 value_sd = idr_find(&dirent_idr, id);
158 if (value_sd)
159 free_irq(irq, value_sd);
160
161 desc->flags &= ~GPIO_TRIGGER_MASK;
162
163 if (!gpio_flags) {
164 gpio_unlock_as_irq(desc->chip, gpio_chip_hwgpio(desc));
165 ret = 0;
166 goto free_id;
167 }
168
169 irq_flags = IRQF_SHARED;
170 if (test_bit(FLAG_TRIG_FALL, &gpio_flags))
171 irq_flags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ?
172 IRQF_TRIGGER_RISING : IRQF_TRIGGER_FALLING;
173 if (test_bit(FLAG_TRIG_RISE, &gpio_flags))
174 irq_flags |= test_bit(FLAG_ACTIVE_LOW, &desc->flags) ?
175 IRQF_TRIGGER_FALLING : IRQF_TRIGGER_RISING;
176
177 if (!value_sd) {
178 value_sd = sysfs_get_dirent(dev->kobj.sd, "value");
179 if (!value_sd) {
180 ret = -ENODEV;
181 goto err_out;
182 }
183
184 ret = idr_alloc(&dirent_idr, value_sd, 1, 0, GFP_KERNEL);
185 if (ret < 0)
186 goto free_sd;
187 id = ret;
188
189 desc->flags &= GPIO_FLAGS_MASK;
190 desc->flags |= (unsigned long)id << ID_SHIFT;
191
192 if (desc->flags >> ID_SHIFT != id) {
193 ret = -ERANGE;
194 goto free_id;
195 }
196 }
197
198 ret = request_any_context_irq(irq, gpio_sysfs_irq, irq_flags,
199 "gpiolib", value_sd);
200 if (ret < 0)
201 goto free_id;
202
203 ret = gpio_lock_as_irq(desc->chip, gpio_chip_hwgpio(desc));
204 if (ret < 0) {
205 gpiod_warn(desc, "failed to flag the GPIO for IRQ\n");
206 goto free_id;
207 }
208
209 desc->flags |= gpio_flags;
210 return 0;
211
212 free_id:
213 idr_remove(&dirent_idr, id);
214 desc->flags &= GPIO_FLAGS_MASK;
215 free_sd:
216 if (value_sd)
217 sysfs_put(value_sd);
218 err_out:
219 return ret;
220 }
221
222 static const struct {
223 const char *name;
224 unsigned long flags;
225 } trigger_types[] = {
226 { "none", 0 },
227 { "falling", BIT(FLAG_TRIG_FALL) },
228 { "rising", BIT(FLAG_TRIG_RISE) },
229 { "both", BIT(FLAG_TRIG_FALL) | BIT(FLAG_TRIG_RISE) },
230 };
231
gpio_edge_show(struct device * dev,struct device_attribute * attr,char * buf)232 static ssize_t gpio_edge_show(struct device *dev,
233 struct device_attribute *attr, char *buf)
234 {
235 const struct gpio_desc *desc = dev_get_drvdata(dev);
236 ssize_t status;
237
238 mutex_lock(&sysfs_lock);
239
240 if (!test_bit(FLAG_EXPORT, &desc->flags))
241 status = -EIO;
242 else {
243 int i;
244
245 status = 0;
246 for (i = 0; i < ARRAY_SIZE(trigger_types); i++)
247 if ((desc->flags & GPIO_TRIGGER_MASK)
248 == trigger_types[i].flags) {
249 status = sprintf(buf, "%s\n",
250 trigger_types[i].name);
251 break;
252 }
253 }
254
255 mutex_unlock(&sysfs_lock);
256 return status;
257 }
258
gpio_edge_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)259 static ssize_t gpio_edge_store(struct device *dev,
260 struct device_attribute *attr, const char *buf, size_t size)
261 {
262 struct gpio_desc *desc = dev_get_drvdata(dev);
263 ssize_t status;
264 int i;
265
266 for (i = 0; i < ARRAY_SIZE(trigger_types); i++)
267 if (sysfs_streq(trigger_types[i].name, buf))
268 goto found;
269 return -EINVAL;
270
271 found:
272 mutex_lock(&sysfs_lock);
273
274 if (!test_bit(FLAG_EXPORT, &desc->flags))
275 status = -EIO;
276 else {
277 status = gpio_setup_irq(desc, dev, trigger_types[i].flags);
278 if (!status)
279 status = size;
280 }
281
282 mutex_unlock(&sysfs_lock);
283
284 return status;
285 }
286
287 static DEVICE_ATTR(edge, 0644, gpio_edge_show, gpio_edge_store);
288
sysfs_set_active_low(struct gpio_desc * desc,struct device * dev,int value)289 static int sysfs_set_active_low(struct gpio_desc *desc, struct device *dev,
290 int value)
291 {
292 int status = 0;
293
294 if (!!test_bit(FLAG_ACTIVE_LOW, &desc->flags) == !!value)
295 return 0;
296
297 if (value)
298 set_bit(FLAG_ACTIVE_LOW, &desc->flags);
299 else
300 clear_bit(FLAG_ACTIVE_LOW, &desc->flags);
301
302 /* reconfigure poll(2) support if enabled on one edge only */
303 if (dev != NULL && (!!test_bit(FLAG_TRIG_RISE, &desc->flags) ^
304 !!test_bit(FLAG_TRIG_FALL, &desc->flags))) {
305 unsigned long trigger_flags = desc->flags & GPIO_TRIGGER_MASK;
306
307 gpio_setup_irq(desc, dev, 0);
308 status = gpio_setup_irq(desc, dev, trigger_flags);
309 }
310
311 return status;
312 }
313
gpio_active_low_show(struct device * dev,struct device_attribute * attr,char * buf)314 static ssize_t gpio_active_low_show(struct device *dev,
315 struct device_attribute *attr, char *buf)
316 {
317 const struct gpio_desc *desc = dev_get_drvdata(dev);
318 ssize_t status;
319
320 mutex_lock(&sysfs_lock);
321
322 if (!test_bit(FLAG_EXPORT, &desc->flags))
323 status = -EIO;
324 else
325 status = sprintf(buf, "%d\n",
326 !!test_bit(FLAG_ACTIVE_LOW, &desc->flags));
327
328 mutex_unlock(&sysfs_lock);
329
330 return status;
331 }
332
gpio_active_low_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)333 static ssize_t gpio_active_low_store(struct device *dev,
334 struct device_attribute *attr, const char *buf, size_t size)
335 {
336 struct gpio_desc *desc = dev_get_drvdata(dev);
337 ssize_t status;
338
339 mutex_lock(&sysfs_lock);
340
341 if (!test_bit(FLAG_EXPORT, &desc->flags)) {
342 status = -EIO;
343 } else {
344 long value;
345
346 status = kstrtol(buf, 0, &value);
347 if (status == 0)
348 status = sysfs_set_active_low(desc, dev, value != 0);
349 }
350
351 mutex_unlock(&sysfs_lock);
352
353 return status ? : size;
354 }
355
356 static DEVICE_ATTR(active_low, 0644,
357 gpio_active_low_show, gpio_active_low_store);
358
359 static struct attribute *gpio_attrs[] = {
360 &dev_attr_value.attr,
361 &dev_attr_active_low.attr,
362 NULL,
363 };
364 ATTRIBUTE_GROUPS(gpio);
365
366 /*
367 * /sys/class/gpio/gpiochipN/
368 * /base ... matching gpio_chip.base (N)
369 * /label ... matching gpio_chip.label
370 * /ngpio ... matching gpio_chip.ngpio
371 */
372
chip_base_show(struct device * dev,struct device_attribute * attr,char * buf)373 static ssize_t chip_base_show(struct device *dev,
374 struct device_attribute *attr, char *buf)
375 {
376 const struct gpio_chip *chip = dev_get_drvdata(dev);
377
378 return sprintf(buf, "%d\n", chip->base);
379 }
380 static DEVICE_ATTR(base, 0444, chip_base_show, NULL);
381
chip_label_show(struct device * dev,struct device_attribute * attr,char * buf)382 static ssize_t chip_label_show(struct device *dev,
383 struct device_attribute *attr, char *buf)
384 {
385 const struct gpio_chip *chip = dev_get_drvdata(dev);
386
387 return sprintf(buf, "%s\n", chip->label ? : "");
388 }
389 static DEVICE_ATTR(label, 0444, chip_label_show, NULL);
390
chip_ngpio_show(struct device * dev,struct device_attribute * attr,char * buf)391 static ssize_t chip_ngpio_show(struct device *dev,
392 struct device_attribute *attr, char *buf)
393 {
394 const struct gpio_chip *chip = dev_get_drvdata(dev);
395
396 return sprintf(buf, "%u\n", chip->ngpio);
397 }
398 static DEVICE_ATTR(ngpio, 0444, chip_ngpio_show, NULL);
399
400 static struct attribute *gpiochip_attrs[] = {
401 &dev_attr_base.attr,
402 &dev_attr_label.attr,
403 &dev_attr_ngpio.attr,
404 NULL,
405 };
406 ATTRIBUTE_GROUPS(gpiochip);
407
408 /*
409 * /sys/class/gpio/export ... write-only
410 * integer N ... number of GPIO to export (full access)
411 * /sys/class/gpio/unexport ... write-only
412 * integer N ... number of GPIO to unexport
413 */
export_store(struct class * class,struct class_attribute * attr,const char * buf,size_t len)414 static ssize_t export_store(struct class *class,
415 struct class_attribute *attr,
416 const char *buf, size_t len)
417 {
418 long gpio;
419 struct gpio_desc *desc;
420 int status;
421
422 status = kstrtol(buf, 0, &gpio);
423 if (status < 0)
424 goto done;
425
426 desc = gpio_to_desc(gpio);
427 /* reject invalid GPIOs */
428 if (!desc) {
429 pr_warn("%s: invalid GPIO %ld\n", __func__, gpio);
430 return -EINVAL;
431 }
432
433 /* No extra locking here; FLAG_SYSFS just signifies that the
434 * request and export were done by on behalf of userspace, so
435 * they may be undone on its behalf too.
436 */
437
438 status = gpiod_request(desc, "sysfs");
439 if (status < 0) {
440 if (status == -EPROBE_DEFER)
441 status = -ENODEV;
442 goto done;
443 }
444 status = gpiod_export(desc, true);
445 if (status < 0)
446 gpiod_free(desc);
447 else
448 set_bit(FLAG_SYSFS, &desc->flags);
449
450 done:
451 if (status)
452 pr_debug("%s: status %d\n", __func__, status);
453 return status ? : len;
454 }
455
unexport_store(struct class * class,struct class_attribute * attr,const char * buf,size_t len)456 static ssize_t unexport_store(struct class *class,
457 struct class_attribute *attr,
458 const char *buf, size_t len)
459 {
460 long gpio;
461 struct gpio_desc *desc;
462 int status;
463
464 status = kstrtol(buf, 0, &gpio);
465 if (status < 0)
466 goto done;
467
468 desc = gpio_to_desc(gpio);
469 /* reject bogus commands (gpio_unexport ignores them) */
470 if (!desc) {
471 pr_warn("%s: invalid GPIO %ld\n", __func__, gpio);
472 return -EINVAL;
473 }
474
475 status = -EINVAL;
476
477 /* No extra locking here; FLAG_SYSFS just signifies that the
478 * request and export were done by on behalf of userspace, so
479 * they may be undone on its behalf too.
480 */
481 if (test_and_clear_bit(FLAG_SYSFS, &desc->flags)) {
482 status = 0;
483 gpiod_free(desc);
484 }
485 done:
486 if (status)
487 pr_debug("%s: status %d\n", __func__, status);
488 return status ? : len;
489 }
490
491 static struct class_attribute gpio_class_attrs[] = {
492 __ATTR(export, 0200, NULL, export_store),
493 __ATTR(unexport, 0200, NULL, unexport_store),
494 __ATTR_NULL,
495 };
496
497 static struct class gpio_class = {
498 .name = "gpio",
499 .owner = THIS_MODULE,
500
501 .class_attrs = gpio_class_attrs,
502 };
503
504
505 /**
506 * gpiod_export - export a GPIO through sysfs
507 * @gpio: gpio to make available, already requested
508 * @direction_may_change: true if userspace may change gpio direction
509 * Context: arch_initcall or later
510 *
511 * When drivers want to make a GPIO accessible to userspace after they
512 * have requested it -- perhaps while debugging, or as part of their
513 * public interface -- they may use this routine. If the GPIO can
514 * change direction (some can't) and the caller allows it, userspace
515 * will see "direction" sysfs attribute which may be used to change
516 * the gpio's direction. A "value" attribute will always be provided.
517 *
518 * Returns zero on success, else an error.
519 */
gpiod_export(struct gpio_desc * desc,bool direction_may_change)520 int gpiod_export(struct gpio_desc *desc, bool direction_may_change)
521 {
522 struct gpio_chip *chip;
523 unsigned long flags;
524 int status;
525 const char *ioname = NULL;
526 struct device *dev;
527 int offset;
528
529 /* can't export until sysfs is available ... */
530 if (!gpio_class.p) {
531 pr_debug("%s: called too early!\n", __func__);
532 return -ENOENT;
533 }
534
535 if (!desc) {
536 pr_debug("%s: invalid gpio descriptor\n", __func__);
537 return -EINVAL;
538 }
539
540 chip = desc->chip;
541
542 mutex_lock(&sysfs_lock);
543
544 /* check if chip is being removed */
545 if (!chip || !chip->exported) {
546 status = -ENODEV;
547 goto fail_unlock;
548 }
549
550 spin_lock_irqsave(&gpio_lock, flags);
551 if (!test_bit(FLAG_REQUESTED, &desc->flags) ||
552 test_bit(FLAG_EXPORT, &desc->flags)) {
553 spin_unlock_irqrestore(&gpio_lock, flags);
554 gpiod_dbg(desc, "%s: unavailable (requested=%d, exported=%d)\n",
555 __func__,
556 test_bit(FLAG_REQUESTED, &desc->flags),
557 test_bit(FLAG_EXPORT, &desc->flags));
558 status = -EPERM;
559 goto fail_unlock;
560 }
561
562 if (!desc->chip->direction_input || !desc->chip->direction_output)
563 direction_may_change = false;
564 spin_unlock_irqrestore(&gpio_lock, flags);
565
566 offset = gpio_chip_hwgpio(desc);
567 if (desc->chip->names && desc->chip->names[offset])
568 ioname = desc->chip->names[offset];
569
570 dev = device_create_with_groups(&gpio_class, desc->chip->dev,
571 MKDEV(0, 0), desc, gpio_groups,
572 ioname ? ioname : "gpio%u",
573 desc_to_gpio(desc));
574 if (IS_ERR(dev)) {
575 status = PTR_ERR(dev);
576 goto fail_unlock;
577 }
578
579 if (direction_may_change) {
580 status = device_create_file(dev, &dev_attr_direction);
581 if (status)
582 goto fail_unregister_device;
583 }
584
585 if (gpiod_to_irq(desc) >= 0 && (direction_may_change ||
586 !test_bit(FLAG_IS_OUT, &desc->flags))) {
587 status = device_create_file(dev, &dev_attr_edge);
588 if (status)
589 goto fail_remove_attr_direction;
590 }
591
592 set_bit(FLAG_EXPORT, &desc->flags);
593 mutex_unlock(&sysfs_lock);
594 return 0;
595
596 fail_remove_attr_direction:
597 device_remove_file(dev, &dev_attr_direction);
598 fail_unregister_device:
599 device_unregister(dev);
600 fail_unlock:
601 mutex_unlock(&sysfs_lock);
602 gpiod_dbg(desc, "%s: status %d\n", __func__, status);
603 return status;
604 }
605 EXPORT_SYMBOL_GPL(gpiod_export);
606
match_export(struct device * dev,const void * data)607 static int match_export(struct device *dev, const void *data)
608 {
609 return dev_get_drvdata(dev) == data;
610 }
611
612 /**
613 * gpiod_export_link - create a sysfs link to an exported GPIO node
614 * @dev: device under which to create symlink
615 * @name: name of the symlink
616 * @gpio: gpio to create symlink to, already exported
617 *
618 * Set up a symlink from /sys/.../dev/name to /sys/class/gpio/gpioN
619 * node. Caller is responsible for unlinking.
620 *
621 * Returns zero on success, else an error.
622 */
gpiod_export_link(struct device * dev,const char * name,struct gpio_desc * desc)623 int gpiod_export_link(struct device *dev, const char *name,
624 struct gpio_desc *desc)
625 {
626 int status = -EINVAL;
627
628 if (!desc) {
629 pr_warn("%s: invalid GPIO\n", __func__);
630 return -EINVAL;
631 }
632
633 mutex_lock(&sysfs_lock);
634
635 if (test_bit(FLAG_EXPORT, &desc->flags)) {
636 struct device *tdev;
637
638 tdev = class_find_device(&gpio_class, NULL, desc, match_export);
639 if (tdev != NULL) {
640 status = sysfs_create_link(&dev->kobj, &tdev->kobj,
641 name);
642 put_device(tdev);
643 } else {
644 status = -ENODEV;
645 }
646 }
647
648 mutex_unlock(&sysfs_lock);
649
650 if (status)
651 gpiod_dbg(desc, "%s: status %d\n", __func__, status);
652
653 return status;
654 }
655 EXPORT_SYMBOL_GPL(gpiod_export_link);
656
657 /**
658 * gpiod_sysfs_set_active_low - set the polarity of gpio sysfs value
659 * @gpio: gpio to change
660 * @value: non-zero to use active low, i.e. inverted values
661 *
662 * Set the polarity of /sys/class/gpio/gpioN/value sysfs attribute.
663 * The GPIO does not have to be exported yet. If poll(2) support has
664 * been enabled for either rising or falling edge, it will be
665 * reconfigured to follow the new polarity.
666 *
667 * Returns zero on success, else an error.
668 */
gpiod_sysfs_set_active_low(struct gpio_desc * desc,int value)669 int gpiod_sysfs_set_active_low(struct gpio_desc *desc, int value)
670 {
671 struct device *dev = NULL;
672 int status = -EINVAL;
673
674 if (!desc) {
675 pr_warn("%s: invalid GPIO\n", __func__);
676 return -EINVAL;
677 }
678
679 mutex_lock(&sysfs_lock);
680
681 if (test_bit(FLAG_EXPORT, &desc->flags)) {
682 dev = class_find_device(&gpio_class, NULL, desc, match_export);
683 if (dev == NULL) {
684 status = -ENODEV;
685 goto unlock;
686 }
687 }
688
689 status = sysfs_set_active_low(desc, dev, value);
690 put_device(dev);
691 unlock:
692 mutex_unlock(&sysfs_lock);
693
694 if (status)
695 gpiod_dbg(desc, "%s: status %d\n", __func__, status);
696
697 return status;
698 }
699 EXPORT_SYMBOL_GPL(gpiod_sysfs_set_active_low);
700
701 /**
702 * gpiod_unexport - reverse effect of gpio_export()
703 * @gpio: gpio to make unavailable
704 *
705 * This is implicit on gpio_free().
706 */
gpiod_unexport(struct gpio_desc * desc)707 void gpiod_unexport(struct gpio_desc *desc)
708 {
709 int status = 0;
710 struct device *dev = NULL;
711
712 if (!desc) {
713 pr_warn("%s: invalid GPIO\n", __func__);
714 return;
715 }
716
717 mutex_lock(&sysfs_lock);
718
719 if (test_bit(FLAG_EXPORT, &desc->flags)) {
720
721 dev = class_find_device(&gpio_class, NULL, desc, match_export);
722 if (dev) {
723 gpio_setup_irq(desc, dev, 0);
724 clear_bit(FLAG_EXPORT, &desc->flags);
725 } else
726 status = -ENODEV;
727 }
728
729 mutex_unlock(&sysfs_lock);
730
731 if (dev) {
732 device_remove_file(dev, &dev_attr_edge);
733 device_remove_file(dev, &dev_attr_direction);
734 device_unregister(dev);
735 put_device(dev);
736 }
737
738 if (status)
739 gpiod_dbg(desc, "%s: status %d\n", __func__, status);
740 }
741 EXPORT_SYMBOL_GPL(gpiod_unexport);
742
gpiochip_export(struct gpio_chip * chip)743 int gpiochip_export(struct gpio_chip *chip)
744 {
745 int status;
746 struct device *dev;
747
748 /* Many systems register gpio chips for SOC support very early,
749 * before driver model support is available. In those cases we
750 * export this later, in gpiolib_sysfs_init() ... here we just
751 * verify that _some_ field of gpio_class got initialized.
752 */
753 if (!gpio_class.p)
754 return 0;
755
756 /* use chip->base for the ID; it's already known to be unique */
757 mutex_lock(&sysfs_lock);
758 dev = device_create_with_groups(&gpio_class, chip->dev, MKDEV(0, 0),
759 chip, gpiochip_groups,
760 "gpiochip%d", chip->base);
761 if (IS_ERR(dev))
762 status = PTR_ERR(dev);
763 else
764 status = 0;
765 chip->exported = (status == 0);
766 mutex_unlock(&sysfs_lock);
767
768 if (status)
769 chip_dbg(chip, "%s: status %d\n", __func__, status);
770
771 return status;
772 }
773
gpiochip_unexport(struct gpio_chip * chip)774 void gpiochip_unexport(struct gpio_chip *chip)
775 {
776 int status;
777 struct device *dev;
778 struct gpio_desc *desc;
779 unsigned int i;
780
781 mutex_lock(&sysfs_lock);
782 dev = class_find_device(&gpio_class, NULL, chip, match_export);
783 if (dev) {
784 put_device(dev);
785 device_unregister(dev);
786 /* prevent further gpiod exports */
787 chip->exported = false;
788 status = 0;
789 } else
790 status = -ENODEV;
791 mutex_unlock(&sysfs_lock);
792
793 if (status)
794 chip_dbg(chip, "%s: status %d\n", __func__, status);
795
796 /* unregister gpiod class devices owned by sysfs */
797 for (i = 0; i < chip->ngpio; i++) {
798 desc = &chip->desc[i];
799 if (test_and_clear_bit(FLAG_SYSFS, &desc->flags))
800 gpiod_free(desc);
801 }
802 }
803
gpiolib_sysfs_init(void)804 static int __init gpiolib_sysfs_init(void)
805 {
806 int status;
807 unsigned long flags;
808 struct gpio_chip *chip;
809
810 status = class_register(&gpio_class);
811 if (status < 0)
812 return status;
813
814 /* Scan and register the gpio_chips which registered very
815 * early (e.g. before the class_register above was called).
816 *
817 * We run before arch_initcall() so chip->dev nodes can have
818 * registered, and so arch_initcall() can always gpio_export().
819 */
820 spin_lock_irqsave(&gpio_lock, flags);
821 list_for_each_entry(chip, &gpio_chips, list) {
822 if (chip->exported)
823 continue;
824
825 /*
826 * TODO we yield gpio_lock here because gpiochip_export()
827 * acquires a mutex. This is unsafe and needs to be fixed.
828 *
829 * Also it would be nice to use gpiochip_find() here so we
830 * can keep gpio_chips local to gpiolib.c, but the yield of
831 * gpio_lock prevents us from doing this.
832 */
833 spin_unlock_irqrestore(&gpio_lock, flags);
834 status = gpiochip_export(chip);
835 spin_lock_irqsave(&gpio_lock, flags);
836 }
837 spin_unlock_irqrestore(&gpio_lock, flags);
838
839
840 return status;
841 }
842 postcore_initcall(gpiolib_sysfs_init);
843