• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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