1 /* 2 * drivers/base/core.c - core driver model code (device registration, etc) 3 * 4 * Copyright (c) 2002-3 Patrick Mochel 5 * Copyright (c) 2002-3 Open Source Development Labs 6 * Copyright (c) 2006 Greg Kroah-Hartman <gregkh@suse.de> 7 * Copyright (c) 2006 Novell, Inc. 8 * 9 * This file is released under the GPLv2 10 * 11 */ 12 13 #include <linux/device.h> 14 #include <linux/err.h> 15 #include <linux/init.h> 16 #include <linux/module.h> 17 #include <linux/slab.h> 18 #include <linux/string.h> 19 #include <linux/kdev_t.h> 20 #include <linux/notifier.h> 21 #include <linux/genhd.h> 22 #include <asm/semaphore.h> 23 24 #include "base.h" 25 #include "power/power.h" 26 27 int (*platform_notify)(struct device *dev) = NULL; 28 int (*platform_notify_remove)(struct device *dev) = NULL; 29 30 #ifdef CONFIG_BLOCK 31 static inline int device_is_not_partition(struct device *dev) 32 { 33 return !(dev->type == &part_type); 34 } 35 #else 36 static inline int device_is_not_partition(struct device *dev) 37 { 38 return 1; 39 } 40 #endif 41 42 /** 43 * dev_driver_string - Return a device's driver name, if at all possible 44 * @dev: struct device to get the name of 45 * 46 * Will return the device's driver's name if it is bound to a device. If 47 * the device is not bound to a device, it will return the name of the bus 48 * it is attached to. If it is not attached to a bus either, an empty 49 * string will be returned. 50 */ 51 const char *dev_driver_string(struct device *dev) 52 { 53 return dev->driver ? dev->driver->name : 54 (dev->bus ? dev->bus->name : 55 (dev->class ? dev->class->name : "")); 56 } 57 EXPORT_SYMBOL(dev_driver_string); 58 59 #define to_dev(obj) container_of(obj, struct device, kobj) 60 #define to_dev_attr(_attr) container_of(_attr, struct device_attribute, attr) 61 62 static ssize_t dev_attr_show(struct kobject *kobj, struct attribute *attr, 63 char *buf) 64 { 65 struct device_attribute *dev_attr = to_dev_attr(attr); 66 struct device *dev = to_dev(kobj); 67 ssize_t ret = -EIO; 68 69 if (dev_attr->show) 70 ret = dev_attr->show(dev, dev_attr, buf); 71 return ret; 72 } 73 74 static ssize_t dev_attr_store(struct kobject *kobj, struct attribute *attr, 75 const char *buf, size_t count) 76 { 77 struct device_attribute *dev_attr = to_dev_attr(attr); 78 struct device *dev = to_dev(kobj); 79 ssize_t ret = -EIO; 80 81 if (dev_attr->store) 82 ret = dev_attr->store(dev, dev_attr, buf, count); 83 return ret; 84 } 85 86 static struct sysfs_ops dev_sysfs_ops = { 87 .show = dev_attr_show, 88 .store = dev_attr_store, 89 }; 90 91 92 /** 93 * device_release - free device structure. 94 * @kobj: device's kobject. 95 * 96 * This is called once the reference count for the object 97 * reaches 0. We forward the call to the device's release 98 * method, which should handle actually freeing the structure. 99 */ 100 static void device_release(struct kobject *kobj) 101 { 102 struct device *dev = to_dev(kobj); 103 104 if (dev->release) 105 dev->release(dev); 106 else if (dev->type && dev->type->release) 107 dev->type->release(dev); 108 else if (dev->class && dev->class->dev_release) 109 dev->class->dev_release(dev); 110 else { 111 printk(KERN_ERR "Device '%s' does not have a release() " 112 "function, it is broken and must be fixed.\n", 113 dev->bus_id); 114 WARN_ON(1); 115 } 116 } 117 118 static struct kobj_type device_ktype = { 119 .release = device_release, 120 .sysfs_ops = &dev_sysfs_ops, 121 }; 122 123 124 static int dev_uevent_filter(struct kset *kset, struct kobject *kobj) 125 { 126 struct kobj_type *ktype = get_ktype(kobj); 127 128 if (ktype == &device_ktype) { 129 struct device *dev = to_dev(kobj); 130 if (dev->uevent_suppress) 131 return 0; 132 if (dev->bus) 133 return 1; 134 if (dev->class) 135 return 1; 136 } 137 return 0; 138 } 139 140 static const char *dev_uevent_name(struct kset *kset, struct kobject *kobj) 141 { 142 struct device *dev = to_dev(kobj); 143 144 if (dev->bus) 145 return dev->bus->name; 146 if (dev->class) 147 return dev->class->name; 148 return NULL; 149 } 150 151 static int dev_uevent(struct kset *kset, struct kobject *kobj, 152 struct kobj_uevent_env *env) 153 { 154 struct device *dev = to_dev(kobj); 155 int retval = 0; 156 157 /* add the major/minor if present */ 158 if (MAJOR(dev->devt)) { 159 add_uevent_var(env, "MAJOR=%u", MAJOR(dev->devt)); 160 add_uevent_var(env, "MINOR=%u", MINOR(dev->devt)); 161 } 162 163 if (dev->type && dev->type->name) 164 add_uevent_var(env, "DEVTYPE=%s", dev->type->name); 165 166 if (dev->driver) 167 add_uevent_var(env, "DRIVER=%s", dev->driver->name); 168 169 #ifdef CONFIG_SYSFS_DEPRECATED 170 if (dev->class) { 171 struct device *parent = dev->parent; 172 173 /* find first bus device in parent chain */ 174 while (parent && !parent->bus) 175 parent = parent->parent; 176 if (parent && parent->bus) { 177 const char *path; 178 179 path = kobject_get_path(&parent->kobj, GFP_KERNEL); 180 if (path) { 181 add_uevent_var(env, "PHYSDEVPATH=%s", path); 182 kfree(path); 183 } 184 185 add_uevent_var(env, "PHYSDEVBUS=%s", parent->bus->name); 186 187 if (parent->driver) 188 add_uevent_var(env, "PHYSDEVDRIVER=%s", 189 parent->driver->name); 190 } 191 } else if (dev->bus) { 192 add_uevent_var(env, "PHYSDEVBUS=%s", dev->bus->name); 193 194 if (dev->driver) 195 add_uevent_var(env, "PHYSDEVDRIVER=%s", 196 dev->driver->name); 197 } 198 #endif 199 200 /* have the bus specific function add its stuff */ 201 if (dev->bus && dev->bus->uevent) { 202 retval = dev->bus->uevent(dev, env); 203 if (retval) 204 pr_debug("device: '%s': %s: bus uevent() returned %d\n", 205 dev->bus_id, __FUNCTION__, retval); 206 } 207 208 /* have the class specific function add its stuff */ 209 if (dev->class && dev->class->dev_uevent) { 210 retval = dev->class->dev_uevent(dev, env); 211 if (retval) 212 pr_debug("device: '%s': %s: class uevent() " 213 "returned %d\n", dev->bus_id, 214 __FUNCTION__, retval); 215 } 216 217 /* have the device type specific fuction add its stuff */ 218 if (dev->type && dev->type->uevent) { 219 retval = dev->type->uevent(dev, env); 220 if (retval) 221 pr_debug("device: '%s': %s: dev_type uevent() " 222 "returned %d\n", dev->bus_id, 223 __FUNCTION__, retval); 224 } 225 226 return retval; 227 } 228 229 static struct kset_uevent_ops device_uevent_ops = { 230 .filter = dev_uevent_filter, 231 .name = dev_uevent_name, 232 .uevent = dev_uevent, 233 }; 234 235 static ssize_t show_uevent(struct device *dev, struct device_attribute *attr, 236 char *buf) 237 { 238 struct kobject *top_kobj; 239 struct kset *kset; 240 struct kobj_uevent_env *env = NULL; 241 int i; 242 size_t count = 0; 243 int retval; 244 245 /* search the kset, the device belongs to */ 246 top_kobj = &dev->kobj; 247 while (!top_kobj->kset && top_kobj->parent) 248 top_kobj = top_kobj->parent; 249 if (!top_kobj->kset) 250 goto out; 251 252 kset = top_kobj->kset; 253 if (!kset->uevent_ops || !kset->uevent_ops->uevent) 254 goto out; 255 256 /* respect filter */ 257 if (kset->uevent_ops && kset->uevent_ops->filter) 258 if (!kset->uevent_ops->filter(kset, &dev->kobj)) 259 goto out; 260 261 env = kzalloc(sizeof(struct kobj_uevent_env), GFP_KERNEL); 262 if (!env) 263 return -ENOMEM; 264 265 /* let the kset specific function add its keys */ 266 retval = kset->uevent_ops->uevent(kset, &dev->kobj, env); 267 if (retval) 268 goto out; 269 270 /* copy keys to file */ 271 for (i = 0; i < env->envp_idx; i++) 272 count += sprintf(&buf[count], "%s\n", env->envp[i]); 273 out: 274 kfree(env); 275 return count; 276 } 277 278 static ssize_t store_uevent(struct device *dev, struct device_attribute *attr, 279 const char *buf, size_t count) 280 { 281 enum kobject_action action; 282 283 if (kobject_action_type(buf, count, &action) == 0) { 284 kobject_uevent(&dev->kobj, action); 285 goto out; 286 } 287 288 dev_err(dev, "uevent: unsupported action-string; this will " 289 "be ignored in a future kernel version\n"); 290 kobject_uevent(&dev->kobj, KOBJ_ADD); 291 out: 292 return count; 293 } 294 295 static struct device_attribute uevent_attr = 296 __ATTR(uevent, S_IRUGO | S_IWUSR, show_uevent, store_uevent); 297 298 static int device_add_attributes(struct device *dev, 299 struct device_attribute *attrs) 300 { 301 int error = 0; 302 int i; 303 304 if (attrs) { 305 for (i = 0; attr_name(attrs[i]); i++) { 306 error = device_create_file(dev, &attrs[i]); 307 if (error) 308 break; 309 } 310 if (error) 311 while (--i >= 0) 312 device_remove_file(dev, &attrs[i]); 313 } 314 return error; 315 } 316 317 static void device_remove_attributes(struct device *dev, 318 struct device_attribute *attrs) 319 { 320 int i; 321 322 if (attrs) 323 for (i = 0; attr_name(attrs[i]); i++) 324 device_remove_file(dev, &attrs[i]); 325 } 326 327 static int device_add_groups(struct device *dev, 328 struct attribute_group **groups) 329 { 330 int error = 0; 331 int i; 332 333 if (groups) { 334 for (i = 0; groups[i]; i++) { 335 error = sysfs_create_group(&dev->kobj, groups[i]); 336 if (error) { 337 while (--i >= 0) 338 sysfs_remove_group(&dev->kobj, 339 groups[i]); 340 break; 341 } 342 } 343 } 344 return error; 345 } 346 347 static void device_remove_groups(struct device *dev, 348 struct attribute_group **groups) 349 { 350 int i; 351 352 if (groups) 353 for (i = 0; groups[i]; i++) 354 sysfs_remove_group(&dev->kobj, groups[i]); 355 } 356 357 static int device_add_attrs(struct device *dev) 358 { 359 struct class *class = dev->class; 360 struct device_type *type = dev->type; 361 int error; 362 363 if (class) { 364 error = device_add_attributes(dev, class->dev_attrs); 365 if (error) 366 return error; 367 } 368 369 if (type) { 370 error = device_add_groups(dev, type->groups); 371 if (error) 372 goto err_remove_class_attrs; 373 } 374 375 error = device_add_groups(dev, dev->groups); 376 if (error) 377 goto err_remove_type_groups; 378 379 return 0; 380 381 err_remove_type_groups: 382 if (type) 383 device_remove_groups(dev, type->groups); 384 err_remove_class_attrs: 385 if (class) 386 device_remove_attributes(dev, class->dev_attrs); 387 388 return error; 389 } 390 391 static void device_remove_attrs(struct device *dev) 392 { 393 struct class *class = dev->class; 394 struct device_type *type = dev->type; 395 396 device_remove_groups(dev, dev->groups); 397 398 if (type) 399 device_remove_groups(dev, type->groups); 400 401 if (class) 402 device_remove_attributes(dev, class->dev_attrs); 403 } 404 405 406 static ssize_t show_dev(struct device *dev, struct device_attribute *attr, 407 char *buf) 408 { 409 return print_dev_t(buf, dev->devt); 410 } 411 412 static struct device_attribute devt_attr = 413 __ATTR(dev, S_IRUGO, show_dev, NULL); 414 415 /* kset to create /sys/devices/ */ 416 struct kset *devices_kset; 417 418 /** 419 * device_create_file - create sysfs attribute file for device. 420 * @dev: device. 421 * @attr: device attribute descriptor. 422 */ 423 int device_create_file(struct device *dev, struct device_attribute *attr) 424 { 425 int error = 0; 426 if (dev) 427 error = sysfs_create_file(&dev->kobj, &attr->attr); 428 return error; 429 } 430 431 /** 432 * device_remove_file - remove sysfs attribute file. 433 * @dev: device. 434 * @attr: device attribute descriptor. 435 */ 436 void device_remove_file(struct device *dev, struct device_attribute *attr) 437 { 438 if (dev) 439 sysfs_remove_file(&dev->kobj, &attr->attr); 440 } 441 442 /** 443 * device_create_bin_file - create sysfs binary attribute file for device. 444 * @dev: device. 445 * @attr: device binary attribute descriptor. 446 */ 447 int device_create_bin_file(struct device *dev, struct bin_attribute *attr) 448 { 449 int error = -EINVAL; 450 if (dev) 451 error = sysfs_create_bin_file(&dev->kobj, attr); 452 return error; 453 } 454 EXPORT_SYMBOL_GPL(device_create_bin_file); 455 456 /** 457 * device_remove_bin_file - remove sysfs binary attribute file 458 * @dev: device. 459 * @attr: device binary attribute descriptor. 460 */ 461 void device_remove_bin_file(struct device *dev, struct bin_attribute *attr) 462 { 463 if (dev) 464 sysfs_remove_bin_file(&dev->kobj, attr); 465 } 466 EXPORT_SYMBOL_GPL(device_remove_bin_file); 467 468 /** 469 * device_schedule_callback_owner - helper to schedule a callback for a device 470 * @dev: device. 471 * @func: callback function to invoke later. 472 * @owner: module owning the callback routine 473 * 474 * Attribute methods must not unregister themselves or their parent device 475 * (which would amount to the same thing). Attempts to do so will deadlock, 476 * since unregistration is mutually exclusive with driver callbacks. 477 * 478 * Instead methods can call this routine, which will attempt to allocate 479 * and schedule a workqueue request to call back @func with @dev as its 480 * argument in the workqueue's process context. @dev will be pinned until 481 * @func returns. 482 * 483 * This routine is usually called via the inline device_schedule_callback(), 484 * which automatically sets @owner to THIS_MODULE. 485 * 486 * Returns 0 if the request was submitted, -ENOMEM if storage could not 487 * be allocated, -ENODEV if a reference to @owner isn't available. 488 * 489 * NOTE: This routine won't work if CONFIG_SYSFS isn't set! It uses an 490 * underlying sysfs routine (since it is intended for use by attribute 491 * methods), and if sysfs isn't available you'll get nothing but -ENOSYS. 492 */ 493 int device_schedule_callback_owner(struct device *dev, 494 void (*func)(struct device *), struct module *owner) 495 { 496 return sysfs_schedule_callback(&dev->kobj, 497 (void (*)(void *)) func, dev, owner); 498 } 499 EXPORT_SYMBOL_GPL(device_schedule_callback_owner); 500 501 static void klist_children_get(struct klist_node *n) 502 { 503 struct device *dev = container_of(n, struct device, knode_parent); 504 505 get_device(dev); 506 } 507 508 static void klist_children_put(struct klist_node *n) 509 { 510 struct device *dev = container_of(n, struct device, knode_parent); 511 512 put_device(dev); 513 } 514 515 /** 516 * device_initialize - init device structure. 517 * @dev: device. 518 * 519 * This prepares the device for use by other layers, 520 * including adding it to the device hierarchy. 521 * It is the first half of device_register(), if called by 522 * that, though it can also be called separately, so one 523 * may use @dev's fields (e.g. the refcount). 524 */ 525 void device_initialize(struct device *dev) 526 { 527 dev->kobj.kset = devices_kset; 528 kobject_init(&dev->kobj, &device_ktype); 529 klist_init(&dev->klist_children, klist_children_get, 530 klist_children_put); 531 INIT_LIST_HEAD(&dev->dma_pools); 532 INIT_LIST_HEAD(&dev->node); 533 init_MUTEX(&dev->sem); 534 spin_lock_init(&dev->devres_lock); 535 INIT_LIST_HEAD(&dev->devres_head); 536 device_init_wakeup(dev, 0); 537 set_dev_node(dev, -1); 538 } 539 540 #ifdef CONFIG_SYSFS_DEPRECATED 541 static struct kobject *get_device_parent(struct device *dev, 542 struct device *parent) 543 { 544 /* class devices without a parent live in /sys/class/<classname>/ */ 545 if (dev->class && (!parent || parent->class != dev->class)) 546 return &dev->class->subsys.kobj; 547 /* all other devices keep their parent */ 548 else if (parent) 549 return &parent->kobj; 550 551 return NULL; 552 } 553 554 static inline void cleanup_device_parent(struct device *dev) {} 555 static inline void cleanup_glue_dir(struct device *dev, 556 struct kobject *glue_dir) {} 557 #else 558 static struct kobject *virtual_device_parent(struct device *dev) 559 { 560 static struct kobject *virtual_dir = NULL; 561 562 if (!virtual_dir) 563 virtual_dir = kobject_create_and_add("virtual", 564 &devices_kset->kobj); 565 566 return virtual_dir; 567 } 568 569 static struct kobject *get_device_parent(struct device *dev, 570 struct device *parent) 571 { 572 int retval; 573 574 if (dev->class) { 575 struct kobject *kobj = NULL; 576 struct kobject *parent_kobj; 577 struct kobject *k; 578 579 /* 580 * If we have no parent, we live in "virtual". 581 * Class-devices with a non class-device as parent, live 582 * in a "glue" directory to prevent namespace collisions. 583 */ 584 if (parent == NULL) 585 parent_kobj = virtual_device_parent(dev); 586 else if (parent->class) 587 return &parent->kobj; 588 else 589 parent_kobj = &parent->kobj; 590 591 /* find our class-directory at the parent and reference it */ 592 spin_lock(&dev->class->class_dirs.list_lock); 593 list_for_each_entry(k, &dev->class->class_dirs.list, entry) 594 if (k->parent == parent_kobj) { 595 kobj = kobject_get(k); 596 break; 597 } 598 spin_unlock(&dev->class->class_dirs.list_lock); 599 if (kobj) 600 return kobj; 601 602 /* or create a new class-directory at the parent device */ 603 k = kobject_create(); 604 if (!k) 605 return NULL; 606 k->kset = &dev->class->class_dirs; 607 retval = kobject_add(k, parent_kobj, "%s", dev->class->name); 608 if (retval < 0) { 609 kobject_put(k); 610 return NULL; 611 } 612 /* do not emit an uevent for this simple "glue" directory */ 613 return k; 614 } 615 616 if (parent) 617 return &parent->kobj; 618 return NULL; 619 } 620 621 static void cleanup_glue_dir(struct device *dev, struct kobject *glue_dir) 622 { 623 /* see if we live in a "glue" directory */ 624 if (!dev->class || glue_dir->kset != &dev->class->class_dirs) 625 return; 626 627 kobject_put(glue_dir); 628 } 629 630 static void cleanup_device_parent(struct device *dev) 631 { 632 cleanup_glue_dir(dev, dev->kobj.parent); 633 } 634 #endif 635 636 static void setup_parent(struct device *dev, struct device *parent) 637 { 638 struct kobject *kobj; 639 kobj = get_device_parent(dev, parent); 640 if (kobj) 641 dev->kobj.parent = kobj; 642 } 643 644 static int device_add_class_symlinks(struct device *dev) 645 { 646 int error; 647 648 if (!dev->class) 649 return 0; 650 651 error = sysfs_create_link(&dev->kobj, &dev->class->subsys.kobj, 652 "subsystem"); 653 if (error) 654 goto out; 655 656 #ifdef CONFIG_SYSFS_DEPRECATED 657 /* stacked class devices need a symlink in the class directory */ 658 if (dev->kobj.parent != &dev->class->subsys.kobj && 659 device_is_not_partition(dev)) { 660 error = sysfs_create_link(&dev->class->subsys.kobj, &dev->kobj, 661 dev->bus_id); 662 if (error) 663 goto out_subsys; 664 } 665 666 if (dev->parent && device_is_not_partition(dev)) { 667 struct device *parent = dev->parent; 668 char *class_name; 669 670 /* 671 * stacked class devices have the 'device' link 672 * pointing to the bus device instead of the parent 673 */ 674 while (parent->class && !parent->bus && parent->parent) 675 parent = parent->parent; 676 677 error = sysfs_create_link(&dev->kobj, 678 &parent->kobj, 679 "device"); 680 if (error) 681 goto out_busid; 682 683 class_name = make_class_name(dev->class->name, 684 &dev->kobj); 685 if (class_name) 686 error = sysfs_create_link(&dev->parent->kobj, 687 &dev->kobj, class_name); 688 kfree(class_name); 689 if (error) 690 goto out_device; 691 } 692 return 0; 693 694 out_device: 695 if (dev->parent && device_is_not_partition(dev)) 696 sysfs_remove_link(&dev->kobj, "device"); 697 out_busid: 698 if (dev->kobj.parent != &dev->class->subsys.kobj && 699 device_is_not_partition(dev)) 700 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 701 #else 702 /* link in the class directory pointing to the device */ 703 error = sysfs_create_link(&dev->class->subsys.kobj, &dev->kobj, 704 dev->bus_id); 705 if (error) 706 goto out_subsys; 707 708 if (dev->parent && device_is_not_partition(dev)) { 709 error = sysfs_create_link(&dev->kobj, &dev->parent->kobj, 710 "device"); 711 if (error) 712 goto out_busid; 713 } 714 return 0; 715 716 out_busid: 717 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 718 #endif 719 720 out_subsys: 721 sysfs_remove_link(&dev->kobj, "subsystem"); 722 out: 723 return error; 724 } 725 726 static void device_remove_class_symlinks(struct device *dev) 727 { 728 if (!dev->class) 729 return; 730 731 #ifdef CONFIG_SYSFS_DEPRECATED 732 if (dev->parent && device_is_not_partition(dev)) { 733 char *class_name; 734 735 class_name = make_class_name(dev->class->name, &dev->kobj); 736 if (class_name) { 737 sysfs_remove_link(&dev->parent->kobj, class_name); 738 kfree(class_name); 739 } 740 sysfs_remove_link(&dev->kobj, "device"); 741 } 742 743 if (dev->kobj.parent != &dev->class->subsys.kobj && 744 device_is_not_partition(dev)) 745 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 746 #else 747 if (dev->parent && device_is_not_partition(dev)) 748 sysfs_remove_link(&dev->kobj, "device"); 749 750 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 751 #endif 752 753 sysfs_remove_link(&dev->kobj, "subsystem"); 754 } 755 756 /** 757 * device_add - add device to device hierarchy. 758 * @dev: device. 759 * 760 * This is part 2 of device_register(), though may be called 761 * separately _iff_ device_initialize() has been called separately. 762 * 763 * This adds it to the kobject hierarchy via kobject_add(), adds it 764 * to the global and sibling lists for the device, then 765 * adds it to the other relevant subsystems of the driver model. 766 */ 767 int device_add(struct device *dev) 768 { 769 struct device *parent = NULL; 770 struct class_interface *class_intf; 771 int error; 772 773 error = pm_sleep_lock(); 774 if (error) { 775 dev_warn(dev, "Suspicious %s during suspend\n", __FUNCTION__); 776 dump_stack(); 777 return error; 778 } 779 780 dev = get_device(dev); 781 if (!dev || !strlen(dev->bus_id)) { 782 error = -EINVAL; 783 goto Error; 784 } 785 786 pr_debug("device: '%s': %s\n", dev->bus_id, __FUNCTION__); 787 788 parent = get_device(dev->parent); 789 setup_parent(dev, parent); 790 791 /* first, register with generic layer. */ 792 error = kobject_add(&dev->kobj, dev->kobj.parent, "%s", dev->bus_id); 793 if (error) 794 goto Error; 795 796 /* notify platform of device entry */ 797 if (platform_notify) 798 platform_notify(dev); 799 800 /* notify clients of device entry (new way) */ 801 if (dev->bus) 802 blocking_notifier_call_chain(&dev->bus->p->bus_notifier, 803 BUS_NOTIFY_ADD_DEVICE, dev); 804 805 error = device_create_file(dev, &uevent_attr); 806 if (error) 807 goto attrError; 808 809 if (MAJOR(dev->devt)) { 810 error = device_create_file(dev, &devt_attr); 811 if (error) 812 goto ueventattrError; 813 } 814 815 error = device_add_class_symlinks(dev); 816 if (error) 817 goto SymlinkError; 818 error = device_add_attrs(dev); 819 if (error) 820 goto AttrsError; 821 error = dpm_sysfs_add(dev); 822 if (error) 823 goto PMError; 824 device_pm_add(dev); 825 error = bus_add_device(dev); 826 if (error) 827 goto BusError; 828 kobject_uevent(&dev->kobj, KOBJ_ADD); 829 bus_attach_device(dev); 830 if (parent) 831 klist_add_tail(&dev->knode_parent, &parent->klist_children); 832 833 if (dev->class) { 834 down(&dev->class->sem); 835 /* tie the class to the device */ 836 list_add_tail(&dev->node, &dev->class->devices); 837 838 /* notify any interfaces that the device is here */ 839 list_for_each_entry(class_intf, &dev->class->interfaces, node) 840 if (class_intf->add_dev) 841 class_intf->add_dev(dev, class_intf); 842 up(&dev->class->sem); 843 } 844 Done: 845 put_device(dev); 846 pm_sleep_unlock(); 847 return error; 848 BusError: 849 device_pm_remove(dev); 850 dpm_sysfs_remove(dev); 851 PMError: 852 if (dev->bus) 853 blocking_notifier_call_chain(&dev->bus->p->bus_notifier, 854 BUS_NOTIFY_DEL_DEVICE, dev); 855 device_remove_attrs(dev); 856 AttrsError: 857 device_remove_class_symlinks(dev); 858 SymlinkError: 859 if (MAJOR(dev->devt)) 860 device_remove_file(dev, &devt_attr); 861 ueventattrError: 862 device_remove_file(dev, &uevent_attr); 863 attrError: 864 kobject_uevent(&dev->kobj, KOBJ_REMOVE); 865 kobject_del(&dev->kobj); 866 Error: 867 cleanup_device_parent(dev); 868 if (parent) 869 put_device(parent); 870 goto Done; 871 } 872 873 /** 874 * device_register - register a device with the system. 875 * @dev: pointer to the device structure 876 * 877 * This happens in two clean steps - initialize the device 878 * and add it to the system. The two steps can be called 879 * separately, but this is the easiest and most common. 880 * I.e. you should only call the two helpers separately if 881 * have a clearly defined need to use and refcount the device 882 * before it is added to the hierarchy. 883 */ 884 int device_register(struct device *dev) 885 { 886 device_initialize(dev); 887 return device_add(dev); 888 } 889 890 /** 891 * get_device - increment reference count for device. 892 * @dev: device. 893 * 894 * This simply forwards the call to kobject_get(), though 895 * we do take care to provide for the case that we get a NULL 896 * pointer passed in. 897 */ 898 struct device *get_device(struct device *dev) 899 { 900 return dev ? to_dev(kobject_get(&dev->kobj)) : NULL; 901 } 902 903 /** 904 * put_device - decrement reference count. 905 * @dev: device in question. 906 */ 907 void put_device(struct device *dev) 908 { 909 /* might_sleep(); */ 910 if (dev) 911 kobject_put(&dev->kobj); 912 } 913 914 /** 915 * device_del - delete device from system. 916 * @dev: device. 917 * 918 * This is the first part of the device unregistration 919 * sequence. This removes the device from the lists we control 920 * from here, has it removed from the other driver model 921 * subsystems it was added to in device_add(), and removes it 922 * from the kobject hierarchy. 923 * 924 * NOTE: this should be called manually _iff_ device_add() was 925 * also called manually. 926 */ 927 void device_del(struct device *dev) 928 { 929 struct device *parent = dev->parent; 930 struct class_interface *class_intf; 931 932 device_pm_remove(dev); 933 if (parent) 934 klist_del(&dev->knode_parent); 935 if (MAJOR(dev->devt)) 936 device_remove_file(dev, &devt_attr); 937 if (dev->class) { 938 device_remove_class_symlinks(dev); 939 940 down(&dev->class->sem); 941 /* notify any interfaces that the device is now gone */ 942 list_for_each_entry(class_intf, &dev->class->interfaces, node) 943 if (class_intf->remove_dev) 944 class_intf->remove_dev(dev, class_intf); 945 /* remove the device from the class list */ 946 list_del_init(&dev->node); 947 up(&dev->class->sem); 948 } 949 device_remove_file(dev, &uevent_attr); 950 device_remove_attrs(dev); 951 bus_remove_device(dev); 952 953 /* 954 * Some platform devices are driven without driver attached 955 * and managed resources may have been acquired. Make sure 956 * all resources are released. 957 */ 958 devres_release_all(dev); 959 960 /* Notify the platform of the removal, in case they 961 * need to do anything... 962 */ 963 if (platform_notify_remove) 964 platform_notify_remove(dev); 965 if (dev->bus) 966 blocking_notifier_call_chain(&dev->bus->p->bus_notifier, 967 BUS_NOTIFY_DEL_DEVICE, dev); 968 kobject_uevent(&dev->kobj, KOBJ_REMOVE); 969 cleanup_device_parent(dev); 970 kobject_del(&dev->kobj); 971 put_device(parent); 972 } 973 974 /** 975 * device_unregister - unregister device from system. 976 * @dev: device going away. 977 * 978 * We do this in two parts, like we do device_register(). First, 979 * we remove it from all the subsystems with device_del(), then 980 * we decrement the reference count via put_device(). If that 981 * is the final reference count, the device will be cleaned up 982 * via device_release() above. Otherwise, the structure will 983 * stick around until the final reference to the device is dropped. 984 */ 985 void device_unregister(struct device *dev) 986 { 987 pr_debug("device: '%s': %s\n", dev->bus_id, __FUNCTION__); 988 device_del(dev); 989 put_device(dev); 990 } 991 992 static struct device *next_device(struct klist_iter *i) 993 { 994 struct klist_node *n = klist_next(i); 995 return n ? container_of(n, struct device, knode_parent) : NULL; 996 } 997 998 /** 999 * device_for_each_child - device child iterator. 1000 * @parent: parent struct device. 1001 * @data: data for the callback. 1002 * @fn: function to be called for each device. 1003 * 1004 * Iterate over @parent's child devices, and call @fn for each, 1005 * passing it @data. 1006 * 1007 * We check the return of @fn each time. If it returns anything 1008 * other than 0, we break out and return that value. 1009 */ 1010 int device_for_each_child(struct device *parent, void *data, 1011 int (*fn)(struct device *dev, void *data)) 1012 { 1013 struct klist_iter i; 1014 struct device *child; 1015 int error = 0; 1016 1017 klist_iter_init(&parent->klist_children, &i); 1018 while ((child = next_device(&i)) && !error) 1019 error = fn(child, data); 1020 klist_iter_exit(&i); 1021 return error; 1022 } 1023 1024 /** 1025 * device_find_child - device iterator for locating a particular device. 1026 * @parent: parent struct device 1027 * @data: Data to pass to match function 1028 * @match: Callback function to check device 1029 * 1030 * This is similar to the device_for_each_child() function above, but it 1031 * returns a reference to a device that is 'found' for later use, as 1032 * determined by the @match callback. 1033 * 1034 * The callback should return 0 if the device doesn't match and non-zero 1035 * if it does. If the callback returns non-zero and a reference to the 1036 * current device can be obtained, this function will return to the caller 1037 * and not iterate over any more devices. 1038 */ 1039 struct device *device_find_child(struct device *parent, void *data, 1040 int (*match)(struct device *dev, void *data)) 1041 { 1042 struct klist_iter i; 1043 struct device *child; 1044 1045 if (!parent) 1046 return NULL; 1047 1048 klist_iter_init(&parent->klist_children, &i); 1049 while ((child = next_device(&i))) 1050 if (match(child, data) && get_device(child)) 1051 break; 1052 klist_iter_exit(&i); 1053 return child; 1054 } 1055 1056 int __init devices_init(void) 1057 { 1058 devices_kset = kset_create_and_add("devices", &device_uevent_ops, NULL); 1059 if (!devices_kset) 1060 return -ENOMEM; 1061 return 0; 1062 } 1063 1064 EXPORT_SYMBOL_GPL(device_for_each_child); 1065 EXPORT_SYMBOL_GPL(device_find_child); 1066 1067 EXPORT_SYMBOL_GPL(device_initialize); 1068 EXPORT_SYMBOL_GPL(device_add); 1069 EXPORT_SYMBOL_GPL(device_register); 1070 1071 EXPORT_SYMBOL_GPL(device_del); 1072 EXPORT_SYMBOL_GPL(device_unregister); 1073 EXPORT_SYMBOL_GPL(get_device); 1074 EXPORT_SYMBOL_GPL(put_device); 1075 1076 EXPORT_SYMBOL_GPL(device_create_file); 1077 EXPORT_SYMBOL_GPL(device_remove_file); 1078 1079 1080 static void device_create_release(struct device *dev) 1081 { 1082 pr_debug("device: '%s': %s\n", dev->bus_id, __FUNCTION__); 1083 kfree(dev); 1084 } 1085 1086 /** 1087 * device_create - creates a device and registers it with sysfs 1088 * @class: pointer to the struct class that this device should be registered to 1089 * @parent: pointer to the parent struct device of this new device, if any 1090 * @devt: the dev_t for the char device to be added 1091 * @fmt: string for the device's name 1092 * 1093 * This function can be used by char device classes. A struct device 1094 * will be created in sysfs, registered to the specified class. 1095 * 1096 * A "dev" file will be created, showing the dev_t for the device, if 1097 * the dev_t is not 0,0. 1098 * If a pointer to a parent struct device is passed in, the newly created 1099 * struct device will be a child of that device in sysfs. 1100 * The pointer to the struct device will be returned from the call. 1101 * Any further sysfs files that might be required can be created using this 1102 * pointer. 1103 * 1104 * Note: the struct class passed to this function must have previously 1105 * been created with a call to class_create(). 1106 */ 1107 struct device *device_create(struct class *class, struct device *parent, 1108 dev_t devt, const char *fmt, ...) 1109 { 1110 va_list args; 1111 struct device *dev = NULL; 1112 int retval = -ENODEV; 1113 1114 if (class == NULL || IS_ERR(class)) 1115 goto error; 1116 1117 dev = kzalloc(sizeof(*dev), GFP_KERNEL); 1118 if (!dev) { 1119 retval = -ENOMEM; 1120 goto error; 1121 } 1122 1123 dev->devt = devt; 1124 dev->class = class; 1125 dev->parent = parent; 1126 dev->release = device_create_release; 1127 1128 va_start(args, fmt); 1129 vsnprintf(dev->bus_id, BUS_ID_SIZE, fmt, args); 1130 va_end(args); 1131 retval = device_register(dev); 1132 if (retval) 1133 goto error; 1134 1135 return dev; 1136 1137 error: 1138 kfree(dev); 1139 return ERR_PTR(retval); 1140 } 1141 EXPORT_SYMBOL_GPL(device_create); 1142 1143 static int __match_devt(struct device *dev, void *data) 1144 { 1145 dev_t *devt = data; 1146 1147 return dev->devt == *devt; 1148 } 1149 1150 /** 1151 * device_destroy - removes a device that was created with device_create() 1152 * @class: pointer to the struct class that this device was registered with 1153 * @devt: the dev_t of the device that was previously registered 1154 * 1155 * This call unregisters and cleans up a device that was created with a 1156 * call to device_create(). 1157 */ 1158 void device_destroy(struct class *class, dev_t devt) 1159 { 1160 struct device *dev; 1161 1162 dev = class_find_device(class, &devt, __match_devt); 1163 if (dev) { 1164 put_device(dev); 1165 device_unregister(dev); 1166 } 1167 } 1168 EXPORT_SYMBOL_GPL(device_destroy); 1169 1170 #ifdef CONFIG_PM_SLEEP 1171 /** 1172 * destroy_suspended_device - asks the PM core to remove a suspended device 1173 * @class: pointer to the struct class that this device was registered with 1174 * @devt: the dev_t of the device that was previously registered 1175 * 1176 * This call notifies the PM core of the necessity to unregister a suspended 1177 * device created with a call to device_create() (devices cannot be 1178 * unregistered directly while suspended, since the PM core holds their 1179 * semaphores at that time). 1180 * 1181 * It can only be called within the scope of a system sleep transition. In 1182 * practice this means it has to be directly or indirectly invoked either by 1183 * a suspend or resume method, or by the PM core (e.g. via 1184 * disable_nonboot_cpus() or enable_nonboot_cpus()). 1185 */ 1186 void destroy_suspended_device(struct class *class, dev_t devt) 1187 { 1188 struct device *dev; 1189 1190 dev = class_find_device(class, &devt, __match_devt); 1191 if (dev) { 1192 device_pm_schedule_removal(dev); 1193 put_device(dev); 1194 } 1195 } 1196 EXPORT_SYMBOL_GPL(destroy_suspended_device); 1197 #endif /* CONFIG_PM_SLEEP */ 1198 1199 /** 1200 * device_rename - renames a device 1201 * @dev: the pointer to the struct device to be renamed 1202 * @new_name: the new name of the device 1203 */ 1204 int device_rename(struct device *dev, char *new_name) 1205 { 1206 char *old_class_name = NULL; 1207 char *new_class_name = NULL; 1208 char *old_device_name = NULL; 1209 int error; 1210 1211 dev = get_device(dev); 1212 if (!dev) 1213 return -EINVAL; 1214 1215 pr_debug("device: '%s': %s: renaming to '%s'\n", dev->bus_id, 1216 __FUNCTION__, new_name); 1217 1218 #ifdef CONFIG_SYSFS_DEPRECATED 1219 if ((dev->class) && (dev->parent)) 1220 old_class_name = make_class_name(dev->class->name, &dev->kobj); 1221 #endif 1222 1223 old_device_name = kmalloc(BUS_ID_SIZE, GFP_KERNEL); 1224 if (!old_device_name) { 1225 error = -ENOMEM; 1226 goto out; 1227 } 1228 strlcpy(old_device_name, dev->bus_id, BUS_ID_SIZE); 1229 strlcpy(dev->bus_id, new_name, BUS_ID_SIZE); 1230 1231 error = kobject_rename(&dev->kobj, new_name); 1232 if (error) { 1233 strlcpy(dev->bus_id, old_device_name, BUS_ID_SIZE); 1234 goto out; 1235 } 1236 1237 #ifdef CONFIG_SYSFS_DEPRECATED 1238 if (old_class_name) { 1239 new_class_name = make_class_name(dev->class->name, &dev->kobj); 1240 if (new_class_name) { 1241 error = sysfs_create_link(&dev->parent->kobj, 1242 &dev->kobj, new_class_name); 1243 if (error) 1244 goto out; 1245 sysfs_remove_link(&dev->parent->kobj, old_class_name); 1246 } 1247 } 1248 #else 1249 if (dev->class) { 1250 sysfs_remove_link(&dev->class->subsys.kobj, old_device_name); 1251 error = sysfs_create_link(&dev->class->subsys.kobj, &dev->kobj, 1252 dev->bus_id); 1253 if (error) { 1254 dev_err(dev, "%s: sysfs_create_symlink failed (%d)\n", 1255 __FUNCTION__, error); 1256 } 1257 } 1258 #endif 1259 1260 out: 1261 put_device(dev); 1262 1263 kfree(new_class_name); 1264 kfree(old_class_name); 1265 kfree(old_device_name); 1266 1267 return error; 1268 } 1269 EXPORT_SYMBOL_GPL(device_rename); 1270 1271 static int device_move_class_links(struct device *dev, 1272 struct device *old_parent, 1273 struct device *new_parent) 1274 { 1275 int error = 0; 1276 #ifdef CONFIG_SYSFS_DEPRECATED 1277 char *class_name; 1278 1279 class_name = make_class_name(dev->class->name, &dev->kobj); 1280 if (!class_name) { 1281 error = -ENOMEM; 1282 goto out; 1283 } 1284 if (old_parent) { 1285 sysfs_remove_link(&dev->kobj, "device"); 1286 sysfs_remove_link(&old_parent->kobj, class_name); 1287 } 1288 if (new_parent) { 1289 error = sysfs_create_link(&dev->kobj, &new_parent->kobj, 1290 "device"); 1291 if (error) 1292 goto out; 1293 error = sysfs_create_link(&new_parent->kobj, &dev->kobj, 1294 class_name); 1295 if (error) 1296 sysfs_remove_link(&dev->kobj, "device"); 1297 } else 1298 error = 0; 1299 out: 1300 kfree(class_name); 1301 return error; 1302 #else 1303 if (old_parent) 1304 sysfs_remove_link(&dev->kobj, "device"); 1305 if (new_parent) 1306 error = sysfs_create_link(&dev->kobj, &new_parent->kobj, 1307 "device"); 1308 return error; 1309 #endif 1310 } 1311 1312 /** 1313 * device_move - moves a device to a new parent 1314 * @dev: the pointer to the struct device to be moved 1315 * @new_parent: the new parent of the device (can by NULL) 1316 */ 1317 int device_move(struct device *dev, struct device *new_parent) 1318 { 1319 int error; 1320 struct device *old_parent; 1321 struct kobject *new_parent_kobj; 1322 1323 dev = get_device(dev); 1324 if (!dev) 1325 return -EINVAL; 1326 1327 new_parent = get_device(new_parent); 1328 new_parent_kobj = get_device_parent(dev, new_parent); 1329 1330 pr_debug("device: '%s': %s: moving to '%s'\n", dev->bus_id, 1331 __FUNCTION__, new_parent ? new_parent->bus_id : "<NULL>"); 1332 error = kobject_move(&dev->kobj, new_parent_kobj); 1333 if (error) { 1334 cleanup_glue_dir(dev, new_parent_kobj); 1335 put_device(new_parent); 1336 goto out; 1337 } 1338 old_parent = dev->parent; 1339 dev->parent = new_parent; 1340 if (old_parent) 1341 klist_remove(&dev->knode_parent); 1342 if (new_parent) 1343 klist_add_tail(&dev->knode_parent, &new_parent->klist_children); 1344 if (!dev->class) 1345 goto out_put; 1346 error = device_move_class_links(dev, old_parent, new_parent); 1347 if (error) { 1348 /* We ignore errors on cleanup since we're hosed anyway... */ 1349 device_move_class_links(dev, new_parent, old_parent); 1350 if (!kobject_move(&dev->kobj, &old_parent->kobj)) { 1351 if (new_parent) 1352 klist_remove(&dev->knode_parent); 1353 if (old_parent) 1354 klist_add_tail(&dev->knode_parent, 1355 &old_parent->klist_children); 1356 } 1357 cleanup_glue_dir(dev, new_parent_kobj); 1358 put_device(new_parent); 1359 goto out; 1360 } 1361 out_put: 1362 put_device(old_parent); 1363 out: 1364 put_device(dev); 1365 return error; 1366 } 1367 EXPORT_SYMBOL_GPL(device_move); 1368 1369 /** 1370 * device_shutdown - call ->shutdown() on each device to shutdown. 1371 */ 1372 void device_shutdown(void) 1373 { 1374 struct device *dev, *devn; 1375 1376 list_for_each_entry_safe_reverse(dev, devn, &devices_kset->list, 1377 kobj.entry) { 1378 if (dev->bus && dev->bus->shutdown) { 1379 dev_dbg(dev, "shutdown\n"); 1380 dev->bus->shutdown(dev); 1381 } else if (dev->driver && dev->driver->shutdown) { 1382 dev_dbg(dev, "shutdown\n"); 1383 dev->driver->shutdown(dev); 1384 } 1385 } 1386 } 1387