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 41 static ssize_t gpio_direction_show(struct device *dev, 42 struct device_attribute *attr, char *buf) 43 { 44 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 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 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 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 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 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 gpiochip_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 = gpiochip_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 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 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 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 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 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 umode_t gpio_is_visible(struct kobject *kobj, struct attribute *attr, 360 int n) 361 { 362 struct device *dev = container_of(kobj, struct device, kobj); 363 struct gpio_desc *desc = dev_get_drvdata(dev); 364 umode_t mode = attr->mode; 365 bool show_direction = test_bit(FLAG_SYSFS_DIR, &desc->flags); 366 367 if (attr == &dev_attr_direction.attr) { 368 if (!show_direction) 369 mode = 0; 370 } else if (attr == &dev_attr_edge.attr) { 371 if (gpiod_to_irq(desc) < 0) 372 mode = 0; 373 if (!show_direction && test_bit(FLAG_IS_OUT, &desc->flags)) 374 mode = 0; 375 } 376 377 return mode; 378 } 379 380 static struct attribute *gpio_attrs[] = { 381 &dev_attr_direction.attr, 382 &dev_attr_edge.attr, 383 &dev_attr_value.attr, 384 &dev_attr_active_low.attr, 385 NULL, 386 }; 387 388 static const struct attribute_group gpio_group = { 389 .attrs = gpio_attrs, 390 .is_visible = gpio_is_visible, 391 }; 392 393 static const struct attribute_group *gpio_groups[] = { 394 &gpio_group, 395 NULL 396 }; 397 398 /* 399 * /sys/class/gpio/gpiochipN/ 400 * /base ... matching gpio_chip.base (N) 401 * /label ... matching gpio_chip.label 402 * /ngpio ... matching gpio_chip.ngpio 403 */ 404 405 static ssize_t chip_base_show(struct device *dev, 406 struct device_attribute *attr, char *buf) 407 { 408 const struct gpio_chip *chip = dev_get_drvdata(dev); 409 410 return sprintf(buf, "%d\n", chip->base); 411 } 412 static DEVICE_ATTR(base, 0444, chip_base_show, NULL); 413 414 static ssize_t chip_label_show(struct device *dev, 415 struct device_attribute *attr, char *buf) 416 { 417 const struct gpio_chip *chip = dev_get_drvdata(dev); 418 419 return sprintf(buf, "%s\n", chip->label ? : ""); 420 } 421 static DEVICE_ATTR(label, 0444, chip_label_show, NULL); 422 423 static ssize_t chip_ngpio_show(struct device *dev, 424 struct device_attribute *attr, char *buf) 425 { 426 const struct gpio_chip *chip = dev_get_drvdata(dev); 427 428 return sprintf(buf, "%u\n", chip->ngpio); 429 } 430 static DEVICE_ATTR(ngpio, 0444, chip_ngpio_show, NULL); 431 432 static struct attribute *gpiochip_attrs[] = { 433 &dev_attr_base.attr, 434 &dev_attr_label.attr, 435 &dev_attr_ngpio.attr, 436 NULL, 437 }; 438 ATTRIBUTE_GROUPS(gpiochip); 439 440 /* 441 * /sys/class/gpio/export ... write-only 442 * integer N ... number of GPIO to export (full access) 443 * /sys/class/gpio/unexport ... write-only 444 * integer N ... number of GPIO to unexport 445 */ 446 static ssize_t export_store(struct class *class, 447 struct class_attribute *attr, 448 const char *buf, size_t len) 449 { 450 long gpio; 451 struct gpio_desc *desc; 452 int status; 453 454 status = kstrtol(buf, 0, &gpio); 455 if (status < 0) 456 goto done; 457 458 desc = gpio_to_desc(gpio); 459 /* reject invalid GPIOs */ 460 if (!desc) { 461 pr_warn("%s: invalid GPIO %ld\n", __func__, gpio); 462 return -EINVAL; 463 } 464 465 /* No extra locking here; FLAG_SYSFS just signifies that the 466 * request and export were done by on behalf of userspace, so 467 * they may be undone on its behalf too. 468 */ 469 470 status = gpiod_request(desc, "sysfs"); 471 if (status < 0) { 472 if (status == -EPROBE_DEFER) 473 status = -ENODEV; 474 goto done; 475 } 476 status = gpiod_export(desc, true); 477 if (status < 0) 478 gpiod_free(desc); 479 else 480 set_bit(FLAG_SYSFS, &desc->flags); 481 482 done: 483 if (status) 484 pr_debug("%s: status %d\n", __func__, status); 485 return status ? : len; 486 } 487 488 static ssize_t unexport_store(struct class *class, 489 struct class_attribute *attr, 490 const char *buf, size_t len) 491 { 492 long gpio; 493 struct gpio_desc *desc; 494 int status; 495 496 status = kstrtol(buf, 0, &gpio); 497 if (status < 0) 498 goto done; 499 500 desc = gpio_to_desc(gpio); 501 /* reject bogus commands (gpio_unexport ignores them) */ 502 if (!desc) { 503 pr_warn("%s: invalid GPIO %ld\n", __func__, gpio); 504 return -EINVAL; 505 } 506 507 status = -EINVAL; 508 509 /* No extra locking here; FLAG_SYSFS just signifies that the 510 * request and export were done by on behalf of userspace, so 511 * they may be undone on its behalf too. 512 */ 513 if (test_and_clear_bit(FLAG_SYSFS, &desc->flags)) { 514 status = 0; 515 gpiod_free(desc); 516 } 517 done: 518 if (status) 519 pr_debug("%s: status %d\n", __func__, status); 520 return status ? : len; 521 } 522 523 static struct class_attribute gpio_class_attrs[] = { 524 __ATTR(export, 0200, NULL, export_store), 525 __ATTR(unexport, 0200, NULL, unexport_store), 526 __ATTR_NULL, 527 }; 528 529 static struct class gpio_class = { 530 .name = "gpio", 531 .owner = THIS_MODULE, 532 533 .class_attrs = gpio_class_attrs, 534 }; 535 536 537 /** 538 * gpiod_export - export a GPIO through sysfs 539 * @gpio: gpio to make available, already requested 540 * @direction_may_change: true if userspace may change gpio direction 541 * Context: arch_initcall or later 542 * 543 * When drivers want to make a GPIO accessible to userspace after they 544 * have requested it -- perhaps while debugging, or as part of their 545 * public interface -- they may use this routine. If the GPIO can 546 * change direction (some can't) and the caller allows it, userspace 547 * will see "direction" sysfs attribute which may be used to change 548 * the gpio's direction. A "value" attribute will always be provided. 549 * 550 * Returns zero on success, else an error. 551 */ 552 int gpiod_export(struct gpio_desc *desc, bool direction_may_change) 553 { 554 struct gpio_chip *chip; 555 unsigned long flags; 556 int status; 557 const char *ioname = NULL; 558 struct device *dev; 559 int offset; 560 561 /* can't export until sysfs is available ... */ 562 if (!gpio_class.p) { 563 pr_debug("%s: called too early!\n", __func__); 564 return -ENOENT; 565 } 566 567 if (!desc) { 568 pr_debug("%s: invalid gpio descriptor\n", __func__); 569 return -EINVAL; 570 } 571 572 chip = desc->chip; 573 574 mutex_lock(&sysfs_lock); 575 576 /* check if chip is being removed */ 577 if (!chip || !chip->exported) { 578 status = -ENODEV; 579 goto fail_unlock; 580 } 581 582 spin_lock_irqsave(&gpio_lock, flags); 583 if (!test_bit(FLAG_REQUESTED, &desc->flags) || 584 test_bit(FLAG_EXPORT, &desc->flags)) { 585 spin_unlock_irqrestore(&gpio_lock, flags); 586 gpiod_dbg(desc, "%s: unavailable (requested=%d, exported=%d)\n", 587 __func__, 588 test_bit(FLAG_REQUESTED, &desc->flags), 589 test_bit(FLAG_EXPORT, &desc->flags)); 590 status = -EPERM; 591 goto fail_unlock; 592 } 593 594 if (desc->chip->direction_input && desc->chip->direction_output && 595 direction_may_change) { 596 set_bit(FLAG_SYSFS_DIR, &desc->flags); 597 } 598 599 spin_unlock_irqrestore(&gpio_lock, flags); 600 601 offset = gpio_chip_hwgpio(desc); 602 if (desc->chip->names && desc->chip->names[offset]) 603 ioname = desc->chip->names[offset]; 604 605 dev = device_create_with_groups(&gpio_class, desc->chip->dev, 606 MKDEV(0, 0), desc, gpio_groups, 607 ioname ? ioname : "gpio%u", 608 desc_to_gpio(desc)); 609 if (IS_ERR(dev)) { 610 status = PTR_ERR(dev); 611 goto fail_unlock; 612 } 613 614 set_bit(FLAG_EXPORT, &desc->flags); 615 mutex_unlock(&sysfs_lock); 616 return 0; 617 618 fail_unlock: 619 mutex_unlock(&sysfs_lock); 620 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 621 return status; 622 } 623 EXPORT_SYMBOL_GPL(gpiod_export); 624 625 static int match_export(struct device *dev, const void *data) 626 { 627 return dev_get_drvdata(dev) == data; 628 } 629 630 /** 631 * gpiod_export_link - create a sysfs link to an exported GPIO node 632 * @dev: device under which to create symlink 633 * @name: name of the symlink 634 * @gpio: gpio to create symlink to, already exported 635 * 636 * Set up a symlink from /sys/.../dev/name to /sys/class/gpio/gpioN 637 * node. Caller is responsible for unlinking. 638 * 639 * Returns zero on success, else an error. 640 */ 641 int gpiod_export_link(struct device *dev, const char *name, 642 struct gpio_desc *desc) 643 { 644 int status = -EINVAL; 645 646 if (!desc) { 647 pr_warn("%s: invalid GPIO\n", __func__); 648 return -EINVAL; 649 } 650 651 mutex_lock(&sysfs_lock); 652 653 if (test_bit(FLAG_EXPORT, &desc->flags)) { 654 struct device *tdev; 655 656 tdev = class_find_device(&gpio_class, NULL, desc, match_export); 657 if (tdev != NULL) { 658 status = sysfs_create_link(&dev->kobj, &tdev->kobj, 659 name); 660 put_device(tdev); 661 } else { 662 status = -ENODEV; 663 } 664 } 665 666 mutex_unlock(&sysfs_lock); 667 668 if (status) 669 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 670 671 return status; 672 } 673 EXPORT_SYMBOL_GPL(gpiod_export_link); 674 675 /** 676 * gpiod_sysfs_set_active_low - set the polarity of gpio sysfs value 677 * @gpio: gpio to change 678 * @value: non-zero to use active low, i.e. inverted values 679 * 680 * Set the polarity of /sys/class/gpio/gpioN/value sysfs attribute. 681 * The GPIO does not have to be exported yet. If poll(2) support has 682 * been enabled for either rising or falling edge, it will be 683 * reconfigured to follow the new polarity. 684 * 685 * Returns zero on success, else an error. 686 */ 687 int gpiod_sysfs_set_active_low(struct gpio_desc *desc, int value) 688 { 689 struct device *dev = NULL; 690 int status = -EINVAL; 691 692 if (!desc) { 693 pr_warn("%s: invalid GPIO\n", __func__); 694 return -EINVAL; 695 } 696 697 mutex_lock(&sysfs_lock); 698 699 if (test_bit(FLAG_EXPORT, &desc->flags)) { 700 dev = class_find_device(&gpio_class, NULL, desc, match_export); 701 if (dev == NULL) { 702 status = -ENODEV; 703 goto unlock; 704 } 705 } 706 707 status = sysfs_set_active_low(desc, dev, value); 708 put_device(dev); 709 unlock: 710 mutex_unlock(&sysfs_lock); 711 712 if (status) 713 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 714 715 return status; 716 } 717 EXPORT_SYMBOL_GPL(gpiod_sysfs_set_active_low); 718 719 /** 720 * gpiod_unexport - reverse effect of gpio_export() 721 * @gpio: gpio to make unavailable 722 * 723 * This is implicit on gpio_free(). 724 */ 725 void gpiod_unexport(struct gpio_desc *desc) 726 { 727 int status = 0; 728 struct device *dev = NULL; 729 730 if (!desc) { 731 pr_warn("%s: invalid GPIO\n", __func__); 732 return; 733 } 734 735 mutex_lock(&sysfs_lock); 736 737 if (test_bit(FLAG_EXPORT, &desc->flags)) { 738 739 dev = class_find_device(&gpio_class, NULL, desc, match_export); 740 if (dev) { 741 gpio_setup_irq(desc, dev, 0); 742 clear_bit(FLAG_SYSFS_DIR, &desc->flags); 743 clear_bit(FLAG_EXPORT, &desc->flags); 744 } else 745 status = -ENODEV; 746 } 747 748 mutex_unlock(&sysfs_lock); 749 750 if (dev) { 751 device_unregister(dev); 752 put_device(dev); 753 } 754 755 if (status) 756 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 757 } 758 EXPORT_SYMBOL_GPL(gpiod_unexport); 759 760 int gpiochip_export(struct gpio_chip *chip) 761 { 762 int status; 763 struct device *dev; 764 765 /* Many systems register gpio chips for SOC support very early, 766 * before driver model support is available. In those cases we 767 * export this later, in gpiolib_sysfs_init() ... here we just 768 * verify that _some_ field of gpio_class got initialized. 769 */ 770 if (!gpio_class.p) 771 return 0; 772 773 /* use chip->base for the ID; it's already known to be unique */ 774 mutex_lock(&sysfs_lock); 775 dev = device_create_with_groups(&gpio_class, chip->dev, MKDEV(0, 0), 776 chip, gpiochip_groups, 777 "gpiochip%d", chip->base); 778 if (IS_ERR(dev)) 779 status = PTR_ERR(dev); 780 else 781 status = 0; 782 chip->exported = (status == 0); 783 mutex_unlock(&sysfs_lock); 784 785 if (status) 786 chip_dbg(chip, "%s: status %d\n", __func__, status); 787 788 return status; 789 } 790 791 void gpiochip_unexport(struct gpio_chip *chip) 792 { 793 int status; 794 struct device *dev; 795 struct gpio_desc *desc; 796 unsigned int i; 797 798 mutex_lock(&sysfs_lock); 799 dev = class_find_device(&gpio_class, NULL, chip, match_export); 800 if (dev) { 801 put_device(dev); 802 device_unregister(dev); 803 /* prevent further gpiod exports */ 804 chip->exported = false; 805 status = 0; 806 } else 807 status = -ENODEV; 808 mutex_unlock(&sysfs_lock); 809 810 if (status) 811 chip_dbg(chip, "%s: status %d\n", __func__, status); 812 813 /* unregister gpiod class devices owned by sysfs */ 814 for (i = 0; i < chip->ngpio; i++) { 815 desc = &chip->desc[i]; 816 if (test_and_clear_bit(FLAG_SYSFS, &desc->flags)) 817 gpiod_free(desc); 818 } 819 } 820 821 static int __init gpiolib_sysfs_init(void) 822 { 823 int status; 824 unsigned long flags; 825 struct gpio_chip *chip; 826 827 status = class_register(&gpio_class); 828 if (status < 0) 829 return status; 830 831 /* Scan and register the gpio_chips which registered very 832 * early (e.g. before the class_register above was called). 833 * 834 * We run before arch_initcall() so chip->dev nodes can have 835 * registered, and so arch_initcall() can always gpio_export(). 836 */ 837 spin_lock_irqsave(&gpio_lock, flags); 838 list_for_each_entry(chip, &gpio_chips, list) { 839 if (chip->exported) 840 continue; 841 842 /* 843 * TODO we yield gpio_lock here because gpiochip_export() 844 * acquires a mutex. This is unsafe and needs to be fixed. 845 * 846 * Also it would be nice to use gpiochip_find() here so we 847 * can keep gpio_chips local to gpiolib.c, but the yield of 848 * gpio_lock prevents us from doing this. 849 */ 850 spin_unlock_irqrestore(&gpio_lock, flags); 851 status = gpiochip_export(chip); 852 spin_lock_irqsave(&gpio_lock, flags); 853 } 854 spin_unlock_irqrestore(&gpio_lock, flags); 855 856 857 return status; 858 } 859 postcore_initcall(gpiolib_sysfs_init); 860