]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/base/core.c
e0998b6b6c4938f0ef8e93b84e6507b8e3c61752
[mirror_ubuntu-artful-kernel.git] / drivers / base / core.c
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/of.h>
22 #include <linux/of_device.h>
23 #include <linux/genhd.h>
24 #include <linux/kallsyms.h>
25 #include <linux/mutex.h>
26 #include <linux/pm_runtime.h>
27 #include <linux/netdevice.h>
28 #include <linux/sysfs.h>
29
30 #include "base.h"
31 #include "power/power.h"
32
33 #ifdef CONFIG_SYSFS_DEPRECATED
34 #ifdef CONFIG_SYSFS_DEPRECATED_V2
35 long sysfs_deprecated = 1;
36 #else
37 long sysfs_deprecated = 0;
38 #endif
39 static int __init sysfs_deprecated_setup(char *arg)
40 {
41 return kstrtol(arg, 10, &sysfs_deprecated);
42 }
43 early_param("sysfs.deprecated", sysfs_deprecated_setup);
44 #endif
45
46 int (*platform_notify)(struct device *dev) = NULL;
47 int (*platform_notify_remove)(struct device *dev) = NULL;
48 static struct kobject *dev_kobj;
49 struct kobject *sysfs_dev_char_kobj;
50 struct kobject *sysfs_dev_block_kobj;
51
52 static DEFINE_MUTEX(device_hotplug_lock);
53
54 void lock_device_hotplug(void)
55 {
56 mutex_lock(&device_hotplug_lock);
57 }
58
59 void unlock_device_hotplug(void)
60 {
61 mutex_unlock(&device_hotplug_lock);
62 }
63
64 int lock_device_hotplug_sysfs(void)
65 {
66 if (mutex_trylock(&device_hotplug_lock))
67 return 0;
68
69 /* Avoid busy looping (5 ms of sleep should do). */
70 msleep(5);
71 return restart_syscall();
72 }
73
74 #ifdef CONFIG_BLOCK
75 static inline int device_is_not_partition(struct device *dev)
76 {
77 return !(dev->type == &part_type);
78 }
79 #else
80 static inline int device_is_not_partition(struct device *dev)
81 {
82 return 1;
83 }
84 #endif
85
86 /**
87 * dev_driver_string - Return a device's driver name, if at all possible
88 * @dev: struct device to get the name of
89 *
90 * Will return the device's driver's name if it is bound to a device. If
91 * the device is not bound to a driver, it will return the name of the bus
92 * it is attached to. If it is not attached to a bus either, an empty
93 * string will be returned.
94 */
95 const char *dev_driver_string(const struct device *dev)
96 {
97 struct device_driver *drv;
98
99 /* dev->driver can change to NULL underneath us because of unbinding,
100 * so be careful about accessing it. dev->bus and dev->class should
101 * never change once they are set, so they don't need special care.
102 */
103 drv = ACCESS_ONCE(dev->driver);
104 return drv ? drv->name :
105 (dev->bus ? dev->bus->name :
106 (dev->class ? dev->class->name : ""));
107 }
108 EXPORT_SYMBOL(dev_driver_string);
109
110 #define to_dev_attr(_attr) container_of(_attr, struct device_attribute, attr)
111
112 static ssize_t dev_attr_show(struct kobject *kobj, struct attribute *attr,
113 char *buf)
114 {
115 struct device_attribute *dev_attr = to_dev_attr(attr);
116 struct device *dev = kobj_to_dev(kobj);
117 ssize_t ret = -EIO;
118
119 if (dev_attr->show)
120 ret = dev_attr->show(dev, dev_attr, buf);
121 if (ret >= (ssize_t)PAGE_SIZE) {
122 print_symbol("dev_attr_show: %s returned bad count\n",
123 (unsigned long)dev_attr->show);
124 }
125 return ret;
126 }
127
128 static ssize_t dev_attr_store(struct kobject *kobj, struct attribute *attr,
129 const char *buf, size_t count)
130 {
131 struct device_attribute *dev_attr = to_dev_attr(attr);
132 struct device *dev = kobj_to_dev(kobj);
133 ssize_t ret = -EIO;
134
135 if (dev_attr->store)
136 ret = dev_attr->store(dev, dev_attr, buf, count);
137 return ret;
138 }
139
140 static const struct sysfs_ops dev_sysfs_ops = {
141 .show = dev_attr_show,
142 .store = dev_attr_store,
143 };
144
145 #define to_ext_attr(x) container_of(x, struct dev_ext_attribute, attr)
146
147 ssize_t device_store_ulong(struct device *dev,
148 struct device_attribute *attr,
149 const char *buf, size_t size)
150 {
151 struct dev_ext_attribute *ea = to_ext_attr(attr);
152 char *end;
153 unsigned long new = simple_strtoul(buf, &end, 0);
154 if (end == buf)
155 return -EINVAL;
156 *(unsigned long *)(ea->var) = new;
157 /* Always return full write size even if we didn't consume all */
158 return size;
159 }
160 EXPORT_SYMBOL_GPL(device_store_ulong);
161
162 ssize_t device_show_ulong(struct device *dev,
163 struct device_attribute *attr,
164 char *buf)
165 {
166 struct dev_ext_attribute *ea = to_ext_attr(attr);
167 return snprintf(buf, PAGE_SIZE, "%lx\n", *(unsigned long *)(ea->var));
168 }
169 EXPORT_SYMBOL_GPL(device_show_ulong);
170
171 ssize_t device_store_int(struct device *dev,
172 struct device_attribute *attr,
173 const char *buf, size_t size)
174 {
175 struct dev_ext_attribute *ea = to_ext_attr(attr);
176 char *end;
177 long new = simple_strtol(buf, &end, 0);
178 if (end == buf || new > INT_MAX || new < INT_MIN)
179 return -EINVAL;
180 *(int *)(ea->var) = new;
181 /* Always return full write size even if we didn't consume all */
182 return size;
183 }
184 EXPORT_SYMBOL_GPL(device_store_int);
185
186 ssize_t device_show_int(struct device *dev,
187 struct device_attribute *attr,
188 char *buf)
189 {
190 struct dev_ext_attribute *ea = to_ext_attr(attr);
191
192 return snprintf(buf, PAGE_SIZE, "%d\n", *(int *)(ea->var));
193 }
194 EXPORT_SYMBOL_GPL(device_show_int);
195
196 ssize_t device_store_bool(struct device *dev, struct device_attribute *attr,
197 const char *buf, size_t size)
198 {
199 struct dev_ext_attribute *ea = to_ext_attr(attr);
200
201 if (strtobool(buf, ea->var) < 0)
202 return -EINVAL;
203
204 return size;
205 }
206 EXPORT_SYMBOL_GPL(device_store_bool);
207
208 ssize_t device_show_bool(struct device *dev, struct device_attribute *attr,
209 char *buf)
210 {
211 struct dev_ext_attribute *ea = to_ext_attr(attr);
212
213 return snprintf(buf, PAGE_SIZE, "%d\n", *(bool *)(ea->var));
214 }
215 EXPORT_SYMBOL_GPL(device_show_bool);
216
217 /**
218 * device_release - free device structure.
219 * @kobj: device's kobject.
220 *
221 * This is called once the reference count for the object
222 * reaches 0. We forward the call to the device's release
223 * method, which should handle actually freeing the structure.
224 */
225 static void device_release(struct kobject *kobj)
226 {
227 struct device *dev = kobj_to_dev(kobj);
228 struct device_private *p = dev->p;
229
230 /*
231 * Some platform devices are driven without driver attached
232 * and managed resources may have been acquired. Make sure
233 * all resources are released.
234 *
235 * Drivers still can add resources into device after device
236 * is deleted but alive, so release devres here to avoid
237 * possible memory leak.
238 */
239 devres_release_all(dev);
240
241 if (dev->release)
242 dev->release(dev);
243 else if (dev->type && dev->type->release)
244 dev->type->release(dev);
245 else if (dev->class && dev->class->dev_release)
246 dev->class->dev_release(dev);
247 else
248 WARN(1, KERN_ERR "Device '%s' does not have a release() "
249 "function, it is broken and must be fixed.\n",
250 dev_name(dev));
251 kfree(p);
252 }
253
254 static const void *device_namespace(struct kobject *kobj)
255 {
256 struct device *dev = kobj_to_dev(kobj);
257 const void *ns = NULL;
258
259 if (dev->class && dev->class->ns_type)
260 ns = dev->class->namespace(dev);
261
262 return ns;
263 }
264
265 static struct kobj_type device_ktype = {
266 .release = device_release,
267 .sysfs_ops = &dev_sysfs_ops,
268 .namespace = device_namespace,
269 };
270
271
272 static int dev_uevent_filter(struct kset *kset, struct kobject *kobj)
273 {
274 struct kobj_type *ktype = get_ktype(kobj);
275
276 if (ktype == &device_ktype) {
277 struct device *dev = kobj_to_dev(kobj);
278 if (dev->bus)
279 return 1;
280 if (dev->class)
281 return 1;
282 }
283 return 0;
284 }
285
286 static const char *dev_uevent_name(struct kset *kset, struct kobject *kobj)
287 {
288 struct device *dev = kobj_to_dev(kobj);
289
290 if (dev->bus)
291 return dev->bus->name;
292 if (dev->class)
293 return dev->class->name;
294 return NULL;
295 }
296
297 static int dev_uevent(struct kset *kset, struct kobject *kobj,
298 struct kobj_uevent_env *env)
299 {
300 struct device *dev = kobj_to_dev(kobj);
301 int retval = 0;
302
303 /* add device node properties if present */
304 if (MAJOR(dev->devt)) {
305 const char *tmp;
306 const char *name;
307 umode_t mode = 0;
308 kuid_t uid = GLOBAL_ROOT_UID;
309 kgid_t gid = GLOBAL_ROOT_GID;
310
311 add_uevent_var(env, "MAJOR=%u", MAJOR(dev->devt));
312 add_uevent_var(env, "MINOR=%u", MINOR(dev->devt));
313 name = device_get_devnode(dev, &mode, &uid, &gid, &tmp);
314 if (name) {
315 add_uevent_var(env, "DEVNAME=%s", name);
316 if (mode)
317 add_uevent_var(env, "DEVMODE=%#o", mode & 0777);
318 if (!uid_eq(uid, GLOBAL_ROOT_UID))
319 add_uevent_var(env, "DEVUID=%u", from_kuid(&init_user_ns, uid));
320 if (!gid_eq(gid, GLOBAL_ROOT_GID))
321 add_uevent_var(env, "DEVGID=%u", from_kgid(&init_user_ns, gid));
322 kfree(tmp);
323 }
324 }
325
326 if (dev->type && dev->type->name)
327 add_uevent_var(env, "DEVTYPE=%s", dev->type->name);
328
329 if (dev->driver)
330 add_uevent_var(env, "DRIVER=%s", dev->driver->name);
331
332 /* Add common DT information about the device */
333 of_device_uevent(dev, env);
334
335 /* have the bus specific function add its stuff */
336 if (dev->bus && dev->bus->uevent) {
337 retval = dev->bus->uevent(dev, env);
338 if (retval)
339 pr_debug("device: '%s': %s: bus uevent() returned %d\n",
340 dev_name(dev), __func__, retval);
341 }
342
343 /* have the class specific function add its stuff */
344 if (dev->class && dev->class->dev_uevent) {
345 retval = dev->class->dev_uevent(dev, env);
346 if (retval)
347 pr_debug("device: '%s': %s: class uevent() "
348 "returned %d\n", dev_name(dev),
349 __func__, retval);
350 }
351
352 /* have the device type specific function add its stuff */
353 if (dev->type && dev->type->uevent) {
354 retval = dev->type->uevent(dev, env);
355 if (retval)
356 pr_debug("device: '%s': %s: dev_type uevent() "
357 "returned %d\n", dev_name(dev),
358 __func__, retval);
359 }
360
361 return retval;
362 }
363
364 static const struct kset_uevent_ops device_uevent_ops = {
365 .filter = dev_uevent_filter,
366 .name = dev_uevent_name,
367 .uevent = dev_uevent,
368 };
369
370 static ssize_t uevent_show(struct device *dev, struct device_attribute *attr,
371 char *buf)
372 {
373 struct kobject *top_kobj;
374 struct kset *kset;
375 struct kobj_uevent_env *env = NULL;
376 int i;
377 size_t count = 0;
378 int retval;
379
380 /* search the kset, the device belongs to */
381 top_kobj = &dev->kobj;
382 while (!top_kobj->kset && top_kobj->parent)
383 top_kobj = top_kobj->parent;
384 if (!top_kobj->kset)
385 goto out;
386
387 kset = top_kobj->kset;
388 if (!kset->uevent_ops || !kset->uevent_ops->uevent)
389 goto out;
390
391 /* respect filter */
392 if (kset->uevent_ops && kset->uevent_ops->filter)
393 if (!kset->uevent_ops->filter(kset, &dev->kobj))
394 goto out;
395
396 env = kzalloc(sizeof(struct kobj_uevent_env), GFP_KERNEL);
397 if (!env)
398 return -ENOMEM;
399
400 /* let the kset specific function add its keys */
401 retval = kset->uevent_ops->uevent(kset, &dev->kobj, env);
402 if (retval)
403 goto out;
404
405 /* copy keys to file */
406 for (i = 0; i < env->envp_idx; i++)
407 count += sprintf(&buf[count], "%s\n", env->envp[i]);
408 out:
409 kfree(env);
410 return count;
411 }
412
413 static ssize_t uevent_store(struct device *dev, struct device_attribute *attr,
414 const char *buf, size_t count)
415 {
416 enum kobject_action action;
417
418 if (kobject_action_type(buf, count, &action) == 0)
419 kobject_uevent(&dev->kobj, action);
420 else
421 dev_err(dev, "uevent: unknown action-string\n");
422 return count;
423 }
424 static DEVICE_ATTR_RW(uevent);
425
426 static ssize_t online_show(struct device *dev, struct device_attribute *attr,
427 char *buf)
428 {
429 bool val;
430
431 device_lock(dev);
432 val = !dev->offline;
433 device_unlock(dev);
434 return sprintf(buf, "%u\n", val);
435 }
436
437 static ssize_t online_store(struct device *dev, struct device_attribute *attr,
438 const char *buf, size_t count)
439 {
440 bool val;
441 int ret;
442
443 ret = strtobool(buf, &val);
444 if (ret < 0)
445 return ret;
446
447 ret = lock_device_hotplug_sysfs();
448 if (ret)
449 return ret;
450
451 ret = val ? device_online(dev) : device_offline(dev);
452 unlock_device_hotplug();
453 return ret < 0 ? ret : count;
454 }
455 static DEVICE_ATTR_RW(online);
456
457 int device_add_groups(struct device *dev, const struct attribute_group **groups)
458 {
459 return sysfs_create_groups(&dev->kobj, groups);
460 }
461
462 void device_remove_groups(struct device *dev,
463 const struct attribute_group **groups)
464 {
465 sysfs_remove_groups(&dev->kobj, groups);
466 }
467
468 static int device_add_attrs(struct device *dev)
469 {
470 struct class *class = dev->class;
471 const struct device_type *type = dev->type;
472 int error;
473
474 if (class) {
475 error = device_add_groups(dev, class->dev_groups);
476 if (error)
477 return error;
478 }
479
480 if (type) {
481 error = device_add_groups(dev, type->groups);
482 if (error)
483 goto err_remove_class_groups;
484 }
485
486 error = device_add_groups(dev, dev->groups);
487 if (error)
488 goto err_remove_type_groups;
489
490 if (device_supports_offline(dev) && !dev->offline_disabled) {
491 error = device_create_file(dev, &dev_attr_online);
492 if (error)
493 goto err_remove_dev_groups;
494 }
495
496 return 0;
497
498 err_remove_dev_groups:
499 device_remove_groups(dev, dev->groups);
500 err_remove_type_groups:
501 if (type)
502 device_remove_groups(dev, type->groups);
503 err_remove_class_groups:
504 if (class)
505 device_remove_groups(dev, class->dev_groups);
506
507 return error;
508 }
509
510 static void device_remove_attrs(struct device *dev)
511 {
512 struct class *class = dev->class;
513 const struct device_type *type = dev->type;
514
515 device_remove_file(dev, &dev_attr_online);
516 device_remove_groups(dev, dev->groups);
517
518 if (type)
519 device_remove_groups(dev, type->groups);
520
521 if (class)
522 device_remove_groups(dev, class->dev_groups);
523 }
524
525 static ssize_t dev_show(struct device *dev, struct device_attribute *attr,
526 char *buf)
527 {
528 return print_dev_t(buf, dev->devt);
529 }
530 static DEVICE_ATTR_RO(dev);
531
532 /* /sys/devices/ */
533 struct kset *devices_kset;
534
535 /**
536 * device_create_file - create sysfs attribute file for device.
537 * @dev: device.
538 * @attr: device attribute descriptor.
539 */
540 int device_create_file(struct device *dev,
541 const struct device_attribute *attr)
542 {
543 int error = 0;
544
545 if (dev) {
546 WARN(((attr->attr.mode & S_IWUGO) && !attr->store),
547 "Attribute %s: write permission without 'store'\n",
548 attr->attr.name);
549 WARN(((attr->attr.mode & S_IRUGO) && !attr->show),
550 "Attribute %s: read permission without 'show'\n",
551 attr->attr.name);
552 error = sysfs_create_file(&dev->kobj, &attr->attr);
553 }
554
555 return error;
556 }
557 EXPORT_SYMBOL_GPL(device_create_file);
558
559 /**
560 * device_remove_file - remove sysfs attribute file.
561 * @dev: device.
562 * @attr: device attribute descriptor.
563 */
564 void device_remove_file(struct device *dev,
565 const struct device_attribute *attr)
566 {
567 if (dev)
568 sysfs_remove_file(&dev->kobj, &attr->attr);
569 }
570 EXPORT_SYMBOL_GPL(device_remove_file);
571
572 /**
573 * device_remove_file_self - remove sysfs attribute file from its own method.
574 * @dev: device.
575 * @attr: device attribute descriptor.
576 *
577 * See kernfs_remove_self() for details.
578 */
579 bool device_remove_file_self(struct device *dev,
580 const struct device_attribute *attr)
581 {
582 if (dev)
583 return sysfs_remove_file_self(&dev->kobj, &attr->attr);
584 else
585 return false;
586 }
587 EXPORT_SYMBOL_GPL(device_remove_file_self);
588
589 /**
590 * device_create_bin_file - create sysfs binary attribute file for device.
591 * @dev: device.
592 * @attr: device binary attribute descriptor.
593 */
594 int device_create_bin_file(struct device *dev,
595 const struct bin_attribute *attr)
596 {
597 int error = -EINVAL;
598 if (dev)
599 error = sysfs_create_bin_file(&dev->kobj, attr);
600 return error;
601 }
602 EXPORT_SYMBOL_GPL(device_create_bin_file);
603
604 /**
605 * device_remove_bin_file - remove sysfs binary attribute file
606 * @dev: device.
607 * @attr: device binary attribute descriptor.
608 */
609 void device_remove_bin_file(struct device *dev,
610 const struct bin_attribute *attr)
611 {
612 if (dev)
613 sysfs_remove_bin_file(&dev->kobj, attr);
614 }
615 EXPORT_SYMBOL_GPL(device_remove_bin_file);
616
617 static void klist_children_get(struct klist_node *n)
618 {
619 struct device_private *p = to_device_private_parent(n);
620 struct device *dev = p->device;
621
622 get_device(dev);
623 }
624
625 static void klist_children_put(struct klist_node *n)
626 {
627 struct device_private *p = to_device_private_parent(n);
628 struct device *dev = p->device;
629
630 put_device(dev);
631 }
632
633 /**
634 * device_initialize - init device structure.
635 * @dev: device.
636 *
637 * This prepares the device for use by other layers by initializing
638 * its fields.
639 * It is the first half of device_register(), if called by
640 * that function, though it can also be called separately, so one
641 * may use @dev's fields. In particular, get_device()/put_device()
642 * may be used for reference counting of @dev after calling this
643 * function.
644 *
645 * All fields in @dev must be initialized by the caller to 0, except
646 * for those explicitly set to some other value. The simplest
647 * approach is to use kzalloc() to allocate the structure containing
648 * @dev.
649 *
650 * NOTE: Use put_device() to give up your reference instead of freeing
651 * @dev directly once you have called this function.
652 */
653 void device_initialize(struct device *dev)
654 {
655 dev->kobj.kset = devices_kset;
656 kobject_init(&dev->kobj, &device_ktype);
657 INIT_LIST_HEAD(&dev->dma_pools);
658 mutex_init(&dev->mutex);
659 lockdep_set_novalidate_class(&dev->mutex);
660 spin_lock_init(&dev->devres_lock);
661 INIT_LIST_HEAD(&dev->devres_head);
662 device_pm_init(dev);
663 set_dev_node(dev, -1);
664 }
665 EXPORT_SYMBOL_GPL(device_initialize);
666
667 struct kobject *virtual_device_parent(struct device *dev)
668 {
669 static struct kobject *virtual_dir = NULL;
670
671 if (!virtual_dir)
672 virtual_dir = kobject_create_and_add("virtual",
673 &devices_kset->kobj);
674
675 return virtual_dir;
676 }
677
678 struct class_dir {
679 struct kobject kobj;
680 struct class *class;
681 };
682
683 #define to_class_dir(obj) container_of(obj, struct class_dir, kobj)
684
685 static void class_dir_release(struct kobject *kobj)
686 {
687 struct class_dir *dir = to_class_dir(kobj);
688 kfree(dir);
689 }
690
691 static const
692 struct kobj_ns_type_operations *class_dir_child_ns_type(struct kobject *kobj)
693 {
694 struct class_dir *dir = to_class_dir(kobj);
695 return dir->class->ns_type;
696 }
697
698 static struct kobj_type class_dir_ktype = {
699 .release = class_dir_release,
700 .sysfs_ops = &kobj_sysfs_ops,
701 .child_ns_type = class_dir_child_ns_type
702 };
703
704 static struct kobject *
705 class_dir_create_and_add(struct class *class, struct kobject *parent_kobj)
706 {
707 struct class_dir *dir;
708 int retval;
709
710 dir = kzalloc(sizeof(*dir), GFP_KERNEL);
711 if (!dir)
712 return NULL;
713
714 dir->class = class;
715 kobject_init(&dir->kobj, &class_dir_ktype);
716
717 dir->kobj.kset = &class->p->glue_dirs;
718
719 retval = kobject_add(&dir->kobj, parent_kobj, "%s", class->name);
720 if (retval < 0) {
721 kobject_put(&dir->kobj);
722 return NULL;
723 }
724 return &dir->kobj;
725 }
726
727 static DEFINE_MUTEX(gdp_mutex);
728
729 static struct kobject *get_device_parent(struct device *dev,
730 struct device *parent)
731 {
732 if (dev->class) {
733 struct kobject *kobj = NULL;
734 struct kobject *parent_kobj;
735 struct kobject *k;
736
737 #ifdef CONFIG_BLOCK
738 /* block disks show up in /sys/block */
739 if (sysfs_deprecated && dev->class == &block_class) {
740 if (parent && parent->class == &block_class)
741 return &parent->kobj;
742 return &block_class.p->subsys.kobj;
743 }
744 #endif
745
746 /*
747 * If we have no parent, we live in "virtual".
748 * Class-devices with a non class-device as parent, live
749 * in a "glue" directory to prevent namespace collisions.
750 */
751 if (parent == NULL)
752 parent_kobj = virtual_device_parent(dev);
753 else if (parent->class && !dev->class->ns_type)
754 return &parent->kobj;
755 else
756 parent_kobj = &parent->kobj;
757
758 mutex_lock(&gdp_mutex);
759
760 /* find our class-directory at the parent and reference it */
761 spin_lock(&dev->class->p->glue_dirs.list_lock);
762 list_for_each_entry(k, &dev->class->p->glue_dirs.list, entry)
763 if (k->parent == parent_kobj) {
764 kobj = kobject_get(k);
765 break;
766 }
767 spin_unlock(&dev->class->p->glue_dirs.list_lock);
768 if (kobj) {
769 mutex_unlock(&gdp_mutex);
770 return kobj;
771 }
772
773 /* or create a new class-directory at the parent device */
774 k = class_dir_create_and_add(dev->class, parent_kobj);
775 /* do not emit an uevent for this simple "glue" directory */
776 mutex_unlock(&gdp_mutex);
777 return k;
778 }
779
780 /* subsystems can specify a default root directory for their devices */
781 if (!parent && dev->bus && dev->bus->dev_root)
782 return &dev->bus->dev_root->kobj;
783
784 if (parent)
785 return &parent->kobj;
786 return NULL;
787 }
788
789 static void cleanup_glue_dir(struct device *dev, struct kobject *glue_dir)
790 {
791 /* see if we live in a "glue" directory */
792 if (!glue_dir || !dev->class ||
793 glue_dir->kset != &dev->class->p->glue_dirs)
794 return;
795
796 mutex_lock(&gdp_mutex);
797 kobject_put(glue_dir);
798 mutex_unlock(&gdp_mutex);
799 }
800
801 static void cleanup_device_parent(struct device *dev)
802 {
803 cleanup_glue_dir(dev, dev->kobj.parent);
804 }
805
806 static int device_add_class_symlinks(struct device *dev)
807 {
808 int error;
809
810 if (!dev->class)
811 return 0;
812
813 error = sysfs_create_link(&dev->kobj,
814 &dev->class->p->subsys.kobj,
815 "subsystem");
816 if (error)
817 goto out;
818
819 if (dev->parent && device_is_not_partition(dev)) {
820 error = sysfs_create_link(&dev->kobj, &dev->parent->kobj,
821 "device");
822 if (error)
823 goto out_subsys;
824 }
825
826 #ifdef CONFIG_BLOCK
827 /* /sys/block has directories and does not need symlinks */
828 if (sysfs_deprecated && dev->class == &block_class)
829 return 0;
830 #endif
831
832 /* link in the class directory pointing to the device */
833 error = sysfs_create_link(&dev->class->p->subsys.kobj,
834 &dev->kobj, dev_name(dev));
835 if (error)
836 goto out_device;
837
838 return 0;
839
840 out_device:
841 sysfs_remove_link(&dev->kobj, "device");
842
843 out_subsys:
844 sysfs_remove_link(&dev->kobj, "subsystem");
845 out:
846 return error;
847 }
848
849 static void device_remove_class_symlinks(struct device *dev)
850 {
851 if (!dev->class)
852 return;
853
854 if (dev->parent && device_is_not_partition(dev))
855 sysfs_remove_link(&dev->kobj, "device");
856 sysfs_remove_link(&dev->kobj, "subsystem");
857 #ifdef CONFIG_BLOCK
858 if (sysfs_deprecated && dev->class == &block_class)
859 return;
860 #endif
861 sysfs_delete_link(&dev->class->p->subsys.kobj, &dev->kobj, dev_name(dev));
862 }
863
864 /**
865 * dev_set_name - set a device name
866 * @dev: device
867 * @fmt: format string for the device's name
868 */
869 int dev_set_name(struct device *dev, const char *fmt, ...)
870 {
871 va_list vargs;
872 int err;
873
874 va_start(vargs, fmt);
875 err = kobject_set_name_vargs(&dev->kobj, fmt, vargs);
876 va_end(vargs);
877 return err;
878 }
879 EXPORT_SYMBOL_GPL(dev_set_name);
880
881 /**
882 * device_to_dev_kobj - select a /sys/dev/ directory for the device
883 * @dev: device
884 *
885 * By default we select char/ for new entries. Setting class->dev_obj
886 * to NULL prevents an entry from being created. class->dev_kobj must
887 * be set (or cleared) before any devices are registered to the class
888 * otherwise device_create_sys_dev_entry() and
889 * device_remove_sys_dev_entry() will disagree about the presence of
890 * the link.
891 */
892 static struct kobject *device_to_dev_kobj(struct device *dev)
893 {
894 struct kobject *kobj;
895
896 if (dev->class)
897 kobj = dev->class->dev_kobj;
898 else
899 kobj = sysfs_dev_char_kobj;
900
901 return kobj;
902 }
903
904 static int device_create_sys_dev_entry(struct device *dev)
905 {
906 struct kobject *kobj = device_to_dev_kobj(dev);
907 int error = 0;
908 char devt_str[15];
909
910 if (kobj) {
911 format_dev_t(devt_str, dev->devt);
912 error = sysfs_create_link(kobj, &dev->kobj, devt_str);
913 }
914
915 return error;
916 }
917
918 static void device_remove_sys_dev_entry(struct device *dev)
919 {
920 struct kobject *kobj = device_to_dev_kobj(dev);
921 char devt_str[15];
922
923 if (kobj) {
924 format_dev_t(devt_str, dev->devt);
925 sysfs_remove_link(kobj, devt_str);
926 }
927 }
928
929 int device_private_init(struct device *dev)
930 {
931 dev->p = kzalloc(sizeof(*dev->p), GFP_KERNEL);
932 if (!dev->p)
933 return -ENOMEM;
934 dev->p->device = dev;
935 klist_init(&dev->p->klist_children, klist_children_get,
936 klist_children_put);
937 INIT_LIST_HEAD(&dev->p->deferred_probe);
938 return 0;
939 }
940
941 /**
942 * device_add - add device to device hierarchy.
943 * @dev: device.
944 *
945 * This is part 2 of device_register(), though may be called
946 * separately _iff_ device_initialize() has been called separately.
947 *
948 * This adds @dev to the kobject hierarchy via kobject_add(), adds it
949 * to the global and sibling lists for the device, then
950 * adds it to the other relevant subsystems of the driver model.
951 *
952 * Do not call this routine or device_register() more than once for
953 * any device structure. The driver model core is not designed to work
954 * with devices that get unregistered and then spring back to life.
955 * (Among other things, it's very hard to guarantee that all references
956 * to the previous incarnation of @dev have been dropped.) Allocate
957 * and register a fresh new struct device instead.
958 *
959 * NOTE: _Never_ directly free @dev after calling this function, even
960 * if it returned an error! Always use put_device() to give up your
961 * reference instead.
962 */
963 int device_add(struct device *dev)
964 {
965 struct device *parent = NULL;
966 struct kobject *kobj;
967 struct class_interface *class_intf;
968 int error = -EINVAL;
969
970 dev = get_device(dev);
971 if (!dev)
972 goto done;
973
974 if (!dev->p) {
975 error = device_private_init(dev);
976 if (error)
977 goto done;
978 }
979
980 /*
981 * for statically allocated devices, which should all be converted
982 * some day, we need to initialize the name. We prevent reading back
983 * the name, and force the use of dev_name()
984 */
985 if (dev->init_name) {
986 dev_set_name(dev, "%s", dev->init_name);
987 dev->init_name = NULL;
988 }
989
990 /* subsystems can specify simple device enumeration */
991 if (!dev_name(dev) && dev->bus && dev->bus->dev_name)
992 dev_set_name(dev, "%s%u", dev->bus->dev_name, dev->id);
993
994 if (!dev_name(dev)) {
995 error = -EINVAL;
996 goto name_error;
997 }
998
999 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1000
1001 parent = get_device(dev->parent);
1002 kobj = get_device_parent(dev, parent);
1003 if (kobj)
1004 dev->kobj.parent = kobj;
1005
1006 /* use parent numa_node */
1007 if (parent)
1008 set_dev_node(dev, dev_to_node(parent));
1009
1010 /* first, register with generic layer. */
1011 /* we require the name to be set before, and pass NULL */
1012 error = kobject_add(&dev->kobj, dev->kobj.parent, NULL);
1013 if (error)
1014 goto Error;
1015
1016 /* notify platform of device entry */
1017 if (platform_notify)
1018 platform_notify(dev);
1019
1020 error = device_create_file(dev, &dev_attr_uevent);
1021 if (error)
1022 goto attrError;
1023
1024 error = device_add_class_symlinks(dev);
1025 if (error)
1026 goto SymlinkError;
1027 error = device_add_attrs(dev);
1028 if (error)
1029 goto AttrsError;
1030 error = bus_add_device(dev);
1031 if (error)
1032 goto BusError;
1033 error = dpm_sysfs_add(dev);
1034 if (error)
1035 goto DPMError;
1036 device_pm_add(dev);
1037
1038 if (MAJOR(dev->devt)) {
1039 error = device_create_file(dev, &dev_attr_dev);
1040 if (error)
1041 goto DevAttrError;
1042
1043 error = device_create_sys_dev_entry(dev);
1044 if (error)
1045 goto SysEntryError;
1046
1047 devtmpfs_create_node(dev);
1048 }
1049
1050 /* Notify clients of device addition. This call must come
1051 * after dpm_sysfs_add() and before kobject_uevent().
1052 */
1053 if (dev->bus)
1054 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1055 BUS_NOTIFY_ADD_DEVICE, dev);
1056
1057 kobject_uevent(&dev->kobj, KOBJ_ADD);
1058 bus_probe_device(dev);
1059 if (parent)
1060 klist_add_tail(&dev->p->knode_parent,
1061 &parent->p->klist_children);
1062
1063 if (dev->class) {
1064 mutex_lock(&dev->class->p->mutex);
1065 /* tie the class to the device */
1066 klist_add_tail(&dev->knode_class,
1067 &dev->class->p->klist_devices);
1068
1069 /* notify any interfaces that the device is here */
1070 list_for_each_entry(class_intf,
1071 &dev->class->p->interfaces, node)
1072 if (class_intf->add_dev)
1073 class_intf->add_dev(dev, class_intf);
1074 mutex_unlock(&dev->class->p->mutex);
1075 }
1076 done:
1077 put_device(dev);
1078 return error;
1079 SysEntryError:
1080 if (MAJOR(dev->devt))
1081 device_remove_file(dev, &dev_attr_dev);
1082 DevAttrError:
1083 device_pm_remove(dev);
1084 dpm_sysfs_remove(dev);
1085 DPMError:
1086 bus_remove_device(dev);
1087 BusError:
1088 device_remove_attrs(dev);
1089 AttrsError:
1090 device_remove_class_symlinks(dev);
1091 SymlinkError:
1092 device_remove_file(dev, &dev_attr_uevent);
1093 attrError:
1094 kobject_uevent(&dev->kobj, KOBJ_REMOVE);
1095 kobject_del(&dev->kobj);
1096 Error:
1097 cleanup_device_parent(dev);
1098 put_device(parent);
1099 name_error:
1100 kfree(dev->p);
1101 dev->p = NULL;
1102 goto done;
1103 }
1104 EXPORT_SYMBOL_GPL(device_add);
1105
1106 /**
1107 * device_register - register a device with the system.
1108 * @dev: pointer to the device structure
1109 *
1110 * This happens in two clean steps - initialize the device
1111 * and add it to the system. The two steps can be called
1112 * separately, but this is the easiest and most common.
1113 * I.e. you should only call the two helpers separately if
1114 * have a clearly defined need to use and refcount the device
1115 * before it is added to the hierarchy.
1116 *
1117 * For more information, see the kerneldoc for device_initialize()
1118 * and device_add().
1119 *
1120 * NOTE: _Never_ directly free @dev after calling this function, even
1121 * if it returned an error! Always use put_device() to give up the
1122 * reference initialized in this function instead.
1123 */
1124 int device_register(struct device *dev)
1125 {
1126 device_initialize(dev);
1127 return device_add(dev);
1128 }
1129 EXPORT_SYMBOL_GPL(device_register);
1130
1131 /**
1132 * get_device - increment reference count for device.
1133 * @dev: device.
1134 *
1135 * This simply forwards the call to kobject_get(), though
1136 * we do take care to provide for the case that we get a NULL
1137 * pointer passed in.
1138 */
1139 struct device *get_device(struct device *dev)
1140 {
1141 return dev ? kobj_to_dev(kobject_get(&dev->kobj)) : NULL;
1142 }
1143 EXPORT_SYMBOL_GPL(get_device);
1144
1145 /**
1146 * put_device - decrement reference count.
1147 * @dev: device in question.
1148 */
1149 void put_device(struct device *dev)
1150 {
1151 /* might_sleep(); */
1152 if (dev)
1153 kobject_put(&dev->kobj);
1154 }
1155 EXPORT_SYMBOL_GPL(put_device);
1156
1157 /**
1158 * device_del - delete device from system.
1159 * @dev: device.
1160 *
1161 * This is the first part of the device unregistration
1162 * sequence. This removes the device from the lists we control
1163 * from here, has it removed from the other driver model
1164 * subsystems it was added to in device_add(), and removes it
1165 * from the kobject hierarchy.
1166 *
1167 * NOTE: this should be called manually _iff_ device_add() was
1168 * also called manually.
1169 */
1170 void device_del(struct device *dev)
1171 {
1172 struct device *parent = dev->parent;
1173 struct class_interface *class_intf;
1174
1175 /* Notify clients of device removal. This call must come
1176 * before dpm_sysfs_remove().
1177 */
1178 if (dev->bus)
1179 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1180 BUS_NOTIFY_DEL_DEVICE, dev);
1181 dpm_sysfs_remove(dev);
1182 if (parent)
1183 klist_del(&dev->p->knode_parent);
1184 if (MAJOR(dev->devt)) {
1185 devtmpfs_delete_node(dev);
1186 device_remove_sys_dev_entry(dev);
1187 device_remove_file(dev, &dev_attr_dev);
1188 }
1189 if (dev->class) {
1190 device_remove_class_symlinks(dev);
1191
1192 mutex_lock(&dev->class->p->mutex);
1193 /* notify any interfaces that the device is now gone */
1194 list_for_each_entry(class_intf,
1195 &dev->class->p->interfaces, node)
1196 if (class_intf->remove_dev)
1197 class_intf->remove_dev(dev, class_intf);
1198 /* remove the device from the class list */
1199 klist_del(&dev->knode_class);
1200 mutex_unlock(&dev->class->p->mutex);
1201 }
1202 device_remove_file(dev, &dev_attr_uevent);
1203 device_remove_attrs(dev);
1204 bus_remove_device(dev);
1205 device_pm_remove(dev);
1206 driver_deferred_probe_del(dev);
1207
1208 /* Notify the platform of the removal, in case they
1209 * need to do anything...
1210 */
1211 if (platform_notify_remove)
1212 platform_notify_remove(dev);
1213 if (dev->bus)
1214 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1215 BUS_NOTIFY_REMOVED_DEVICE, dev);
1216 kobject_uevent(&dev->kobj, KOBJ_REMOVE);
1217 cleanup_device_parent(dev);
1218 kobject_del(&dev->kobj);
1219 put_device(parent);
1220 }
1221 EXPORT_SYMBOL_GPL(device_del);
1222
1223 /**
1224 * device_unregister - unregister device from system.
1225 * @dev: device going away.
1226 *
1227 * We do this in two parts, like we do device_register(). First,
1228 * we remove it from all the subsystems with device_del(), then
1229 * we decrement the reference count via put_device(). If that
1230 * is the final reference count, the device will be cleaned up
1231 * via device_release() above. Otherwise, the structure will
1232 * stick around until the final reference to the device is dropped.
1233 */
1234 void device_unregister(struct device *dev)
1235 {
1236 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1237 device_del(dev);
1238 put_device(dev);
1239 }
1240 EXPORT_SYMBOL_GPL(device_unregister);
1241
1242 static struct device *next_device(struct klist_iter *i)
1243 {
1244 struct klist_node *n = klist_next(i);
1245 struct device *dev = NULL;
1246 struct device_private *p;
1247
1248 if (n) {
1249 p = to_device_private_parent(n);
1250 dev = p->device;
1251 }
1252 return dev;
1253 }
1254
1255 /**
1256 * device_get_devnode - path of device node file
1257 * @dev: device
1258 * @mode: returned file access mode
1259 * @uid: returned file owner
1260 * @gid: returned file group
1261 * @tmp: possibly allocated string
1262 *
1263 * Return the relative path of a possible device node.
1264 * Non-default names may need to allocate a memory to compose
1265 * a name. This memory is returned in tmp and needs to be
1266 * freed by the caller.
1267 */
1268 const char *device_get_devnode(struct device *dev,
1269 umode_t *mode, kuid_t *uid, kgid_t *gid,
1270 const char **tmp)
1271 {
1272 char *s;
1273
1274 *tmp = NULL;
1275
1276 /* the device type may provide a specific name */
1277 if (dev->type && dev->type->devnode)
1278 *tmp = dev->type->devnode(dev, mode, uid, gid);
1279 if (*tmp)
1280 return *tmp;
1281
1282 /* the class may provide a specific name */
1283 if (dev->class && dev->class->devnode)
1284 *tmp = dev->class->devnode(dev, mode);
1285 if (*tmp)
1286 return *tmp;
1287
1288 /* return name without allocation, tmp == NULL */
1289 if (strchr(dev_name(dev), '!') == NULL)
1290 return dev_name(dev);
1291
1292 /* replace '!' in the name with '/' */
1293 *tmp = kstrdup(dev_name(dev), GFP_KERNEL);
1294 if (!*tmp)
1295 return NULL;
1296 while ((s = strchr(*tmp, '!')))
1297 s[0] = '/';
1298 return *tmp;
1299 }
1300
1301 /**
1302 * device_for_each_child - device child iterator.
1303 * @parent: parent struct device.
1304 * @fn: function to be called for each device.
1305 * @data: data for the callback.
1306 *
1307 * Iterate over @parent's child devices, and call @fn for each,
1308 * passing it @data.
1309 *
1310 * We check the return of @fn each time. If it returns anything
1311 * other than 0, we break out and return that value.
1312 */
1313 int device_for_each_child(struct device *parent, void *data,
1314 int (*fn)(struct device *dev, void *data))
1315 {
1316 struct klist_iter i;
1317 struct device *child;
1318 int error = 0;
1319
1320 if (!parent->p)
1321 return 0;
1322
1323 klist_iter_init(&parent->p->klist_children, &i);
1324 while ((child = next_device(&i)) && !error)
1325 error = fn(child, data);
1326 klist_iter_exit(&i);
1327 return error;
1328 }
1329 EXPORT_SYMBOL_GPL(device_for_each_child);
1330
1331 /**
1332 * device_find_child - device iterator for locating a particular device.
1333 * @parent: parent struct device
1334 * @match: Callback function to check device
1335 * @data: Data to pass to match function
1336 *
1337 * This is similar to the device_for_each_child() function above, but it
1338 * returns a reference to a device that is 'found' for later use, as
1339 * determined by the @match callback.
1340 *
1341 * The callback should return 0 if the device doesn't match and non-zero
1342 * if it does. If the callback returns non-zero and a reference to the
1343 * current device can be obtained, this function will return to the caller
1344 * and not iterate over any more devices.
1345 *
1346 * NOTE: you will need to drop the reference with put_device() after use.
1347 */
1348 struct device *device_find_child(struct device *parent, void *data,
1349 int (*match)(struct device *dev, void *data))
1350 {
1351 struct klist_iter i;
1352 struct device *child;
1353
1354 if (!parent)
1355 return NULL;
1356
1357 klist_iter_init(&parent->p->klist_children, &i);
1358 while ((child = next_device(&i)))
1359 if (match(child, data) && get_device(child))
1360 break;
1361 klist_iter_exit(&i);
1362 return child;
1363 }
1364 EXPORT_SYMBOL_GPL(device_find_child);
1365
1366 int __init devices_init(void)
1367 {
1368 devices_kset = kset_create_and_add("devices", &device_uevent_ops, NULL);
1369 if (!devices_kset)
1370 return -ENOMEM;
1371 dev_kobj = kobject_create_and_add("dev", NULL);
1372 if (!dev_kobj)
1373 goto dev_kobj_err;
1374 sysfs_dev_block_kobj = kobject_create_and_add("block", dev_kobj);
1375 if (!sysfs_dev_block_kobj)
1376 goto block_kobj_err;
1377 sysfs_dev_char_kobj = kobject_create_and_add("char", dev_kobj);
1378 if (!sysfs_dev_char_kobj)
1379 goto char_kobj_err;
1380
1381 return 0;
1382
1383 char_kobj_err:
1384 kobject_put(sysfs_dev_block_kobj);
1385 block_kobj_err:
1386 kobject_put(dev_kobj);
1387 dev_kobj_err:
1388 kset_unregister(devices_kset);
1389 return -ENOMEM;
1390 }
1391
1392 static int device_check_offline(struct device *dev, void *not_used)
1393 {
1394 int ret;
1395
1396 ret = device_for_each_child(dev, NULL, device_check_offline);
1397 if (ret)
1398 return ret;
1399
1400 return device_supports_offline(dev) && !dev->offline ? -EBUSY : 0;
1401 }
1402
1403 /**
1404 * device_offline - Prepare the device for hot-removal.
1405 * @dev: Device to be put offline.
1406 *
1407 * Execute the device bus type's .offline() callback, if present, to prepare
1408 * the device for a subsequent hot-removal. If that succeeds, the device must
1409 * not be used until either it is removed or its bus type's .online() callback
1410 * is executed.
1411 *
1412 * Call under device_hotplug_lock.
1413 */
1414 int device_offline(struct device *dev)
1415 {
1416 int ret;
1417
1418 if (dev->offline_disabled)
1419 return -EPERM;
1420
1421 ret = device_for_each_child(dev, NULL, device_check_offline);
1422 if (ret)
1423 return ret;
1424
1425 device_lock(dev);
1426 if (device_supports_offline(dev)) {
1427 if (dev->offline) {
1428 ret = 1;
1429 } else {
1430 ret = dev->bus->offline(dev);
1431 if (!ret) {
1432 kobject_uevent(&dev->kobj, KOBJ_OFFLINE);
1433 dev->offline = true;
1434 }
1435 }
1436 }
1437 device_unlock(dev);
1438
1439 return ret;
1440 }
1441
1442 /**
1443 * device_online - Put the device back online after successful device_offline().
1444 * @dev: Device to be put back online.
1445 *
1446 * If device_offline() has been successfully executed for @dev, but the device
1447 * has not been removed subsequently, execute its bus type's .online() callback
1448 * to indicate that the device can be used again.
1449 *
1450 * Call under device_hotplug_lock.
1451 */
1452 int device_online(struct device *dev)
1453 {
1454 int ret = 0;
1455
1456 device_lock(dev);
1457 if (device_supports_offline(dev)) {
1458 if (dev->offline) {
1459 ret = dev->bus->online(dev);
1460 if (!ret) {
1461 kobject_uevent(&dev->kobj, KOBJ_ONLINE);
1462 dev->offline = false;
1463 }
1464 } else {
1465 ret = 1;
1466 }
1467 }
1468 device_unlock(dev);
1469
1470 return ret;
1471 }
1472
1473 struct root_device {
1474 struct device dev;
1475 struct module *owner;
1476 };
1477
1478 static inline struct root_device *to_root_device(struct device *d)
1479 {
1480 return container_of(d, struct root_device, dev);
1481 }
1482
1483 static void root_device_release(struct device *dev)
1484 {
1485 kfree(to_root_device(dev));
1486 }
1487
1488 /**
1489 * __root_device_register - allocate and register a root device
1490 * @name: root device name
1491 * @owner: owner module of the root device, usually THIS_MODULE
1492 *
1493 * This function allocates a root device and registers it
1494 * using device_register(). In order to free the returned
1495 * device, use root_device_unregister().
1496 *
1497 * Root devices are dummy devices which allow other devices
1498 * to be grouped under /sys/devices. Use this function to
1499 * allocate a root device and then use it as the parent of
1500 * any device which should appear under /sys/devices/{name}
1501 *
1502 * The /sys/devices/{name} directory will also contain a
1503 * 'module' symlink which points to the @owner directory
1504 * in sysfs.
1505 *
1506 * Returns &struct device pointer on success, or ERR_PTR() on error.
1507 *
1508 * Note: You probably want to use root_device_register().
1509 */
1510 struct device *__root_device_register(const char *name, struct module *owner)
1511 {
1512 struct root_device *root;
1513 int err = -ENOMEM;
1514
1515 root = kzalloc(sizeof(struct root_device), GFP_KERNEL);
1516 if (!root)
1517 return ERR_PTR(err);
1518
1519 err = dev_set_name(&root->dev, "%s", name);
1520 if (err) {
1521 kfree(root);
1522 return ERR_PTR(err);
1523 }
1524
1525 root->dev.release = root_device_release;
1526
1527 err = device_register(&root->dev);
1528 if (err) {
1529 put_device(&root->dev);
1530 return ERR_PTR(err);
1531 }
1532
1533 #ifdef CONFIG_MODULES /* gotta find a "cleaner" way to do this */
1534 if (owner) {
1535 struct module_kobject *mk = &owner->mkobj;
1536
1537 err = sysfs_create_link(&root->dev.kobj, &mk->kobj, "module");
1538 if (err) {
1539 device_unregister(&root->dev);
1540 return ERR_PTR(err);
1541 }
1542 root->owner = owner;
1543 }
1544 #endif
1545
1546 return &root->dev;
1547 }
1548 EXPORT_SYMBOL_GPL(__root_device_register);
1549
1550 /**
1551 * root_device_unregister - unregister and free a root device
1552 * @dev: device going away
1553 *
1554 * This function unregisters and cleans up a device that was created by
1555 * root_device_register().
1556 */
1557 void root_device_unregister(struct device *dev)
1558 {
1559 struct root_device *root = to_root_device(dev);
1560
1561 if (root->owner)
1562 sysfs_remove_link(&root->dev.kobj, "module");
1563
1564 device_unregister(dev);
1565 }
1566 EXPORT_SYMBOL_GPL(root_device_unregister);
1567
1568
1569 static void device_create_release(struct device *dev)
1570 {
1571 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1572 kfree(dev);
1573 }
1574
1575 static struct device *
1576 device_create_groups_vargs(struct class *class, struct device *parent,
1577 dev_t devt, void *drvdata,
1578 const struct attribute_group **groups,
1579 const char *fmt, va_list args)
1580 {
1581 struct device *dev = NULL;
1582 int retval = -ENODEV;
1583
1584 if (class == NULL || IS_ERR(class))
1585 goto error;
1586
1587 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1588 if (!dev) {
1589 retval = -ENOMEM;
1590 goto error;
1591 }
1592
1593 device_initialize(dev);
1594 dev->devt = devt;
1595 dev->class = class;
1596 dev->parent = parent;
1597 dev->groups = groups;
1598 dev->release = device_create_release;
1599 dev_set_drvdata(dev, drvdata);
1600
1601 retval = kobject_set_name_vargs(&dev->kobj, fmt, args);
1602 if (retval)
1603 goto error;
1604
1605 retval = device_add(dev);
1606 if (retval)
1607 goto error;
1608
1609 return dev;
1610
1611 error:
1612 put_device(dev);
1613 return ERR_PTR(retval);
1614 }
1615
1616 /**
1617 * device_create_vargs - creates a device and registers it with sysfs
1618 * @class: pointer to the struct class that this device should be registered to
1619 * @parent: pointer to the parent struct device of this new device, if any
1620 * @devt: the dev_t for the char device to be added
1621 * @drvdata: the data to be added to the device for callbacks
1622 * @fmt: string for the device's name
1623 * @args: va_list for the device's name
1624 *
1625 * This function can be used by char device classes. A struct device
1626 * will be created in sysfs, registered to the specified class.
1627 *
1628 * A "dev" file will be created, showing the dev_t for the device, if
1629 * the dev_t is not 0,0.
1630 * If a pointer to a parent struct device is passed in, the newly created
1631 * struct device will be a child of that device in sysfs.
1632 * The pointer to the struct device will be returned from the call.
1633 * Any further sysfs files that might be required can be created using this
1634 * pointer.
1635 *
1636 * Returns &struct device pointer on success, or ERR_PTR() on error.
1637 *
1638 * Note: the struct class passed to this function must have previously
1639 * been created with a call to class_create().
1640 */
1641 struct device *device_create_vargs(struct class *class, struct device *parent,
1642 dev_t devt, void *drvdata, const char *fmt,
1643 va_list args)
1644 {
1645 return device_create_groups_vargs(class, parent, devt, drvdata, NULL,
1646 fmt, args);
1647 }
1648 EXPORT_SYMBOL_GPL(device_create_vargs);
1649
1650 /**
1651 * device_create - creates a device and registers it with sysfs
1652 * @class: pointer to the struct class that this device should be registered to
1653 * @parent: pointer to the parent struct device of this new device, if any
1654 * @devt: the dev_t for the char device to be added
1655 * @drvdata: the data to be added to the device for callbacks
1656 * @fmt: string for the device's name
1657 *
1658 * This function can be used by char device classes. A struct device
1659 * will be created in sysfs, registered to the specified class.
1660 *
1661 * A "dev" file will be created, showing the dev_t for the device, if
1662 * the dev_t is not 0,0.
1663 * If a pointer to a parent struct device is passed in, the newly created
1664 * struct device will be a child of that device in sysfs.
1665 * The pointer to the struct device will be returned from the call.
1666 * Any further sysfs files that might be required can be created using this
1667 * pointer.
1668 *
1669 * Returns &struct device pointer on success, or ERR_PTR() on error.
1670 *
1671 * Note: the struct class passed to this function must have previously
1672 * been created with a call to class_create().
1673 */
1674 struct device *device_create(struct class *class, struct device *parent,
1675 dev_t devt, void *drvdata, const char *fmt, ...)
1676 {
1677 va_list vargs;
1678 struct device *dev;
1679
1680 va_start(vargs, fmt);
1681 dev = device_create_vargs(class, parent, devt, drvdata, fmt, vargs);
1682 va_end(vargs);
1683 return dev;
1684 }
1685 EXPORT_SYMBOL_GPL(device_create);
1686
1687 /**
1688 * device_create_with_groups - creates a device and registers it with sysfs
1689 * @class: pointer to the struct class that this device should be registered to
1690 * @parent: pointer to the parent struct device of this new device, if any
1691 * @devt: the dev_t for the char device to be added
1692 * @drvdata: the data to be added to the device for callbacks
1693 * @groups: NULL-terminated list of attribute groups to be created
1694 * @fmt: string for the device's name
1695 *
1696 * This function can be used by char device classes. A struct device
1697 * will be created in sysfs, registered to the specified class.
1698 * Additional attributes specified in the groups parameter will also
1699 * be created automatically.
1700 *
1701 * A "dev" file will be created, showing the dev_t for the device, if
1702 * the dev_t is not 0,0.
1703 * If a pointer to a parent struct device is passed in, the newly created
1704 * struct device will be a child of that device in sysfs.
1705 * The pointer to the struct device will be returned from the call.
1706 * Any further sysfs files that might be required can be created using this
1707 * pointer.
1708 *
1709 * Returns &struct device pointer on success, or ERR_PTR() on error.
1710 *
1711 * Note: the struct class passed to this function must have previously
1712 * been created with a call to class_create().
1713 */
1714 struct device *device_create_with_groups(struct class *class,
1715 struct device *parent, dev_t devt,
1716 void *drvdata,
1717 const struct attribute_group **groups,
1718 const char *fmt, ...)
1719 {
1720 va_list vargs;
1721 struct device *dev;
1722
1723 va_start(vargs, fmt);
1724 dev = device_create_groups_vargs(class, parent, devt, drvdata, groups,
1725 fmt, vargs);
1726 va_end(vargs);
1727 return dev;
1728 }
1729 EXPORT_SYMBOL_GPL(device_create_with_groups);
1730
1731 static int __match_devt(struct device *dev, const void *data)
1732 {
1733 const dev_t *devt = data;
1734
1735 return dev->devt == *devt;
1736 }
1737
1738 /**
1739 * device_destroy - removes a device that was created with device_create()
1740 * @class: pointer to the struct class that this device was registered with
1741 * @devt: the dev_t of the device that was previously registered
1742 *
1743 * This call unregisters and cleans up a device that was created with a
1744 * call to device_create().
1745 */
1746 void device_destroy(struct class *class, dev_t devt)
1747 {
1748 struct device *dev;
1749
1750 dev = class_find_device(class, NULL, &devt, __match_devt);
1751 if (dev) {
1752 put_device(dev);
1753 device_unregister(dev);
1754 }
1755 }
1756 EXPORT_SYMBOL_GPL(device_destroy);
1757
1758 /**
1759 * device_rename - renames a device
1760 * @dev: the pointer to the struct device to be renamed
1761 * @new_name: the new name of the device
1762 *
1763 * It is the responsibility of the caller to provide mutual
1764 * exclusion between two different calls of device_rename
1765 * on the same device to ensure that new_name is valid and
1766 * won't conflict with other devices.
1767 *
1768 * Note: Don't call this function. Currently, the networking layer calls this
1769 * function, but that will change. The following text from Kay Sievers offers
1770 * some insight:
1771 *
1772 * Renaming devices is racy at many levels, symlinks and other stuff are not
1773 * replaced atomically, and you get a "move" uevent, but it's not easy to
1774 * connect the event to the old and new device. Device nodes are not renamed at
1775 * all, there isn't even support for that in the kernel now.
1776 *
1777 * In the meantime, during renaming, your target name might be taken by another
1778 * driver, creating conflicts. Or the old name is taken directly after you
1779 * renamed it -- then you get events for the same DEVPATH, before you even see
1780 * the "move" event. It's just a mess, and nothing new should ever rely on
1781 * kernel device renaming. Besides that, it's not even implemented now for
1782 * other things than (driver-core wise very simple) network devices.
1783 *
1784 * We are currently about to change network renaming in udev to completely
1785 * disallow renaming of devices in the same namespace as the kernel uses,
1786 * because we can't solve the problems properly, that arise with swapping names
1787 * of multiple interfaces without races. Means, renaming of eth[0-9]* will only
1788 * be allowed to some other name than eth[0-9]*, for the aforementioned
1789 * reasons.
1790 *
1791 * Make up a "real" name in the driver before you register anything, or add
1792 * some other attributes for userspace to find the device, or use udev to add
1793 * symlinks -- but never rename kernel devices later, it's a complete mess. We
1794 * don't even want to get into that and try to implement the missing pieces in
1795 * the core. We really have other pieces to fix in the driver core mess. :)
1796 */
1797 int device_rename(struct device *dev, const char *new_name)
1798 {
1799 struct kobject *kobj = &dev->kobj;
1800 char *old_device_name = NULL;
1801 int error;
1802
1803 dev = get_device(dev);
1804 if (!dev)
1805 return -EINVAL;
1806
1807 dev_dbg(dev, "renaming to %s\n", new_name);
1808
1809 old_device_name = kstrdup(dev_name(dev), GFP_KERNEL);
1810 if (!old_device_name) {
1811 error = -ENOMEM;
1812 goto out;
1813 }
1814
1815 if (dev->class) {
1816 error = sysfs_rename_link_ns(&dev->class->p->subsys.kobj,
1817 kobj, old_device_name,
1818 new_name, kobject_namespace(kobj));
1819 if (error)
1820 goto out;
1821 }
1822
1823 error = kobject_rename(kobj, new_name);
1824 if (error)
1825 goto out;
1826
1827 out:
1828 put_device(dev);
1829
1830 kfree(old_device_name);
1831
1832 return error;
1833 }
1834 EXPORT_SYMBOL_GPL(device_rename);
1835
1836 static int device_move_class_links(struct device *dev,
1837 struct device *old_parent,
1838 struct device *new_parent)
1839 {
1840 int error = 0;
1841
1842 if (old_parent)
1843 sysfs_remove_link(&dev->kobj, "device");
1844 if (new_parent)
1845 error = sysfs_create_link(&dev->kobj, &new_parent->kobj,
1846 "device");
1847 return error;
1848 }
1849
1850 /**
1851 * device_move - moves a device to a new parent
1852 * @dev: the pointer to the struct device to be moved
1853 * @new_parent: the new parent of the device (can by NULL)
1854 * @dpm_order: how to reorder the dpm_list
1855 */
1856 int device_move(struct device *dev, struct device *new_parent,
1857 enum dpm_order dpm_order)
1858 {
1859 int error;
1860 struct device *old_parent;
1861 struct kobject *new_parent_kobj;
1862
1863 dev = get_device(dev);
1864 if (!dev)
1865 return -EINVAL;
1866
1867 device_pm_lock();
1868 new_parent = get_device(new_parent);
1869 new_parent_kobj = get_device_parent(dev, new_parent);
1870
1871 pr_debug("device: '%s': %s: moving to '%s'\n", dev_name(dev),
1872 __func__, new_parent ? dev_name(new_parent) : "<NULL>");
1873 error = kobject_move(&dev->kobj, new_parent_kobj);
1874 if (error) {
1875 cleanup_glue_dir(dev, new_parent_kobj);
1876 put_device(new_parent);
1877 goto out;
1878 }
1879 old_parent = dev->parent;
1880 dev->parent = new_parent;
1881 if (old_parent)
1882 klist_remove(&dev->p->knode_parent);
1883 if (new_parent) {
1884 klist_add_tail(&dev->p->knode_parent,
1885 &new_parent->p->klist_children);
1886 set_dev_node(dev, dev_to_node(new_parent));
1887 }
1888
1889 if (dev->class) {
1890 error = device_move_class_links(dev, old_parent, new_parent);
1891 if (error) {
1892 /* We ignore errors on cleanup since we're hosed anyway... */
1893 device_move_class_links(dev, new_parent, old_parent);
1894 if (!kobject_move(&dev->kobj, &old_parent->kobj)) {
1895 if (new_parent)
1896 klist_remove(&dev->p->knode_parent);
1897 dev->parent = old_parent;
1898 if (old_parent) {
1899 klist_add_tail(&dev->p->knode_parent,
1900 &old_parent->p->klist_children);
1901 set_dev_node(dev, dev_to_node(old_parent));
1902 }
1903 }
1904 cleanup_glue_dir(dev, new_parent_kobj);
1905 put_device(new_parent);
1906 goto out;
1907 }
1908 }
1909 switch (dpm_order) {
1910 case DPM_ORDER_NONE:
1911 break;
1912 case DPM_ORDER_DEV_AFTER_PARENT:
1913 device_pm_move_after(dev, new_parent);
1914 break;
1915 case DPM_ORDER_PARENT_BEFORE_DEV:
1916 device_pm_move_before(new_parent, dev);
1917 break;
1918 case DPM_ORDER_DEV_LAST:
1919 device_pm_move_last(dev);
1920 break;
1921 }
1922
1923 put_device(old_parent);
1924 out:
1925 device_pm_unlock();
1926 put_device(dev);
1927 return error;
1928 }
1929 EXPORT_SYMBOL_GPL(device_move);
1930
1931 /**
1932 * device_shutdown - call ->shutdown() on each device to shutdown.
1933 */
1934 void device_shutdown(void)
1935 {
1936 struct device *dev, *parent;
1937
1938 spin_lock(&devices_kset->list_lock);
1939 /*
1940 * Walk the devices list backward, shutting down each in turn.
1941 * Beware that device unplug events may also start pulling
1942 * devices offline, even as the system is shutting down.
1943 */
1944 while (!list_empty(&devices_kset->list)) {
1945 dev = list_entry(devices_kset->list.prev, struct device,
1946 kobj.entry);
1947
1948 /*
1949 * hold reference count of device's parent to
1950 * prevent it from being freed because parent's
1951 * lock is to be held
1952 */
1953 parent = get_device(dev->parent);
1954 get_device(dev);
1955 /*
1956 * Make sure the device is off the kset list, in the
1957 * event that dev->*->shutdown() doesn't remove it.
1958 */
1959 list_del_init(&dev->kobj.entry);
1960 spin_unlock(&devices_kset->list_lock);
1961
1962 /* hold lock to avoid race with probe/release */
1963 if (parent)
1964 device_lock(parent);
1965 device_lock(dev);
1966
1967 /* Don't allow any more runtime suspends */
1968 pm_runtime_get_noresume(dev);
1969 pm_runtime_barrier(dev);
1970
1971 if (dev->bus && dev->bus->shutdown) {
1972 if (initcall_debug)
1973 dev_info(dev, "shutdown\n");
1974 dev->bus->shutdown(dev);
1975 } else if (dev->driver && dev->driver->shutdown) {
1976 if (initcall_debug)
1977 dev_info(dev, "shutdown\n");
1978 dev->driver->shutdown(dev);
1979 }
1980
1981 device_unlock(dev);
1982 if (parent)
1983 device_unlock(parent);
1984
1985 put_device(dev);
1986 put_device(parent);
1987
1988 spin_lock(&devices_kset->list_lock);
1989 }
1990 spin_unlock(&devices_kset->list_lock);
1991 }
1992
1993 /*
1994 * Device logging functions
1995 */
1996
1997 #ifdef CONFIG_PRINTK
1998 static int
1999 create_syslog_header(const struct device *dev, char *hdr, size_t hdrlen)
2000 {
2001 const char *subsys;
2002 size_t pos = 0;
2003
2004 if (dev->class)
2005 subsys = dev->class->name;
2006 else if (dev->bus)
2007 subsys = dev->bus->name;
2008 else
2009 return 0;
2010
2011 pos += snprintf(hdr + pos, hdrlen - pos, "SUBSYSTEM=%s", subsys);
2012 if (pos >= hdrlen)
2013 goto overflow;
2014
2015 /*
2016 * Add device identifier DEVICE=:
2017 * b12:8 block dev_t
2018 * c127:3 char dev_t
2019 * n8 netdev ifindex
2020 * +sound:card0 subsystem:devname
2021 */
2022 if (MAJOR(dev->devt)) {
2023 char c;
2024
2025 if (strcmp(subsys, "block") == 0)
2026 c = 'b';
2027 else
2028 c = 'c';
2029 pos++;
2030 pos += snprintf(hdr + pos, hdrlen - pos,
2031 "DEVICE=%c%u:%u",
2032 c, MAJOR(dev->devt), MINOR(dev->devt));
2033 } else if (strcmp(subsys, "net") == 0) {
2034 struct net_device *net = to_net_dev(dev);
2035
2036 pos++;
2037 pos += snprintf(hdr + pos, hdrlen - pos,
2038 "DEVICE=n%u", net->ifindex);
2039 } else {
2040 pos++;
2041 pos += snprintf(hdr + pos, hdrlen - pos,
2042 "DEVICE=+%s:%s", subsys, dev_name(dev));
2043 }
2044
2045 if (pos >= hdrlen)
2046 goto overflow;
2047
2048 return pos;
2049
2050 overflow:
2051 dev_WARN(dev, "device/subsystem name too long");
2052 return 0;
2053 }
2054
2055 int dev_vprintk_emit(int level, const struct device *dev,
2056 const char *fmt, va_list args)
2057 {
2058 char hdr[128];
2059 size_t hdrlen;
2060
2061 hdrlen = create_syslog_header(dev, hdr, sizeof(hdr));
2062
2063 return vprintk_emit(0, level, hdrlen ? hdr : NULL, hdrlen, fmt, args);
2064 }
2065 EXPORT_SYMBOL(dev_vprintk_emit);
2066
2067 int dev_printk_emit(int level, const struct device *dev, const char *fmt, ...)
2068 {
2069 va_list args;
2070 int r;
2071
2072 va_start(args, fmt);
2073
2074 r = dev_vprintk_emit(level, dev, fmt, args);
2075
2076 va_end(args);
2077
2078 return r;
2079 }
2080 EXPORT_SYMBOL(dev_printk_emit);
2081
2082 static void __dev_printk(const char *level, const struct device *dev,
2083 struct va_format *vaf)
2084 {
2085 if (dev)
2086 dev_printk_emit(level[1] - '0', dev, "%s %s: %pV",
2087 dev_driver_string(dev), dev_name(dev), vaf);
2088 else
2089 printk("%s(NULL device *): %pV", level, vaf);
2090 }
2091
2092 void dev_printk(const char *level, const struct device *dev,
2093 const char *fmt, ...)
2094 {
2095 struct va_format vaf;
2096 va_list args;
2097
2098 va_start(args, fmt);
2099
2100 vaf.fmt = fmt;
2101 vaf.va = &args;
2102
2103 __dev_printk(level, dev, &vaf);
2104
2105 va_end(args);
2106 }
2107 EXPORT_SYMBOL(dev_printk);
2108
2109 #define define_dev_printk_level(func, kern_level) \
2110 void func(const struct device *dev, const char *fmt, ...) \
2111 { \
2112 struct va_format vaf; \
2113 va_list args; \
2114 \
2115 va_start(args, fmt); \
2116 \
2117 vaf.fmt = fmt; \
2118 vaf.va = &args; \
2119 \
2120 __dev_printk(kern_level, dev, &vaf); \
2121 \
2122 va_end(args); \
2123 } \
2124 EXPORT_SYMBOL(func);
2125
2126 define_dev_printk_level(dev_emerg, KERN_EMERG);
2127 define_dev_printk_level(dev_alert, KERN_ALERT);
2128 define_dev_printk_level(dev_crit, KERN_CRIT);
2129 define_dev_printk_level(dev_err, KERN_ERR);
2130 define_dev_printk_level(dev_warn, KERN_WARNING);
2131 define_dev_printk_level(dev_notice, KERN_NOTICE);
2132 define_dev_printk_level(_dev_info, KERN_INFO);
2133
2134 #endif