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 unsigned long flags; 555 int status; 556 const char *ioname = NULL; 557 struct device *dev; 558 int offset; 559 560 /* can't export until sysfs is available ... */ 561 if (!gpio_class.p) { 562 pr_debug("%s: called too early!\n", __func__); 563 return -ENOENT; 564 } 565 566 if (!desc) { 567 pr_debug("%s: invalid gpio descriptor\n", __func__); 568 return -EINVAL; 569 } 570 571 mutex_lock(&sysfs_lock); 572 573 spin_lock_irqsave(&gpio_lock, flags); 574 if (!test_bit(FLAG_REQUESTED, &desc->flags) || 575 test_bit(FLAG_EXPORT, &desc->flags)) { 576 spin_unlock_irqrestore(&gpio_lock, flags); 577 gpiod_dbg(desc, "%s: unavailable (requested=%d, exported=%d)\n", 578 __func__, 579 test_bit(FLAG_REQUESTED, &desc->flags), 580 test_bit(FLAG_EXPORT, &desc->flags)); 581 status = -EPERM; 582 goto fail_unlock; 583 } 584 585 if (desc->chip->direction_input && desc->chip->direction_output && 586 direction_may_change) { 587 set_bit(FLAG_SYSFS_DIR, &desc->flags); 588 } 589 590 spin_unlock_irqrestore(&gpio_lock, flags); 591 592 offset = gpio_chip_hwgpio(desc); 593 if (desc->chip->names && desc->chip->names[offset]) 594 ioname = desc->chip->names[offset]; 595 596 dev = device_create_with_groups(&gpio_class, desc->chip->dev, 597 MKDEV(0, 0), desc, gpio_groups, 598 ioname ? ioname : "gpio%u", 599 desc_to_gpio(desc)); 600 if (IS_ERR(dev)) { 601 status = PTR_ERR(dev); 602 goto fail_unlock; 603 } 604 605 set_bit(FLAG_EXPORT, &desc->flags); 606 mutex_unlock(&sysfs_lock); 607 return 0; 608 609 fail_unlock: 610 mutex_unlock(&sysfs_lock); 611 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 612 return status; 613 } 614 EXPORT_SYMBOL_GPL(gpiod_export); 615 616 static int match_export(struct device *dev, const void *data) 617 { 618 return dev_get_drvdata(dev) == data; 619 } 620 621 /** 622 * gpiod_export_link - create a sysfs link to an exported GPIO node 623 * @dev: device under which to create symlink 624 * @name: name of the symlink 625 * @gpio: gpio to create symlink to, already exported 626 * 627 * Set up a symlink from /sys/.../dev/name to /sys/class/gpio/gpioN 628 * node. Caller is responsible for unlinking. 629 * 630 * Returns zero on success, else an error. 631 */ 632 int gpiod_export_link(struct device *dev, const char *name, 633 struct gpio_desc *desc) 634 { 635 int status = -EINVAL; 636 637 if (!desc) { 638 pr_warn("%s: invalid GPIO\n", __func__); 639 return -EINVAL; 640 } 641 642 mutex_lock(&sysfs_lock); 643 644 if (test_bit(FLAG_EXPORT, &desc->flags)) { 645 struct device *tdev; 646 647 tdev = class_find_device(&gpio_class, NULL, desc, match_export); 648 if (tdev != NULL) { 649 status = sysfs_create_link(&dev->kobj, &tdev->kobj, 650 name); 651 } else { 652 status = -ENODEV; 653 } 654 } 655 656 mutex_unlock(&sysfs_lock); 657 658 if (status) 659 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 660 661 return status; 662 } 663 EXPORT_SYMBOL_GPL(gpiod_export_link); 664 665 /** 666 * gpiod_sysfs_set_active_low - set the polarity of gpio sysfs value 667 * @gpio: gpio to change 668 * @value: non-zero to use active low, i.e. inverted values 669 * 670 * Set the polarity of /sys/class/gpio/gpioN/value sysfs attribute. 671 * The GPIO does not have to be exported yet. If poll(2) support has 672 * been enabled for either rising or falling edge, it will be 673 * reconfigured to follow the new polarity. 674 * 675 * Returns zero on success, else an error. 676 */ 677 int gpiod_sysfs_set_active_low(struct gpio_desc *desc, int value) 678 { 679 struct device *dev = NULL; 680 int status = -EINVAL; 681 682 if (!desc) { 683 pr_warn("%s: invalid GPIO\n", __func__); 684 return -EINVAL; 685 } 686 687 mutex_lock(&sysfs_lock); 688 689 if (test_bit(FLAG_EXPORT, &desc->flags)) { 690 dev = class_find_device(&gpio_class, NULL, desc, match_export); 691 if (dev == NULL) { 692 status = -ENODEV; 693 goto unlock; 694 } 695 } 696 697 status = sysfs_set_active_low(desc, dev, value); 698 699 unlock: 700 mutex_unlock(&sysfs_lock); 701 702 if (status) 703 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 704 705 return status; 706 } 707 EXPORT_SYMBOL_GPL(gpiod_sysfs_set_active_low); 708 709 /** 710 * gpiod_unexport - reverse effect of gpio_export() 711 * @gpio: gpio to make unavailable 712 * 713 * This is implicit on gpio_free(). 714 */ 715 void gpiod_unexport(struct gpio_desc *desc) 716 { 717 int status = 0; 718 struct device *dev = NULL; 719 720 if (!desc) { 721 pr_warn("%s: invalid GPIO\n", __func__); 722 return; 723 } 724 725 mutex_lock(&sysfs_lock); 726 727 if (test_bit(FLAG_EXPORT, &desc->flags)) { 728 729 dev = class_find_device(&gpio_class, NULL, desc, match_export); 730 if (dev) { 731 gpio_setup_irq(desc, dev, 0); 732 clear_bit(FLAG_SYSFS_DIR, &desc->flags); 733 clear_bit(FLAG_EXPORT, &desc->flags); 734 } else 735 status = -ENODEV; 736 } 737 738 mutex_unlock(&sysfs_lock); 739 740 if (dev) { 741 device_unregister(dev); 742 put_device(dev); 743 } 744 745 if (status) 746 gpiod_dbg(desc, "%s: status %d\n", __func__, status); 747 } 748 EXPORT_SYMBOL_GPL(gpiod_unexport); 749 750 int gpiochip_export(struct gpio_chip *chip) 751 { 752 int status; 753 struct device *dev; 754 755 /* Many systems register gpio chips for SOC support very early, 756 * before driver model support is available. In those cases we 757 * export this later, in gpiolib_sysfs_init() ... here we just 758 * verify that _some_ field of gpio_class got initialized. 759 */ 760 if (!gpio_class.p) 761 return 0; 762 763 /* use chip->base for the ID; it's already known to be unique */ 764 mutex_lock(&sysfs_lock); 765 dev = device_create_with_groups(&gpio_class, chip->dev, MKDEV(0, 0), 766 chip, gpiochip_groups, 767 "gpiochip%d", chip->base); 768 if (IS_ERR(dev)) 769 status = PTR_ERR(dev); 770 else 771 status = 0; 772 chip->exported = (status == 0); 773 mutex_unlock(&sysfs_lock); 774 775 if (status) 776 chip_dbg(chip, "%s: status %d\n", __func__, status); 777 778 return status; 779 } 780 781 void gpiochip_unexport(struct gpio_chip *chip) 782 { 783 int status; 784 struct device *dev; 785 786 mutex_lock(&sysfs_lock); 787 dev = class_find_device(&gpio_class, NULL, chip, match_export); 788 if (dev) { 789 put_device(dev); 790 device_unregister(dev); 791 chip->exported = false; 792 status = 0; 793 } else 794 status = -ENODEV; 795 mutex_unlock(&sysfs_lock); 796 797 if (status) 798 chip_dbg(chip, "%s: status %d\n", __func__, status); 799 } 800 801 static int __init gpiolib_sysfs_init(void) 802 { 803 int status; 804 unsigned long flags; 805 struct gpio_chip *chip; 806 807 status = class_register(&gpio_class); 808 if (status < 0) 809 return status; 810 811 /* Scan and register the gpio_chips which registered very 812 * early (e.g. before the class_register above was called). 813 * 814 * We run before arch_initcall() so chip->dev nodes can have 815 * registered, and so arch_initcall() can always gpio_export(). 816 */ 817 spin_lock_irqsave(&gpio_lock, flags); 818 list_for_each_entry(chip, &gpio_chips, list) { 819 if (chip->exported) 820 continue; 821 822 /* 823 * TODO we yield gpio_lock here because gpiochip_export() 824 * acquires a mutex. This is unsafe and needs to be fixed. 825 * 826 * Also it would be nice to use gpiochip_find() here so we 827 * can keep gpio_chips local to gpiolib.c, but the yield of 828 * gpio_lock prevents us from doing this. 829 */ 830 spin_unlock_irqrestore(&gpio_lock, flags); 831 status = gpiochip_export(chip); 832 spin_lock_irqsave(&gpio_lock, flags); 833 } 834 spin_unlock_irqrestore(&gpio_lock, flags); 835 836 837 return status; 838 } 839 postcore_initcall(gpiolib_sysfs_init); 840