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 27int (*platform_notify)(struct device *dev) = NULL; 28int (*platform_notify_remove)(struct device *dev) = NULL; 29 30#ifdef CONFIG_BLOCK 31static inline int device_is_not_partition(struct device *dev) 32{ 33 return !(dev->type == &part_type); 34} 35#else 36static 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 */ 51const 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} 57EXPORT_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 62static 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 74static 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 86static 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 */ 100static 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 118static struct kobj_type device_ktype = { 119 .release = device_release, 120 .sysfs_ops = &dev_sysfs_ops, 121}; 122 123 124static 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 140static 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 151static 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 229static struct kset_uevent_ops device_uevent_ops = { 230 .filter = dev_uevent_filter, 231 .name = dev_uevent_name, 232 .uevent = dev_uevent, 233}; 234 235static 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]); 273out: 274 kfree(env); 275 return count; 276} 277 278static 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); 291out: 292 return count; 293} 294 295static struct device_attribute uevent_attr = 296 __ATTR(uevent, S_IRUGO | S_IWUSR, show_uevent, store_uevent); 297 298static 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 317static 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 327static 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 347static 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 357static 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 391static 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 406static 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 412static struct device_attribute devt_attr = 413 __ATTR(dev, S_IRUGO, show_dev, NULL); 414 415/* kset to create /sys/devices/ */ 416struct kset *devices_kset; 417 418/** 419 * device_create_file - create sysfs attribute file for device. 420 * @dev: device. 421 * @attr: device attribute descriptor. 422 */ 423int device_create_file(struct device *dev, struct device_attribute *attr) 424{ 425 int error = 0; 426 if (get_device(dev)) { 427 error = sysfs_create_file(&dev->kobj, &attr->attr); 428 put_device(dev); 429 } 430 return error; 431} 432 433/** 434 * device_remove_file - remove sysfs attribute file. 435 * @dev: device. 436 * @attr: device attribute descriptor. 437 */ 438void device_remove_file(struct device *dev, struct device_attribute *attr) 439{ 440 if (get_device(dev)) { 441 sysfs_remove_file(&dev->kobj, &attr->attr); 442 put_device(dev); 443 } 444} 445 446/** 447 * device_create_bin_file - create sysfs binary attribute file for device. 448 * @dev: device. 449 * @attr: device binary attribute descriptor. 450 */ 451int device_create_bin_file(struct device *dev, struct bin_attribute *attr) 452{ 453 int error = -EINVAL; 454 if (dev) 455 error = sysfs_create_bin_file(&dev->kobj, attr); 456 return error; 457} 458EXPORT_SYMBOL_GPL(device_create_bin_file); 459 460/** 461 * device_remove_bin_file - remove sysfs binary attribute file 462 * @dev: device. 463 * @attr: device binary attribute descriptor. 464 */ 465void device_remove_bin_file(struct device *dev, struct bin_attribute *attr) 466{ 467 if (dev) 468 sysfs_remove_bin_file(&dev->kobj, attr); 469} 470EXPORT_SYMBOL_GPL(device_remove_bin_file); 471 472/** 473 * device_schedule_callback_owner - helper to schedule a callback for a device 474 * @dev: device. 475 * @func: callback function to invoke later. 476 * @owner: module owning the callback routine 477 * 478 * Attribute methods must not unregister themselves or their parent device 479 * (which would amount to the same thing). Attempts to do so will deadlock, 480 * since unregistration is mutually exclusive with driver callbacks. 481 * 482 * Instead methods can call this routine, which will attempt to allocate 483 * and schedule a workqueue request to call back @func with @dev as its 484 * argument in the workqueue's process context. @dev will be pinned until 485 * @func returns. 486 * 487 * This routine is usually called via the inline device_schedule_callback(), 488 * which automatically sets @owner to THIS_MODULE. 489 * 490 * Returns 0 if the request was submitted, -ENOMEM if storage could not 491 * be allocated, -ENODEV if a reference to @owner isn't available. 492 * 493 * NOTE: This routine won't work if CONFIG_SYSFS isn't set! It uses an 494 * underlying sysfs routine (since it is intended for use by attribute 495 * methods), and if sysfs isn't available you'll get nothing but -ENOSYS. 496 */ 497int device_schedule_callback_owner(struct device *dev, 498 void (*func)(struct device *), struct module *owner) 499{ 500 return sysfs_schedule_callback(&dev->kobj, 501 (void (*)(void *)) func, dev, owner); 502} 503EXPORT_SYMBOL_GPL(device_schedule_callback_owner); 504 505static void klist_children_get(struct klist_node *n) 506{ 507 struct device *dev = container_of(n, struct device, knode_parent); 508 509 get_device(dev); 510} 511 512static void klist_children_put(struct klist_node *n) 513{ 514 struct device *dev = container_of(n, struct device, knode_parent); 515 516 put_device(dev); 517} 518 519/** 520 * device_initialize - init device structure. 521 * @dev: device. 522 * 523 * This prepares the device for use by other layers, 524 * including adding it to the device hierarchy. 525 * It is the first half of device_register(), if called by 526 * that, though it can also be called separately, so one 527 * may use @dev's fields (e.g. the refcount). 528 */ 529void device_initialize(struct device *dev) 530{ 531 dev->kobj.kset = devices_kset; 532 kobject_init(&dev->kobj, &device_ktype); 533 klist_init(&dev->klist_children, klist_children_get, 534 klist_children_put); 535 INIT_LIST_HEAD(&dev->dma_pools); 536 INIT_LIST_HEAD(&dev->node); 537 init_MUTEX(&dev->sem); 538 spin_lock_init(&dev->devres_lock); 539 INIT_LIST_HEAD(&dev->devres_head); 540 device_init_wakeup(dev, 0); 541 set_dev_node(dev, -1); 542} 543 544#ifdef CONFIG_SYSFS_DEPRECATED 545static struct kobject *get_device_parent(struct device *dev, 546 struct device *parent) 547{ 548 /* class devices without a parent live in /sys/class/<classname>/ */ 549 if (dev->class && (!parent || parent->class != dev->class)) 550 return &dev->class->subsys.kobj; 551 /* all other devices keep their parent */ 552 else if (parent) 553 return &parent->kobj; 554 555 return NULL; 556} 557 558static inline void cleanup_device_parent(struct device *dev) {} 559static inline void cleanup_glue_dir(struct device *dev, 560 struct kobject *glue_dir) {} 561#else 562static struct kobject *virtual_device_parent(struct device *dev) 563{ 564 static struct kobject *virtual_dir = NULL; 565 566 if (!virtual_dir) 567 virtual_dir = kobject_create_and_add("virtual", 568 &devices_kset->kobj); 569 570 return virtual_dir; 571} 572 573static struct kobject *get_device_parent(struct device *dev, 574 struct device *parent) 575{ 576 int retval; 577 578 if (dev->class) { 579 struct kobject *kobj = NULL; 580 struct kobject *parent_kobj; 581 struct kobject *k; 582 583 /* 584 * If we have no parent, we live in "virtual". 585 * Class-devices with a non class-device as parent, live 586 * in a "glue" directory to prevent namespace collisions. 587 */ 588 if (parent == NULL) 589 parent_kobj = virtual_device_parent(dev); 590 else if (parent->class) 591 return &parent->kobj; 592 else 593 parent_kobj = &parent->kobj; 594 595 /* find our class-directory at the parent and reference it */ 596 spin_lock(&dev->class->class_dirs.list_lock); 597 list_for_each_entry(k, &dev->class->class_dirs.list, entry) 598 if (k->parent == parent_kobj) { 599 kobj = kobject_get(k); 600 break; 601 } 602 spin_unlock(&dev->class->class_dirs.list_lock); 603 if (kobj) 604 return kobj; 605 606 /* or create a new class-directory at the parent device */ 607 k = kobject_create(); 608 if (!k) 609 return NULL; 610 k->kset = &dev->class->class_dirs; 611 retval = kobject_add(k, parent_kobj, "%s", dev->class->name); 612 if (retval < 0) { 613 kobject_put(k); 614 return NULL; 615 } 616 /* do not emit an uevent for this simple "glue" directory */ 617 return k; 618 } 619 620 if (parent) 621 return &parent->kobj; 622 return NULL; 623} 624 625static void cleanup_glue_dir(struct device *dev, struct kobject *glue_dir) 626{ 627 /* see if we live in a "glue" directory */ 628 if (!dev->class || glue_dir->kset != &dev->class->class_dirs) 629 return; 630 631 kobject_put(glue_dir); 632} 633 634static void cleanup_device_parent(struct device *dev) 635{ 636 cleanup_glue_dir(dev, dev->kobj.parent); 637} 638#endif 639 640static void setup_parent(struct device *dev, struct device *parent) 641{ 642 struct kobject *kobj; 643 kobj = get_device_parent(dev, parent); 644 if (kobj) 645 dev->kobj.parent = kobj; 646} 647 648static int device_add_class_symlinks(struct device *dev) 649{ 650 int error; 651 652 if (!dev->class) 653 return 0; 654 655 error = sysfs_create_link(&dev->kobj, &dev->class->subsys.kobj, 656 "subsystem"); 657 if (error) 658 goto out; 659 660#ifdef CONFIG_SYSFS_DEPRECATED 661 /* stacked class devices need a symlink in the class directory */ 662 if (dev->kobj.parent != &dev->class->subsys.kobj && 663 device_is_not_partition(dev)) { 664 error = sysfs_create_link(&dev->class->subsys.kobj, &dev->kobj, 665 dev->bus_id); 666 if (error) 667 goto out_subsys; 668 } 669 670 if (dev->parent && device_is_not_partition(dev)) { 671 struct device *parent = dev->parent; 672 char *class_name; 673 674 /* 675 * stacked class devices have the 'device' link 676 * pointing to the bus device instead of the parent 677 */ 678 while (parent->class && !parent->bus && parent->parent) 679 parent = parent->parent; 680 681 error = sysfs_create_link(&dev->kobj, 682 &parent->kobj, 683 "device"); 684 if (error) 685 goto out_busid; 686 687 class_name = make_class_name(dev->class->name, 688 &dev->kobj); 689 if (class_name) 690 error = sysfs_create_link(&dev->parent->kobj, 691 &dev->kobj, class_name); 692 kfree(class_name); 693 if (error) 694 goto out_device; 695 } 696 return 0; 697 698out_device: 699 if (dev->parent && device_is_not_partition(dev)) 700 sysfs_remove_link(&dev->kobj, "device"); 701out_busid: 702 if (dev->kobj.parent != &dev->class->subsys.kobj && 703 device_is_not_partition(dev)) 704 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 705#else 706 /* link in the class directory pointing to the device */ 707 error = sysfs_create_link(&dev->class->subsys.kobj, &dev->kobj, 708 dev->bus_id); 709 if (error) 710 goto out_subsys; 711 712 if (dev->parent && device_is_not_partition(dev)) { 713 error = sysfs_create_link(&dev->kobj, &dev->parent->kobj, 714 "device"); 715 if (error) 716 goto out_busid; 717 } 718 return 0; 719 720out_busid: 721 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 722#endif 723 724out_subsys: 725 sysfs_remove_link(&dev->kobj, "subsystem"); 726out: 727 return error; 728} 729 730static void device_remove_class_symlinks(struct device *dev) 731{ 732 if (!dev->class) 733 return; 734 735#ifdef CONFIG_SYSFS_DEPRECATED 736 if (dev->parent && device_is_not_partition(dev)) { 737 char *class_name; 738 739 class_name = make_class_name(dev->class->name, &dev->kobj); 740 if (class_name) { 741 sysfs_remove_link(&dev->parent->kobj, class_name); 742 kfree(class_name); 743 } 744 sysfs_remove_link(&dev->kobj, "device"); 745 } 746 747 if (dev->kobj.parent != &dev->class->subsys.kobj && 748 device_is_not_partition(dev)) 749 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 750#else 751 if (dev->parent && device_is_not_partition(dev)) 752 sysfs_remove_link(&dev->kobj, "device"); 753 754 sysfs_remove_link(&dev->class->subsys.kobj, dev->bus_id); 755#endif 756 757 sysfs_remove_link(&dev->kobj, "subsystem"); 758} 759 760/** 761 * device_add - add device to device hierarchy. 762 * @dev: device. 763 * 764 * This is part 2 of device_register(), though may be called 765 * separately _iff_ device_initialize() has been called separately. 766 * 767 * This adds it to the kobject hierarchy via kobject_add(), adds it 768 * to the global and sibling lists for the device, then 769 * adds it to the other relevant subsystems of the driver model. 770 */ 771int device_add(struct device *dev) 772{ 773 struct device *parent = NULL; 774 struct class_interface *class_intf; 775 int error; 776 777 error = pm_sleep_lock(); 778 if (error) { 779 dev_warn(dev, "Suspicious %s during suspend\n", __FUNCTION__); 780 dump_stack(); 781 return error; 782 } 783 784 dev = get_device(dev); 785 if (!dev || !strlen(dev->bus_id)) { 786 error = -EINVAL; 787 goto Error; 788 } 789 790 pr_debug("device: '%s': %s\n", dev->bus_id, __FUNCTION__); 791 792 parent = get_device(dev->parent); 793 setup_parent(dev, parent); 794 795 /* first, register with generic layer. */ 796 error = kobject_add(&dev->kobj, dev->kobj.parent, "%s", dev->bus_id); 797 if (error) 798 goto Error; 799 800 /* notify platform of device entry */ 801 if (platform_notify) 802 platform_notify(dev); 803 804 /* notify clients of device entry (new way) */ 805 if (dev->bus) 806 blocking_notifier_call_chain(&dev->bus->p->bus_notifier, 807 BUS_NOTIFY_ADD_DEVICE, dev); 808 809 error = device_create_file(dev, &uevent_attr); 810 if (error) 811 goto attrError; 812 813 if (MAJOR(dev->devt)) { 814 error = device_create_file(dev, &devt_attr); 815 if (error) 816 goto ueventattrError; 817 } 818 819 error = device_add_class_symlinks(dev); 820 if (error) 821 goto SymlinkError; 822 error = device_add_attrs(dev); 823 if (error) 824 goto AttrsError; 825 error = dpm_sysfs_add(dev); 826 if (error) 827 goto PMError; 828 device_pm_add(dev); 829 error = bus_add_device(dev); 830 if (error) 831 goto BusError; 832 kobject_uevent(&dev->kobj, KOBJ_ADD); 833 bus_attach_device(dev); 834 if (parent) 835 klist_add_tail(&dev->knode_parent, &parent->klist_children); 836 837 if (dev->class) { 838 down(&dev->class->sem); 839 /* tie the class to the device */ 840 list_add_tail(&dev->node, &dev->class->devices); 841 842 /* notify any interfaces that the device is here */ 843 list_for_each_entry(class_intf, &dev->class->interfaces, node) 844 if (class_intf->add_dev) 845 class_intf->add_dev(dev, class_intf); 846 up(&dev->class->sem); 847 } 848 Done: 849 put_device(dev); 850 pm_sleep_unlock(); 851 return error; 852 BusError: 853 device_pm_remove(dev); 854 dpm_sysfs_remove(dev); 855 PMError: 856 if (dev->bus) 857 blocking_notifier_call_chain(&dev->bus->p->bus_notifier, 858 BUS_NOTIFY_DEL_DEVICE, dev); 859 device_remove_attrs(dev); 860 AttrsError: 861 device_remove_class_symlinks(dev); 862 SymlinkError: 863 if (MAJOR(dev->devt)) 864 device_remove_file(dev, &devt_attr); 865 ueventattrError: 866 device_remove_file(dev, &uevent_attr); 867 attrError: 868 kobject_uevent(&dev->kobj, KOBJ_REMOVE); 869 kobject_del(&dev->kobj); 870 Error: 871 cleanup_device_parent(dev); 872 if (parent) 873 put_device(parent); 874 goto Done; 875} 876 877/** 878 * device_register - register a device with the system. 879 * @dev: pointer to the device structure 880 * 881 * This happens in two clean steps - initialize the device 882 * and add it to the system. The two steps can be called 883 * separately, but this is the easiest and most common. 884 * I.e. you should only call the two helpers separately if 885 * have a clearly defined need to use and refcount the device 886 * before it is added to the hierarchy. 887 */ 888int device_register(struct device *dev) 889{ 890 device_initialize(dev); 891 return device_add(dev); 892} 893 894/** 895 * get_device - increment reference count for device. 896 * @dev: device. 897 * 898 * This simply forwards the call to kobject_get(), though 899 * we do take care to provide for the case that we get a NULL 900 * pointer passed in. 901 */ 902struct device *get_device(struct device *dev) 903{ 904 return dev ? to_dev(kobject_get(&dev->kobj)) : NULL; 905} 906 907/** 908 * put_device - decrement reference count. 909 * @dev: device in question. 910 */ 911void put_device(struct device *dev) 912{ 913 /* might_sleep(); */ 914 if (dev) 915 kobject_put(&dev->kobj); 916} 917 918/** 919 * device_del - delete device from system. 920 * @dev: device. 921 * 922 * This is the first part of the device unregistration 923 * sequence. This removes the device from the lists we control 924 * from here, has it removed from the other driver model 925 * subsystems it was added to in device_add(), and removes it 926 * from the kobject hierarchy. 927 * 928 * NOTE: this should be called manually _iff_ device_add() was 929 * also called manually. 930 */ 931void device_del(struct device *dev) 932{ 933 struct device *parent = dev->parent; 934 struct class_interface *class_intf; 935 936 device_pm_remove(dev); 937 if (parent) 938 klist_del(&dev->knode_parent); 939 if (MAJOR(dev->devt)) 940 device_remove_file(dev, &devt_attr); 941 if (dev->class) { 942 device_remove_class_symlinks(dev); 943 944 down(&dev->class->sem); 945 /* notify any interfaces that the device is now gone */ 946 list_for_each_entry(class_intf, &dev->class->interfaces, node) 947 if (class_intf->remove_dev) 948 class_intf->remove_dev(dev, class_intf); 949 /* remove the device from the class list */ 950 list_del_init(&dev->node); 951 up(&dev->class->sem); 952 } 953 device_remove_file(dev, &uevent_attr); 954 device_remove_attrs(dev); 955 bus_remove_device(dev); 956 957 /* 958 * Some platform devices are driven without driver attached 959 * and managed resources may have been acquired. Make sure 960 * all resources are released. 961 */ 962 devres_release_all(dev); 963 964 /* Notify the platform of the removal, in case they 965 * need to do anything... 966 */ 967 if (platform_notify_remove) 968 platform_notify_remove(dev); 969 if (dev->bus) 970 blocking_notifier_call_chain(&dev->bus->p->bus_notifier, 971 BUS_NOTIFY_DEL_DEVICE, dev); 972 kobject_uevent(&dev->kobj, KOBJ_REMOVE); 973 cleanup_device_parent(dev); 974 kobject_del(&dev->kobj); 975 put_device(parent); 976} 977 978/** 979 * device_unregister - unregister device from system. 980 * @dev: device going away. 981 * 982 * We do this in two parts, like we do device_register(). First, 983 * we remove it from all the subsystems with device_del(), then 984 * we decrement the reference count via put_device(). If that 985 * is the final reference count, the device will be cleaned up 986 * via device_release() above. Otherwise, the structure will 987 * stick around until the final reference to the device is dropped. 988 */ 989void device_unregister(struct device *dev) 990{ 991 pr_debug("device: '%s': %s\n", dev->bus_id, __FUNCTION__); 992 device_del(dev); 993 put_device(dev); 994} 995 996static struct device *next_device(struct klist_iter *i) 997{ 998 struct klist_node *n = klist_next(i); 999 return n ? container_of(n, struct device, knode_parent) : NULL; 1000} 1001 1002/** 1003 * device_for_each_child - device child iterator. 1004 * @parent: parent struct device. 1005 * @data: data for the callback. 1006 * @fn: function to be called for each device. 1007 * 1008 * Iterate over @parent's child devices, and call @fn for each, 1009 * passing it @data. 1010 * 1011 * We check the return of @fn each time. If it returns anything 1012 * other than 0, we break out and return that value. 1013 */ 1014int device_for_each_child(struct device *parent, void *data, 1015 int (*fn)(struct device *dev, void *data)) 1016{ 1017 struct klist_iter i; 1018 struct device *child; 1019 int error = 0; 1020 1021 klist_iter_init(&parent->klist_children, &i); 1022 while ((child = next_device(&i)) && !error) 1023 error = fn(child, data); 1024 klist_iter_exit(&i); 1025 return error; 1026} 1027 1028/** 1029 * device_find_child - device iterator for locating a particular device. 1030 * @parent: parent struct device 1031 * @data: Data to pass to match function 1032 * @match: Callback function to check device 1033 * 1034 * This is similar to the device_for_each_child() function above, but it 1035 * returns a reference to a device that is 'found' for later use, as 1036 * determined by the @match callback. 1037 * 1038 * The callback should return 0 if the device doesn't match and non-zero 1039 * if it does. If the callback returns non-zero and a reference to the 1040 * current device can be obtained, this function will return to the caller 1041 * and not iterate over any more devices. 1042 */ 1043struct device *device_find_child(struct device *parent, void *data, 1044 int (*match)(struct device *dev, void *data)) 1045{ 1046 struct klist_iter i; 1047 struct device *child; 1048 1049 if (!parent) 1050 return NULL; 1051 1052 klist_iter_init(&parent->klist_children, &i); 1053 while ((child = next_device(&i))) 1054 if (match(child, data) && get_device(child)) 1055 break; 1056 klist_iter_exit(&i); 1057 return child; 1058} 1059 1060int __init devices_init(void) 1061{ 1062 devices_kset = kset_create_and_add("devices", &device_uevent_ops, NULL); 1063 if (!devices_kset) 1064 return -ENOMEM; 1065 return 0; 1066} 1067 1068EXPORT_SYMBOL_GPL(device_for_each_child); 1069EXPORT_SYMBOL_GPL(device_find_child); 1070 1071EXPORT_SYMBOL_GPL(device_initialize); 1072EXPORT_SYMBOL_GPL(device_add); 1073EXPORT_SYMBOL_GPL(device_register); 1074 1075EXPORT_SYMBOL_GPL(device_del); 1076EXPORT_SYMBOL_GPL(device_unregister); 1077EXPORT_SYMBOL_GPL(get_device); 1078EXPORT_SYMBOL_GPL(put_device); 1079 1080EXPORT_SYMBOL_GPL(device_create_file); 1081EXPORT_SYMBOL_GPL(device_remove_file); 1082 1083 1084static void device_create_release(struct device *dev) 1085{ 1086 pr_debug("device: '%s': %s\n", dev->bus_id, __FUNCTION__); 1087 kfree(dev); 1088} 1089 1090/** 1091 * device_create - creates a device and registers it with sysfs 1092 * @class: pointer to the struct class that this device should be registered to 1093 * @parent: pointer to the parent struct device of this new device, if any 1094 * @devt: the dev_t for the char device to be added 1095 * @fmt: string for the device's name 1096 * 1097 * This function can be used by char device classes. A struct device 1098 * will be created in sysfs, registered to the specified class. 1099 * 1100 * A "dev" file will be created, showing the dev_t for the device, if 1101 * the dev_t is not 0,0. 1102 * If a pointer to a parent struct device is passed in, the newly created 1103 * struct device will be a child of that device in sysfs. 1104 * The pointer to the struct device will be returned from the call. 1105 * Any further sysfs files that might be required can be created using this 1106 * pointer. 1107 * 1108 * Note: the struct class passed to this function must have previously 1109 * been created with a call to class_create(). 1110 */ 1111struct device *device_create(struct class *class, struct device *parent, 1112 dev_t devt, const char *fmt, ...) 1113{ 1114 va_list args; 1115 struct device *dev = NULL; 1116 int retval = -ENODEV; 1117 1118 if (class == NULL || IS_ERR(class)) 1119 goto error; 1120 1121 dev = kzalloc(sizeof(*dev), GFP_KERNEL); 1122 if (!dev) { 1123 retval = -ENOMEM; 1124 goto error; 1125 } 1126 1127 dev->devt = devt; 1128 dev->class = class; 1129 dev->parent = parent; 1130 dev->release = device_create_release; 1131 1132 va_start(args, fmt); 1133 vsnprintf(dev->bus_id, BUS_ID_SIZE, fmt, args); 1134 va_end(args); 1135 retval = device_register(dev); 1136 if (retval) 1137 goto error; 1138 1139 return dev; 1140 1141error: 1142 kfree(dev); 1143 return ERR_PTR(retval); 1144} 1145EXPORT_SYMBOL_GPL(device_create); 1146 1147/** 1148 * find_device - finds a device that was created with device_create() 1149 * @class: pointer to the struct class that this device was registered with 1150 * @devt: the dev_t of the device that was previously registered 1151 */ 1152static struct device *find_device(struct class *class, dev_t devt) 1153{ 1154 struct device *dev = NULL; 1155 struct device *dev_tmp; 1156 1157 down(&class->sem); 1158 list_for_each_entry(dev_tmp, &class->devices, node) { 1159 if (dev_tmp->devt == devt) { 1160 dev = dev_tmp; 1161 break; 1162 } 1163 } 1164 up(&class->sem); 1165 return dev; 1166} 1167 1168/** 1169 * device_destroy - removes a device that was created with device_create() 1170 * @class: pointer to the struct class that this device was registered with 1171 * @devt: the dev_t of the device that was previously registered 1172 * 1173 * This call unregisters and cleans up a device that was created with a 1174 * call to device_create(). 1175 */ 1176void device_destroy(struct class *class, dev_t devt) 1177{ 1178 struct device *dev; 1179 1180 dev = find_device(class, devt); 1181 if (dev) 1182 device_unregister(dev); 1183} 1184EXPORT_SYMBOL_GPL(device_destroy); 1185 1186#ifdef CONFIG_PM_SLEEP 1187/** 1188 * destroy_suspended_device - asks the PM core to remove a suspended device 1189 * @class: pointer to the struct class that this device was registered with 1190 * @devt: the dev_t of the device that was previously registered 1191 * 1192 * This call notifies the PM core of the necessity to unregister a suspended 1193 * device created with a call to device_create() (devices cannot be 1194 * unregistered directly while suspended, since the PM core holds their 1195 * semaphores at that time). 1196 * 1197 * It can only be called within the scope of a system sleep transition. In 1198 * practice this means it has to be directly or indirectly invoked either by 1199 * a suspend or resume method, or by the PM core (e.g. via 1200 * disable_nonboot_cpus() or enable_nonboot_cpus()). 1201 */ 1202void destroy_suspended_device(struct class *class, dev_t devt) 1203{ 1204 struct device *dev; 1205 1206 dev = find_device(class, devt); 1207 if (dev) 1208 device_pm_schedule_removal(dev); 1209} 1210EXPORT_SYMBOL_GPL(destroy_suspended_device); 1211#endif /* CONFIG_PM_SLEEP */ 1212 1213/** 1214 * device_rename - renames a device 1215 * @dev: the pointer to the struct device to be renamed 1216 * @new_name: the new name of the device 1217 */ 1218int device_rename(struct device *dev, char *new_name) 1219{ 1220 char *old_class_name = NULL; 1221 char *new_class_name = NULL; 1222 char *old_device_name = NULL; 1223 int error; 1224 1225 dev = get_device(dev); 1226 if (!dev) 1227 return -EINVAL; 1228 1229 pr_debug("device: '%s': %s: renaming to '%s'\n", dev->bus_id, 1230 __FUNCTION__, new_name); 1231 1232#ifdef CONFIG_SYSFS_DEPRECATED 1233 if ((dev->class) && (dev->parent)) 1234 old_class_name = make_class_name(dev->class->name, &dev->kobj); 1235#endif 1236 1237 old_device_name = kmalloc(BUS_ID_SIZE, GFP_KERNEL); 1238 if (!old_device_name) { 1239 error = -ENOMEM; 1240 goto out; 1241 } 1242 strlcpy(old_device_name, dev->bus_id, BUS_ID_SIZE); 1243 strlcpy(dev->bus_id, new_name, BUS_ID_SIZE); 1244 1245 error = kobject_rename(&dev->kobj, new_name); 1246 if (error) { 1247 strlcpy(dev->bus_id, old_device_name, BUS_ID_SIZE); 1248 goto out; 1249 } 1250 1251#ifdef CONFIG_SYSFS_DEPRECATED 1252 if (old_class_name) { 1253 new_class_name = make_class_name(dev->class->name, &dev->kobj); 1254 if (new_class_name) { 1255 error = sysfs_create_link(&dev->parent->kobj, 1256 &dev->kobj, new_class_name); 1257 if (error) 1258 goto out; 1259 sysfs_remove_link(&dev->parent->kobj, old_class_name); 1260 } 1261 } 1262#else 1263 if (dev->class) { 1264 sysfs_remove_link(&dev->class->subsys.kobj, old_device_name); 1265 error = sysfs_create_link(&dev->class->subsys.kobj, &dev->kobj, 1266 dev->bus_id); 1267 if (error) { 1268 dev_err(dev, "%s: sysfs_create_symlink failed (%d)\n", 1269 __FUNCTION__, error); 1270 } 1271 } 1272#endif 1273 1274out: 1275 put_device(dev); 1276 1277 kfree(new_class_name); 1278 kfree(old_class_name); 1279 kfree(old_device_name); 1280 1281 return error; 1282} 1283EXPORT_SYMBOL_GPL(device_rename); 1284 1285static int device_move_class_links(struct device *dev, 1286 struct device *old_parent, 1287 struct device *new_parent) 1288{ 1289 int error = 0; 1290#ifdef CONFIG_SYSFS_DEPRECATED 1291 char *class_name; 1292 1293 class_name = make_class_name(dev->class->name, &dev->kobj); 1294 if (!class_name) { 1295 error = -ENOMEM; 1296 goto out; 1297 } 1298 if (old_parent) { 1299 sysfs_remove_link(&dev->kobj, "device"); 1300 sysfs_remove_link(&old_parent->kobj, class_name); 1301 } 1302 if (new_parent) { 1303 error = sysfs_create_link(&dev->kobj, &new_parent->kobj, 1304 "device"); 1305 if (error) 1306 goto out; 1307 error = sysfs_create_link(&new_parent->kobj, &dev->kobj, 1308 class_name); 1309 if (error) 1310 sysfs_remove_link(&dev->kobj, "device"); 1311 } else 1312 error = 0; 1313out: 1314 kfree(class_name); 1315 return error; 1316#else 1317 if (old_parent) 1318 sysfs_remove_link(&dev->kobj, "device"); 1319 if (new_parent) 1320 error = sysfs_create_link(&dev->kobj, &new_parent->kobj, 1321 "device"); 1322 return error; 1323#endif 1324} 1325 1326/** 1327 * device_move - moves a device to a new parent 1328 * @dev: the pointer to the struct device to be moved 1329 * @new_parent: the new parent of the device (can by NULL) 1330 */ 1331int device_move(struct device *dev, struct device *new_parent) 1332{ 1333 int error; 1334 struct device *old_parent; 1335 struct kobject *new_parent_kobj; 1336 1337 dev = get_device(dev); 1338 if (!dev) 1339 return -EINVAL; 1340 1341 new_parent = get_device(new_parent); 1342 new_parent_kobj = get_device_parent(dev, new_parent); 1343 1344 pr_debug("device: '%s': %s: moving to '%s'\n", dev->bus_id, 1345 __FUNCTION__, new_parent ? new_parent->bus_id : "<NULL>"); 1346 error = kobject_move(&dev->kobj, new_parent_kobj); 1347 if (error) { 1348 cleanup_glue_dir(dev, new_parent_kobj); 1349 put_device(new_parent); 1350 goto out; 1351 } 1352 old_parent = dev->parent; 1353 dev->parent = new_parent; 1354 if (old_parent) 1355 klist_remove(&dev->knode_parent); 1356 if (new_parent) 1357 klist_add_tail(&dev->knode_parent, &new_parent->klist_children); 1358 if (!dev->class) 1359 goto out_put; 1360 error = device_move_class_links(dev, old_parent, new_parent); 1361 if (error) { 1362 /* We ignore errors on cleanup since we're hosed anyway... */ 1363 device_move_class_links(dev, new_parent, old_parent); 1364 if (!kobject_move(&dev->kobj, &old_parent->kobj)) { 1365 if (new_parent) 1366 klist_remove(&dev->knode_parent); 1367 if (old_parent) 1368 klist_add_tail(&dev->knode_parent, 1369 &old_parent->klist_children); 1370 } 1371 cleanup_glue_dir(dev, new_parent_kobj); 1372 put_device(new_parent); 1373 goto out; 1374 } 1375out_put: 1376 put_device(old_parent); 1377out: 1378 put_device(dev); 1379 return error; 1380} 1381EXPORT_SYMBOL_GPL(device_move); 1382 1383/** 1384 * device_shutdown - call ->shutdown() on each device to shutdown. 1385 */ 1386void device_shutdown(void) 1387{ 1388 struct device *dev, *devn; 1389 1390 list_for_each_entry_safe_reverse(dev, devn, &devices_kset->list, 1391 kobj.entry) { 1392 if (dev->bus && dev->bus->shutdown) { 1393 dev_dbg(dev, "shutdown\n"); 1394 dev->bus->shutdown(dev); 1395 } else if (dev->driver && dev->driver->shutdown) { 1396 dev_dbg(dev, "shutdown\n"); 1397 dev->driver->shutdown(dev); 1398 } 1399 } 1400}