1
2
3
4
5
6
7
8
9
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/async.h>
27#include <linux/pm_runtime.h>
28#include <linux/netdevice.h>
29
30#include "base.h"
31#include "power/power.h"
32
33#ifdef CONFIG_SYSFS_DEPRECATED
34#ifdef CONFIG_SYSFS_DEPRECATED_V2
35long sysfs_deprecated = 1;
36#else
37long sysfs_deprecated = 0;
38#endif
39static __init int sysfs_deprecated_setup(char *arg)
40{
41 return strict_strtol(arg, 10, &sysfs_deprecated);
42}
43early_param("sysfs.deprecated", sysfs_deprecated_setup);
44#endif
45
46int (*platform_notify)(struct device *dev) = NULL;
47int (*platform_notify_remove)(struct device *dev) = NULL;
48static struct kobject *dev_kobj;
49struct kobject *sysfs_dev_char_kobj;
50struct kobject *sysfs_dev_block_kobj;
51
52#ifdef CONFIG_BLOCK
53static inline int device_is_not_partition(struct device *dev)
54{
55 return !(dev->type == &part_type);
56}
57#else
58static inline int device_is_not_partition(struct device *dev)
59{
60 return 1;
61}
62#endif
63
64
65
66
67
68
69
70
71
72
73const char *dev_driver_string(const struct device *dev)
74{
75 struct device_driver *drv;
76
77
78
79
80
81 drv = ACCESS_ONCE(dev->driver);
82 return drv ? drv->name :
83 (dev->bus ? dev->bus->name :
84 (dev->class ? dev->class->name : ""));
85}
86EXPORT_SYMBOL(dev_driver_string);
87
88#define to_dev(obj) container_of(obj, struct device, kobj)
89#define to_dev_attr(_attr) container_of(_attr, struct device_attribute, attr)
90
91static ssize_t dev_attr_show(struct kobject *kobj, struct attribute *attr,
92 char *buf)
93{
94 struct device_attribute *dev_attr = to_dev_attr(attr);
95 struct device *dev = to_dev(kobj);
96 ssize_t ret = -EIO;
97
98 if (dev_attr->show)
99 ret = dev_attr->show(dev, dev_attr, buf);
100 if (ret >= (ssize_t)PAGE_SIZE) {
101 print_symbol("dev_attr_show: %s returned bad count\n",
102 (unsigned long)dev_attr->show);
103 }
104 return ret;
105}
106
107static ssize_t dev_attr_store(struct kobject *kobj, struct attribute *attr,
108 const char *buf, size_t count)
109{
110 struct device_attribute *dev_attr = to_dev_attr(attr);
111 struct device *dev = to_dev(kobj);
112 ssize_t ret = -EIO;
113
114 if (dev_attr->store)
115 ret = dev_attr->store(dev, dev_attr, buf, count);
116 return ret;
117}
118
119static const struct sysfs_ops dev_sysfs_ops = {
120 .show = dev_attr_show,
121 .store = dev_attr_store,
122};
123
124#define to_ext_attr(x) container_of(x, struct dev_ext_attribute, attr)
125
126ssize_t device_store_ulong(struct device *dev,
127 struct device_attribute *attr,
128 const char *buf, size_t size)
129{
130 struct dev_ext_attribute *ea = to_ext_attr(attr);
131 char *end;
132 unsigned long new = simple_strtoul(buf, &end, 0);
133 if (end == buf)
134 return -EINVAL;
135 *(unsigned long *)(ea->var) = new;
136
137 return size;
138}
139EXPORT_SYMBOL_GPL(device_store_ulong);
140
141ssize_t device_show_ulong(struct device *dev,
142 struct device_attribute *attr,
143 char *buf)
144{
145 struct dev_ext_attribute *ea = to_ext_attr(attr);
146 return snprintf(buf, PAGE_SIZE, "%lx\n", *(unsigned long *)(ea->var));
147}
148EXPORT_SYMBOL_GPL(device_show_ulong);
149
150ssize_t device_store_int(struct device *dev,
151 struct device_attribute *attr,
152 const char *buf, size_t size)
153{
154 struct dev_ext_attribute *ea = to_ext_attr(attr);
155 char *end;
156 long new = simple_strtol(buf, &end, 0);
157 if (end == buf || new > INT_MAX || new < INT_MIN)
158 return -EINVAL;
159 *(int *)(ea->var) = new;
160
161 return size;
162}
163EXPORT_SYMBOL_GPL(device_store_int);
164
165ssize_t device_show_int(struct device *dev,
166 struct device_attribute *attr,
167 char *buf)
168{
169 struct dev_ext_attribute *ea = to_ext_attr(attr);
170
171 return snprintf(buf, PAGE_SIZE, "%d\n", *(int *)(ea->var));
172}
173EXPORT_SYMBOL_GPL(device_show_int);
174
175
176
177
178
179
180
181
182
183static void device_release(struct kobject *kobj)
184{
185 struct device *dev = to_dev(kobj);
186 struct device_private *p = dev->p;
187
188 if (dev->release)
189 dev->release(dev);
190 else if (dev->type && dev->type->release)
191 dev->type->release(dev);
192 else if (dev->class && dev->class->dev_release)
193 dev->class->dev_release(dev);
194 else
195 WARN(1, KERN_ERR "Device '%s' does not have a release() "
196 "function, it is broken and must be fixed.\n",
197 dev_name(dev));
198 kfree(p);
199}
200
201static const void *device_namespace(struct kobject *kobj)
202{
203 struct device *dev = to_dev(kobj);
204 const void *ns = NULL;
205
206 if (dev->class && dev->class->ns_type)
207 ns = dev->class->namespace(dev);
208
209 return ns;
210}
211
212static struct kobj_type device_ktype = {
213 .release = device_release,
214 .sysfs_ops = &dev_sysfs_ops,
215 .namespace = device_namespace,
216};
217
218
219static int dev_uevent_filter(struct kset *kset, struct kobject *kobj)
220{
221 struct kobj_type *ktype = get_ktype(kobj);
222
223 if (ktype == &device_ktype) {
224 struct device *dev = to_dev(kobj);
225 if (dev->bus)
226 return 1;
227 if (dev->class)
228 return 1;
229 }
230 return 0;
231}
232
233static const char *dev_uevent_name(struct kset *kset, struct kobject *kobj)
234{
235 struct device *dev = to_dev(kobj);
236
237 if (dev->bus)
238 return dev->bus->name;
239 if (dev->class)
240 return dev->class->name;
241 return NULL;
242}
243
244static int dev_uevent(struct kset *kset, struct kobject *kobj,
245 struct kobj_uevent_env *env)
246{
247 struct device *dev = to_dev(kobj);
248 int retval = 0;
249
250
251 if (MAJOR(dev->devt)) {
252 const char *tmp;
253 const char *name;
254 umode_t mode = 0;
255
256 add_uevent_var(env, "MAJOR=%u", MAJOR(dev->devt));
257 add_uevent_var(env, "MINOR=%u", MINOR(dev->devt));
258 name = device_get_devnode(dev, &mode, &tmp);
259 if (name) {
260 add_uevent_var(env, "DEVNAME=%s", name);
261 kfree(tmp);
262 if (mode)
263 add_uevent_var(env, "DEVMODE=%#o", mode & 0777);
264 }
265 }
266
267 if (dev->type && dev->type->name)
268 add_uevent_var(env, "DEVTYPE=%s", dev->type->name);
269
270 if (dev->driver)
271 add_uevent_var(env, "DRIVER=%s", dev->driver->name);
272
273
274 of_device_uevent(dev, env);
275
276
277 if (dev->bus && dev->bus->uevent) {
278 retval = dev->bus->uevent(dev, env);
279 if (retval)
280 pr_debug("device: '%s': %s: bus uevent() returned %d\n",
281 dev_name(dev), __func__, retval);
282 }
283
284
285 if (dev->class && dev->class->dev_uevent) {
286 retval = dev->class->dev_uevent(dev, env);
287 if (retval)
288 pr_debug("device: '%s': %s: class uevent() "
289 "returned %d\n", dev_name(dev),
290 __func__, retval);
291 }
292
293
294 if (dev->type && dev->type->uevent) {
295 retval = dev->type->uevent(dev, env);
296 if (retval)
297 pr_debug("device: '%s': %s: dev_type uevent() "
298 "returned %d\n", dev_name(dev),
299 __func__, retval);
300 }
301
302 return retval;
303}
304
305static const struct kset_uevent_ops device_uevent_ops = {
306 .filter = dev_uevent_filter,
307 .name = dev_uevent_name,
308 .uevent = dev_uevent,
309};
310
311static ssize_t show_uevent(struct device *dev, struct device_attribute *attr,
312 char *buf)
313{
314 struct kobject *top_kobj;
315 struct kset *kset;
316 struct kobj_uevent_env *env = NULL;
317 int i;
318 size_t count = 0;
319 int retval;
320
321
322 top_kobj = &dev->kobj;
323 while (!top_kobj->kset && top_kobj->parent)
324 top_kobj = top_kobj->parent;
325 if (!top_kobj->kset)
326 goto out;
327
328 kset = top_kobj->kset;
329 if (!kset->uevent_ops || !kset->uevent_ops->uevent)
330 goto out;
331
332
333 if (kset->uevent_ops && kset->uevent_ops->filter)
334 if (!kset->uevent_ops->filter(kset, &dev->kobj))
335 goto out;
336
337 env = kzalloc(sizeof(struct kobj_uevent_env), GFP_KERNEL);
338 if (!env)
339 return -ENOMEM;
340
341
342 retval = kset->uevent_ops->uevent(kset, &dev->kobj, env);
343 if (retval)
344 goto out;
345
346
347 for (i = 0; i < env->envp_idx; i++)
348 count += sprintf(&buf[count], "%s\n", env->envp[i]);
349out:
350 kfree(env);
351 return count;
352}
353
354static ssize_t store_uevent(struct device *dev, struct device_attribute *attr,
355 const char *buf, size_t count)
356{
357 enum kobject_action action;
358
359 if (kobject_action_type(buf, count, &action) == 0)
360 kobject_uevent(&dev->kobj, action);
361 else
362 dev_err(dev, "uevent: unknown action-string\n");
363 return count;
364}
365
366static struct device_attribute uevent_attr =
367 __ATTR(uevent, S_IRUGO | S_IWUSR, show_uevent, store_uevent);
368
369static int device_add_attributes(struct device *dev,
370 struct device_attribute *attrs)
371{
372 int error = 0;
373 int i;
374
375 if (attrs) {
376 for (i = 0; attr_name(attrs[i]); i++) {
377 error = device_create_file(dev, &attrs[i]);
378 if (error)
379 break;
380 }
381 if (error)
382 while (--i >= 0)
383 device_remove_file(dev, &attrs[i]);
384 }
385 return error;
386}
387
388static void device_remove_attributes(struct device *dev,
389 struct device_attribute *attrs)
390{
391 int i;
392
393 if (attrs)
394 for (i = 0; attr_name(attrs[i]); i++)
395 device_remove_file(dev, &attrs[i]);
396}
397
398static int device_add_bin_attributes(struct device *dev,
399 struct bin_attribute *attrs)
400{
401 int error = 0;
402 int i;
403
404 if (attrs) {
405 for (i = 0; attr_name(attrs[i]); i++) {
406 error = device_create_bin_file(dev, &attrs[i]);
407 if (error)
408 break;
409 }
410 if (error)
411 while (--i >= 0)
412 device_remove_bin_file(dev, &attrs[i]);
413 }
414 return error;
415}
416
417static void device_remove_bin_attributes(struct device *dev,
418 struct bin_attribute *attrs)
419{
420 int i;
421
422 if (attrs)
423 for (i = 0; attr_name(attrs[i]); i++)
424 device_remove_bin_file(dev, &attrs[i]);
425}
426
427static int device_add_groups(struct device *dev,
428 const struct attribute_group **groups)
429{
430 int error = 0;
431 int i;
432
433 if (groups) {
434 for (i = 0; groups[i]; i++) {
435 error = sysfs_create_group(&dev->kobj, groups[i]);
436 if (error) {
437 while (--i >= 0)
438 sysfs_remove_group(&dev->kobj,
439 groups[i]);
440 break;
441 }
442 }
443 }
444 return error;
445}
446
447static void device_remove_groups(struct device *dev,
448 const struct attribute_group **groups)
449{
450 int i;
451
452 if (groups)
453 for (i = 0; groups[i]; i++)
454 sysfs_remove_group(&dev->kobj, groups[i]);
455}
456
457static int device_add_attrs(struct device *dev)
458{
459 struct class *class = dev->class;
460 const struct device_type *type = dev->type;
461 int error;
462
463 if (class) {
464 error = device_add_attributes(dev, class->dev_attrs);
465 if (error)
466 return error;
467 error = device_add_bin_attributes(dev, class->dev_bin_attrs);
468 if (error)
469 goto err_remove_class_attrs;
470 }
471
472 if (type) {
473 error = device_add_groups(dev, type->groups);
474 if (error)
475 goto err_remove_class_bin_attrs;
476 }
477
478 error = device_add_groups(dev, dev->groups);
479 if (error)
480 goto err_remove_type_groups;
481
482 return 0;
483
484 err_remove_type_groups:
485 if (type)
486 device_remove_groups(dev, type->groups);
487 err_remove_class_bin_attrs:
488 if (class)
489 device_remove_bin_attributes(dev, class->dev_bin_attrs);
490 err_remove_class_attrs:
491 if (class)
492 device_remove_attributes(dev, class->dev_attrs);
493
494 return error;
495}
496
497static void device_remove_attrs(struct device *dev)
498{
499 struct class *class = dev->class;
500 const struct device_type *type = dev->type;
501
502 device_remove_groups(dev, dev->groups);
503
504 if (type)
505 device_remove_groups(dev, type->groups);
506
507 if (class) {
508 device_remove_attributes(dev, class->dev_attrs);
509 device_remove_bin_attributes(dev, class->dev_bin_attrs);
510 }
511}
512
513
514static ssize_t show_dev(struct device *dev, struct device_attribute *attr,
515 char *buf)
516{
517 return print_dev_t(buf, dev->devt);
518}
519
520static struct device_attribute devt_attr =
521 __ATTR(dev, S_IRUGO, show_dev, NULL);
522
523
524struct kset *devices_kset;
525
526
527
528
529
530
531int device_create_file(struct device *dev,
532 const struct device_attribute *attr)
533{
534 int error = 0;
535 if (dev)
536 error = sysfs_create_file(&dev->kobj, &attr->attr);
537 return error;
538}
539
540
541
542
543
544
545void device_remove_file(struct device *dev,
546 const struct device_attribute *attr)
547{
548 if (dev)
549 sysfs_remove_file(&dev->kobj, &attr->attr);
550}
551
552
553
554
555
556
557int device_create_bin_file(struct device *dev,
558 const struct bin_attribute *attr)
559{
560 int error = -EINVAL;
561 if (dev)
562 error = sysfs_create_bin_file(&dev->kobj, attr);
563 return error;
564}
565EXPORT_SYMBOL_GPL(device_create_bin_file);
566
567
568
569
570
571
572void device_remove_bin_file(struct device *dev,
573 const struct bin_attribute *attr)
574{
575 if (dev)
576 sysfs_remove_bin_file(&dev->kobj, attr);
577}
578EXPORT_SYMBOL_GPL(device_remove_bin_file);
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605int device_schedule_callback_owner(struct device *dev,
606 void (*func)(struct device *), struct module *owner)
607{
608 return sysfs_schedule_callback(&dev->kobj,
609 (void (*)(void *)) func, dev, owner);
610}
611EXPORT_SYMBOL_GPL(device_schedule_callback_owner);
612
613static void klist_children_get(struct klist_node *n)
614{
615 struct device_private *p = to_device_private_parent(n);
616 struct device *dev = p->device;
617
618 get_device(dev);
619}
620
621static void klist_children_put(struct klist_node *n)
622{
623 struct device_private *p = to_device_private_parent(n);
624 struct device *dev = p->device;
625
626 put_device(dev);
627}
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649void device_initialize(struct device *dev)
650{
651 dev->kobj.kset = devices_kset;
652 kobject_init(&dev->kobj, &device_ktype);
653 INIT_LIST_HEAD(&dev->dma_pools);
654 mutex_init(&dev->mutex);
655 lockdep_set_novalidate_class(&dev->mutex);
656 spin_lock_init(&dev->devres_lock);
657 INIT_LIST_HEAD(&dev->devres_head);
658 device_pm_init(dev);
659 set_dev_node(dev, -1);
660}
661
662static struct kobject *virtual_device_parent(struct device *dev)
663{
664 static struct kobject *virtual_dir = NULL;
665
666 if (!virtual_dir)
667 virtual_dir = kobject_create_and_add("virtual",
668 &devices_kset->kobj);
669
670 return virtual_dir;
671}
672
673struct class_dir {
674 struct kobject kobj;
675 struct class *class;
676};
677
678#define to_class_dir(obj) container_of(obj, struct class_dir, kobj)
679
680static void class_dir_release(struct kobject *kobj)
681{
682 struct class_dir *dir = to_class_dir(kobj);
683 kfree(dir);
684}
685
686static const
687struct kobj_ns_type_operations *class_dir_child_ns_type(struct kobject *kobj)
688{
689 struct class_dir *dir = to_class_dir(kobj);
690 return dir->class->ns_type;
691}
692
693static struct kobj_type class_dir_ktype = {
694 .release = class_dir_release,
695 .sysfs_ops = &kobj_sysfs_ops,
696 .child_ns_type = class_dir_child_ns_type
697};
698
699static struct kobject *
700class_dir_create_and_add(struct class *class, struct kobject *parent_kobj)
701{
702 struct class_dir *dir;
703 int retval;
704
705 dir = kzalloc(sizeof(*dir), GFP_KERNEL);
706 if (!dir)
707 return NULL;
708
709 dir->class = class;
710 kobject_init(&dir->kobj, &class_dir_ktype);
711
712 dir->kobj.kset = &class->p->glue_dirs;
713
714 retval = kobject_add(&dir->kobj, parent_kobj, "%s", class->name);
715 if (retval < 0) {
716 kobject_put(&dir->kobj);
717 return NULL;
718 }
719 return &dir->kobj;
720}
721
722
723static struct kobject *get_device_parent(struct device *dev,
724 struct device *parent)
725{
726 if (dev->class) {
727 static DEFINE_MUTEX(gdp_mutex);
728 struct kobject *kobj = NULL;
729 struct kobject *parent_kobj;
730 struct kobject *k;
731
732#ifdef CONFIG_BLOCK
733
734 if (sysfs_deprecated && dev->class == &block_class) {
735 if (parent && parent->class == &block_class)
736 return &parent->kobj;
737 return &block_class.p->subsys.kobj;
738 }
739#endif
740
741
742
743
744
745
746 if (parent == NULL)
747 parent_kobj = virtual_device_parent(dev);
748 else if (parent->class && !dev->class->ns_type)
749 return &parent->kobj;
750 else
751 parent_kobj = &parent->kobj;
752
753 mutex_lock(&gdp_mutex);
754
755
756 spin_lock(&dev->class->p->glue_dirs.list_lock);
757 list_for_each_entry(k, &dev->class->p->glue_dirs.list, entry)
758 if (k->parent == parent_kobj) {
759 kobj = kobject_get(k);
760 break;
761 }
762 spin_unlock(&dev->class->p->glue_dirs.list_lock);
763 if (kobj) {
764 mutex_unlock(&gdp_mutex);
765 return kobj;
766 }
767
768
769 k = class_dir_create_and_add(dev->class, parent_kobj);
770
771 mutex_unlock(&gdp_mutex);
772 return k;
773 }
774
775
776 if (!parent && dev->bus && dev->bus->dev_root)
777 return &dev->bus->dev_root->kobj;
778
779 if (parent)
780 return &parent->kobj;
781 return NULL;
782}
783
784static void cleanup_glue_dir(struct device *dev, struct kobject *glue_dir)
785{
786
787 if (!glue_dir || !dev->class ||
788 glue_dir->kset != &dev->class->p->glue_dirs)
789 return;
790
791 kobject_put(glue_dir);
792}
793
794static void cleanup_device_parent(struct device *dev)
795{
796 cleanup_glue_dir(dev, dev->kobj.parent);
797}
798
799static int device_add_class_symlinks(struct device *dev)
800{
801 int error;
802
803 if (!dev->class)
804 return 0;
805
806 error = sysfs_create_link(&dev->kobj,
807 &dev->class->p->subsys.kobj,
808 "subsystem");
809 if (error)
810 goto out;
811
812 if (dev->parent && device_is_not_partition(dev)) {
813 error = sysfs_create_link(&dev->kobj, &dev->parent->kobj,
814 "device");
815 if (error)
816 goto out_subsys;
817 }
818
819#ifdef CONFIG_BLOCK
820
821 if (sysfs_deprecated && dev->class == &block_class)
822 return 0;
823#endif
824
825
826 error = sysfs_create_link(&dev->class->p->subsys.kobj,
827 &dev->kobj, dev_name(dev));
828 if (error)
829 goto out_device;
830
831 return 0;
832
833out_device:
834 sysfs_remove_link(&dev->kobj, "device");
835
836out_subsys:
837 sysfs_remove_link(&dev->kobj, "subsystem");
838out:
839 return error;
840}
841
842static void device_remove_class_symlinks(struct device *dev)
843{
844 if (!dev->class)
845 return;
846
847 if (dev->parent && device_is_not_partition(dev))
848 sysfs_remove_link(&dev->kobj, "device");
849 sysfs_remove_link(&dev->kobj, "subsystem");
850#ifdef CONFIG_BLOCK
851 if (sysfs_deprecated && dev->class == &block_class)
852 return;
853#endif
854 sysfs_delete_link(&dev->class->p->subsys.kobj, &dev->kobj, dev_name(dev));
855}
856
857
858
859
860
861
862int dev_set_name(struct device *dev, const char *fmt, ...)
863{
864 va_list vargs;
865 int err;
866
867 va_start(vargs, fmt);
868 err = kobject_set_name_vargs(&dev->kobj, fmt, vargs);
869 va_end(vargs);
870 return err;
871}
872EXPORT_SYMBOL_GPL(dev_set_name);
873
874
875
876
877
878
879
880
881
882
883
884
885static struct kobject *device_to_dev_kobj(struct device *dev)
886{
887 struct kobject *kobj;
888
889 if (dev->class)
890 kobj = dev->class->dev_kobj;
891 else
892 kobj = sysfs_dev_char_kobj;
893
894 return kobj;
895}
896
897static int device_create_sys_dev_entry(struct device *dev)
898{
899 struct kobject *kobj = device_to_dev_kobj(dev);
900 int error = 0;
901 char devt_str[15];
902
903 if (kobj) {
904 format_dev_t(devt_str, dev->devt);
905 error = sysfs_create_link(kobj, &dev->kobj, devt_str);
906 }
907
908 return error;
909}
910
911static void device_remove_sys_dev_entry(struct device *dev)
912{
913 struct kobject *kobj = device_to_dev_kobj(dev);
914 char devt_str[15];
915
916 if (kobj) {
917 format_dev_t(devt_str, dev->devt);
918 sysfs_remove_link(kobj, devt_str);
919 }
920}
921
922int device_private_init(struct device *dev)
923{
924 dev->p = kzalloc(sizeof(*dev->p), GFP_KERNEL);
925 if (!dev->p)
926 return -ENOMEM;
927 dev->p->device = dev;
928 klist_init(&dev->p->klist_children, klist_children_get,
929 klist_children_put);
930 INIT_LIST_HEAD(&dev->p->deferred_probe);
931 return 0;
932}
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956int device_add(struct device *dev)
957{
958 struct device *parent = NULL;
959 struct kobject *kobj;
960 struct class_interface *class_intf;
961 int error = -EINVAL;
962
963 dev = get_device(dev);
964 if (!dev)
965 goto done;
966
967 if (!dev->p) {
968 error = device_private_init(dev);
969 if (error)
970 goto done;
971 }
972
973
974
975
976
977
978 if (dev->init_name) {
979 dev_set_name(dev, "%s", dev->init_name);
980 dev->init_name = NULL;
981 }
982
983
984 if (!dev_name(dev) && dev->bus && dev->bus->dev_name)
985 dev_set_name(dev, "%s%u", dev->bus->dev_name, dev->id);
986
987 if (!dev_name(dev)) {
988 error = -EINVAL;
989 goto name_error;
990 }
991
992 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
993
994 parent = get_device(dev->parent);
995 kobj = get_device_parent(dev, parent);
996 if (kobj)
997 dev->kobj.parent = kobj;
998
999
1000 if (parent)
1001 set_dev_node(dev, dev_to_node(parent));
1002
1003
1004
1005 error = kobject_add(&dev->kobj, dev->kobj.parent, NULL);
1006 if (error)
1007 goto Error;
1008
1009
1010 if (platform_notify)
1011 platform_notify(dev);
1012
1013 error = device_create_file(dev, &uevent_attr);
1014 if (error)
1015 goto attrError;
1016
1017 if (MAJOR(dev->devt)) {
1018 error = device_create_file(dev, &devt_attr);
1019 if (error)
1020 goto ueventattrError;
1021
1022 error = device_create_sys_dev_entry(dev);
1023 if (error)
1024 goto devtattrError;
1025
1026 devtmpfs_create_node(dev);
1027 }
1028
1029 error = device_add_class_symlinks(dev);
1030 if (error)
1031 goto SymlinkError;
1032 error = device_add_attrs(dev);
1033 if (error)
1034 goto AttrsError;
1035 error = bus_add_device(dev);
1036 if (error)
1037 goto BusError;
1038 error = dpm_sysfs_add(dev);
1039 if (error)
1040 goto DPMError;
1041 device_pm_add(dev);
1042
1043
1044
1045
1046 if (dev->bus)
1047 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1048 BUS_NOTIFY_ADD_DEVICE, dev);
1049
1050 kobject_uevent(&dev->kobj, KOBJ_ADD);
1051 bus_probe_device(dev);
1052 if (parent)
1053 klist_add_tail(&dev->p->knode_parent,
1054 &parent->p->klist_children);
1055
1056 if (dev->class) {
1057 mutex_lock(&dev->class->p->mutex);
1058
1059 klist_add_tail(&dev->knode_class,
1060 &dev->class->p->klist_devices);
1061
1062
1063 list_for_each_entry(class_intf,
1064 &dev->class->p->interfaces, node)
1065 if (class_intf->add_dev)
1066 class_intf->add_dev(dev, class_intf);
1067 mutex_unlock(&dev->class->p->mutex);
1068 }
1069done:
1070 put_device(dev);
1071 return error;
1072 DPMError:
1073 bus_remove_device(dev);
1074 BusError:
1075 device_remove_attrs(dev);
1076 AttrsError:
1077 device_remove_class_symlinks(dev);
1078 SymlinkError:
1079 if (MAJOR(dev->devt))
1080 devtmpfs_delete_node(dev);
1081 if (MAJOR(dev->devt))
1082 device_remove_sys_dev_entry(dev);
1083 devtattrError:
1084 if (MAJOR(dev->devt))
1085 device_remove_file(dev, &devt_attr);
1086 ueventattrError:
1087 device_remove_file(dev, &uevent_attr);
1088 attrError:
1089 kobject_uevent(&dev->kobj, KOBJ_REMOVE);
1090 kobject_del(&dev->kobj);
1091 Error:
1092 cleanup_device_parent(dev);
1093 if (parent)
1094 put_device(parent);
1095name_error:
1096 kfree(dev->p);
1097 dev->p = NULL;
1098 goto done;
1099}
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119int device_register(struct device *dev)
1120{
1121 device_initialize(dev);
1122 return device_add(dev);
1123}
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133struct device *get_device(struct device *dev)
1134{
1135 return dev ? to_dev(kobject_get(&dev->kobj)) : NULL;
1136}
1137
1138
1139
1140
1141
1142void put_device(struct device *dev)
1143{
1144
1145 if (dev)
1146 kobject_put(&dev->kobj);
1147}
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162void device_del(struct device *dev)
1163{
1164 struct device *parent = dev->parent;
1165 struct class_interface *class_intf;
1166
1167
1168
1169
1170 if (dev->bus)
1171 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1172 BUS_NOTIFY_DEL_DEVICE, dev);
1173 device_pm_remove(dev);
1174 dpm_sysfs_remove(dev);
1175 if (parent)
1176 klist_del(&dev->p->knode_parent);
1177 if (MAJOR(dev->devt)) {
1178 devtmpfs_delete_node(dev);
1179 device_remove_sys_dev_entry(dev);
1180 device_remove_file(dev, &devt_attr);
1181 }
1182 if (dev->class) {
1183 device_remove_class_symlinks(dev);
1184
1185 mutex_lock(&dev->class->p->mutex);
1186
1187 list_for_each_entry(class_intf,
1188 &dev->class->p->interfaces, node)
1189 if (class_intf->remove_dev)
1190 class_intf->remove_dev(dev, class_intf);
1191
1192 klist_del(&dev->knode_class);
1193 mutex_unlock(&dev->class->p->mutex);
1194 }
1195 device_remove_file(dev, &uevent_attr);
1196 device_remove_attrs(dev);
1197 bus_remove_device(dev);
1198 driver_deferred_probe_del(dev);
1199
1200
1201
1202
1203
1204
1205 devres_release_all(dev);
1206
1207
1208
1209
1210 if (platform_notify_remove)
1211 platform_notify_remove(dev);
1212 kobject_uevent(&dev->kobj, KOBJ_REMOVE);
1213 cleanup_device_parent(dev);
1214 kobject_del(&dev->kobj);
1215 put_device(parent);
1216}
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
1227
1228
1229void device_unregister(struct device *dev)
1230{
1231 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1232 device_del(dev);
1233 put_device(dev);
1234}
1235
1236static struct device *next_device(struct klist_iter *i)
1237{
1238 struct klist_node *n = klist_next(i);
1239 struct device *dev = NULL;
1240 struct device_private *p;
1241
1242 if (n) {
1243 p = to_device_private_parent(n);
1244 dev = p->device;
1245 }
1246 return dev;
1247}
1248
1249
1250
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260const char *device_get_devnode(struct device *dev,
1261 umode_t *mode, const char **tmp)
1262{
1263 char *s;
1264
1265 *tmp = NULL;
1266
1267
1268 if (dev->type && dev->type->devnode)
1269 *tmp = dev->type->devnode(dev, mode);
1270 if (*tmp)
1271 return *tmp;
1272
1273
1274 if (dev->class && dev->class->devnode)
1275 *tmp = dev->class->devnode(dev, mode);
1276 if (*tmp)
1277 return *tmp;
1278
1279
1280 if (strchr(dev_name(dev), '!') == NULL)
1281 return dev_name(dev);
1282
1283
1284 *tmp = kstrdup(dev_name(dev), GFP_KERNEL);
1285 if (!*tmp)
1286 return NULL;
1287 while ((s = strchr(*tmp, '!')))
1288 s[0] = '/';
1289 return *tmp;
1290}
1291
1292
1293
1294
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304int device_for_each_child(struct device *parent, void *data,
1305 int (*fn)(struct device *dev, void *data))
1306{
1307 struct klist_iter i;
1308 struct device *child;
1309 int error = 0;
1310
1311 if (!parent->p)
1312 return 0;
1313
1314 klist_iter_init(&parent->p->klist_children, &i);
1315 while ((child = next_device(&i)) && !error)
1316 error = fn(child, data);
1317 klist_iter_exit(&i);
1318 return error;
1319}
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336struct device *device_find_child(struct device *parent, void *data,
1337 int (*match)(struct device *dev, void *data))
1338{
1339 struct klist_iter i;
1340 struct device *child;
1341
1342 if (!parent)
1343 return NULL;
1344
1345 klist_iter_init(&parent->p->klist_children, &i);
1346 while ((child = next_device(&i)))
1347 if (match(child, data) && get_device(child))
1348 break;
1349 klist_iter_exit(&i);
1350 return child;
1351}
1352
1353int __init devices_init(void)
1354{
1355 devices_kset = kset_create_and_add("devices", &device_uevent_ops, NULL);
1356 if (!devices_kset)
1357 return -ENOMEM;
1358 dev_kobj = kobject_create_and_add("dev", NULL);
1359 if (!dev_kobj)
1360 goto dev_kobj_err;
1361 sysfs_dev_block_kobj = kobject_create_and_add("block", dev_kobj);
1362 if (!sysfs_dev_block_kobj)
1363 goto block_kobj_err;
1364 sysfs_dev_char_kobj = kobject_create_and_add("char", dev_kobj);
1365 if (!sysfs_dev_char_kobj)
1366 goto char_kobj_err;
1367
1368 return 0;
1369
1370 char_kobj_err:
1371 kobject_put(sysfs_dev_block_kobj);
1372 block_kobj_err:
1373 kobject_put(dev_kobj);
1374 dev_kobj_err:
1375 kset_unregister(devices_kset);
1376 return -ENOMEM;
1377}
1378
1379EXPORT_SYMBOL_GPL(device_for_each_child);
1380EXPORT_SYMBOL_GPL(device_find_child);
1381
1382EXPORT_SYMBOL_GPL(device_initialize);
1383EXPORT_SYMBOL_GPL(device_add);
1384EXPORT_SYMBOL_GPL(device_register);
1385
1386EXPORT_SYMBOL_GPL(device_del);
1387EXPORT_SYMBOL_GPL(device_unregister);
1388EXPORT_SYMBOL_GPL(get_device);
1389EXPORT_SYMBOL_GPL(put_device);
1390
1391EXPORT_SYMBOL_GPL(device_create_file);
1392EXPORT_SYMBOL_GPL(device_remove_file);
1393
1394struct root_device {
1395 struct device dev;
1396 struct module *owner;
1397};
1398
1399inline struct root_device *to_root_device(struct device *d)
1400{
1401 return container_of(d, struct root_device, dev);
1402}
1403
1404static void root_device_release(struct device *dev)
1405{
1406 kfree(to_root_device(dev));
1407}
1408
1409
1410
1411
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431struct device *__root_device_register(const char *name, struct module *owner)
1432{
1433 struct root_device *root;
1434 int err = -ENOMEM;
1435
1436 root = kzalloc(sizeof(struct root_device), GFP_KERNEL);
1437 if (!root)
1438 return ERR_PTR(err);
1439
1440 err = dev_set_name(&root->dev, "%s", name);
1441 if (err) {
1442 kfree(root);
1443 return ERR_PTR(err);
1444 }
1445
1446 root->dev.release = root_device_release;
1447
1448 err = device_register(&root->dev);
1449 if (err) {
1450 put_device(&root->dev);
1451 return ERR_PTR(err);
1452 }
1453
1454#ifdef CONFIG_MODULES
1455 if (owner) {
1456 struct module_kobject *mk = &owner->mkobj;
1457
1458 err = sysfs_create_link(&root->dev.kobj, &mk->kobj, "module");
1459 if (err) {
1460 device_unregister(&root->dev);
1461 return ERR_PTR(err);
1462 }
1463 root->owner = owner;
1464 }
1465#endif
1466
1467 return &root->dev;
1468}
1469EXPORT_SYMBOL_GPL(__root_device_register);
1470
1471
1472
1473
1474
1475
1476
1477
1478void root_device_unregister(struct device *dev)
1479{
1480 struct root_device *root = to_root_device(dev);
1481
1482 if (root->owner)
1483 sysfs_remove_link(&root->dev.kobj, "module");
1484
1485 device_unregister(dev);
1486}
1487EXPORT_SYMBOL_GPL(root_device_unregister);
1488
1489
1490static void device_create_release(struct device *dev)
1491{
1492 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1493 kfree(dev);
1494}
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521struct device *device_create_vargs(struct class *class, struct device *parent,
1522 dev_t devt, void *drvdata, const char *fmt,
1523 va_list args)
1524{
1525 struct device *dev = NULL;
1526 int retval = -ENODEV;
1527
1528 if (class == NULL || IS_ERR(class))
1529 goto error;
1530
1531 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1532 if (!dev) {
1533 retval = -ENOMEM;
1534 goto error;
1535 }
1536
1537 dev->devt = devt;
1538 dev->class = class;
1539 dev->parent = parent;
1540 dev->release = device_create_release;
1541 dev_set_drvdata(dev, drvdata);
1542
1543 retval = kobject_set_name_vargs(&dev->kobj, fmt, args);
1544 if (retval)
1545 goto error;
1546
1547 retval = device_register(dev);
1548 if (retval)
1549 goto error;
1550
1551 return dev;
1552
1553error:
1554 put_device(dev);
1555 return ERR_PTR(retval);
1556}
1557EXPORT_SYMBOL_GPL(device_create_vargs);
1558
1559
1560
1561
1562
1563
1564
1565
1566
1567
1568
1569
1570
1571
1572
1573
1574
1575
1576
1577
1578
1579
1580
1581
1582
1583struct device *device_create(struct class *class, struct device *parent,
1584 dev_t devt, void *drvdata, const char *fmt, ...)
1585{
1586 va_list vargs;
1587 struct device *dev;
1588
1589 va_start(vargs, fmt);
1590 dev = device_create_vargs(class, parent, devt, drvdata, fmt, vargs);
1591 va_end(vargs);
1592 return dev;
1593}
1594EXPORT_SYMBOL_GPL(device_create);
1595
1596static int __match_devt(struct device *dev, void *data)
1597{
1598 dev_t *devt = data;
1599
1600 return dev->devt == *devt;
1601}
1602
1603
1604
1605
1606
1607
1608
1609
1610
1611void device_destroy(struct class *class, dev_t devt)
1612{
1613 struct device *dev;
1614
1615 dev = class_find_device(class, NULL, &devt, __match_devt);
1616 if (dev) {
1617 put_device(dev);
1618 device_unregister(dev);
1619 }
1620}
1621EXPORT_SYMBOL_GPL(device_destroy);
1622
1623
1624
1625
1626
1627
1628
1629
1630
1631
1632
1633
1634
1635
1636
1637
1638
1639
1640
1641
1642
1643
1644
1645
1646
1647
1648
1649
1650
1651
1652
1653
1654
1655
1656
1657
1658
1659
1660
1661
1662int device_rename(struct device *dev, const char *new_name)
1663{
1664 char *old_class_name = NULL;
1665 char *new_class_name = NULL;
1666 char *old_device_name = NULL;
1667 int error;
1668
1669 dev = get_device(dev);
1670 if (!dev)
1671 return -EINVAL;
1672
1673 pr_debug("device: '%s': %s: renaming to '%s'\n", dev_name(dev),
1674 __func__, new_name);
1675
1676 old_device_name = kstrdup(dev_name(dev), GFP_KERNEL);
1677 if (!old_device_name) {
1678 error = -ENOMEM;
1679 goto out;
1680 }
1681
1682 if (dev->class) {
1683 error = sysfs_rename_link(&dev->class->p->subsys.kobj,
1684 &dev->kobj, old_device_name, new_name);
1685 if (error)
1686 goto out;
1687 }
1688
1689 error = kobject_rename(&dev->kobj, new_name);
1690 if (error)
1691 goto out;
1692
1693out:
1694 put_device(dev);
1695
1696 kfree(new_class_name);
1697 kfree(old_class_name);
1698 kfree(old_device_name);
1699
1700 return error;
1701}
1702EXPORT_SYMBOL_GPL(device_rename);
1703
1704static int device_move_class_links(struct device *dev,
1705 struct device *old_parent,
1706 struct device *new_parent)
1707{
1708 int error = 0;
1709
1710 if (old_parent)
1711 sysfs_remove_link(&dev->kobj, "device");
1712 if (new_parent)
1713 error = sysfs_create_link(&dev->kobj, &new_parent->kobj,
1714 "device");
1715 return error;
1716}
1717
1718
1719
1720
1721
1722
1723
1724int device_move(struct device *dev, struct device *new_parent,
1725 enum dpm_order dpm_order)
1726{
1727 int error;
1728 struct device *old_parent;
1729 struct kobject *new_parent_kobj;
1730
1731 dev = get_device(dev);
1732 if (!dev)
1733 return -EINVAL;
1734
1735 device_pm_lock();
1736 new_parent = get_device(new_parent);
1737 new_parent_kobj = get_device_parent(dev, new_parent);
1738
1739 pr_debug("device: '%s': %s: moving to '%s'\n", dev_name(dev),
1740 __func__, new_parent ? dev_name(new_parent) : "<NULL>");
1741 error = kobject_move(&dev->kobj, new_parent_kobj);
1742 if (error) {
1743 cleanup_glue_dir(dev, new_parent_kobj);
1744 put_device(new_parent);
1745 goto out;
1746 }
1747 old_parent = dev->parent;
1748 dev->parent = new_parent;
1749 if (old_parent)
1750 klist_remove(&dev->p->knode_parent);
1751 if (new_parent) {
1752 klist_add_tail(&dev->p->knode_parent,
1753 &new_parent->p->klist_children);
1754 set_dev_node(dev, dev_to_node(new_parent));
1755 }
1756
1757 if (!dev->class)
1758 goto out_put;
1759 error = device_move_class_links(dev, old_parent, new_parent);
1760 if (error) {
1761
1762 device_move_class_links(dev, new_parent, old_parent);
1763 if (!kobject_move(&dev->kobj, &old_parent->kobj)) {
1764 if (new_parent)
1765 klist_remove(&dev->p->knode_parent);
1766 dev->parent = old_parent;
1767 if (old_parent) {
1768 klist_add_tail(&dev->p->knode_parent,
1769 &old_parent->p->klist_children);
1770 set_dev_node(dev, dev_to_node(old_parent));
1771 }
1772 }
1773 cleanup_glue_dir(dev, new_parent_kobj);
1774 put_device(new_parent);
1775 goto out;
1776 }
1777 switch (dpm_order) {
1778 case DPM_ORDER_NONE:
1779 break;
1780 case DPM_ORDER_DEV_AFTER_PARENT:
1781 device_pm_move_after(dev, new_parent);
1782 break;
1783 case DPM_ORDER_PARENT_BEFORE_DEV:
1784 device_pm_move_before(new_parent, dev);
1785 break;
1786 case DPM_ORDER_DEV_LAST:
1787 device_pm_move_last(dev);
1788 break;
1789 }
1790out_put:
1791 put_device(old_parent);
1792out:
1793 device_pm_unlock();
1794 put_device(dev);
1795 return error;
1796}
1797EXPORT_SYMBOL_GPL(device_move);
1798
1799
1800
1801
1802void device_shutdown(void)
1803{
1804 struct device *dev;
1805
1806 spin_lock(&devices_kset->list_lock);
1807
1808
1809
1810
1811
1812 while (!list_empty(&devices_kset->list)) {
1813 dev = list_entry(devices_kset->list.prev, struct device,
1814 kobj.entry);
1815 get_device(dev);
1816
1817
1818
1819
1820 list_del_init(&dev->kobj.entry);
1821 spin_unlock(&devices_kset->list_lock);
1822
1823
1824 pm_runtime_get_noresume(dev);
1825 pm_runtime_barrier(dev);
1826
1827 if (dev->bus && dev->bus->shutdown) {
1828 dev_dbg(dev, "shutdown\n");
1829 dev->bus->shutdown(dev);
1830 } else if (dev->driver && dev->driver->shutdown) {
1831 dev_dbg(dev, "shutdown\n");
1832 dev->driver->shutdown(dev);
1833 }
1834 put_device(dev);
1835
1836 spin_lock(&devices_kset->list_lock);
1837 }
1838 spin_unlock(&devices_kset->list_lock);
1839 async_synchronize_full();
1840}
1841
1842
1843
1844
1845
1846#ifdef CONFIG_PRINTK
1847int __dev_printk(const char *level, const struct device *dev,
1848 struct va_format *vaf)
1849{
1850 char dict[128];
1851 size_t dictlen = 0;
1852 const char *subsys;
1853
1854 if (!dev)
1855 return printk("%s(NULL device *): %pV", level, vaf);
1856
1857 if (dev->class)
1858 subsys = dev->class->name;
1859 else if (dev->bus)
1860 subsys = dev->bus->name;
1861 else
1862 goto skip;
1863
1864 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1865 "SUBSYSTEM=%s", subsys);
1866
1867
1868
1869
1870
1871
1872
1873
1874 if (MAJOR(dev->devt)) {
1875 char c;
1876
1877 if (strcmp(subsys, "block") == 0)
1878 c = 'b';
1879 else
1880 c = 'c';
1881 dictlen++;
1882 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1883 "DEVICE=%c%u:%u",
1884 c, MAJOR(dev->devt), MINOR(dev->devt));
1885 } else if (strcmp(subsys, "net") == 0) {
1886 struct net_device *net = to_net_dev(dev);
1887
1888 dictlen++;
1889 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1890 "DEVICE=n%u", net->ifindex);
1891 } else {
1892 dictlen++;
1893 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1894 "DEVICE=+%s:%s", subsys, dev_name(dev));
1895 }
1896skip:
1897 return printk_emit(0, level[1] - '0',
1898 dictlen ? dict : NULL, dictlen,
1899 "%s %s: %pV",
1900 dev_driver_string(dev), dev_name(dev), vaf);
1901}
1902EXPORT_SYMBOL(__dev_printk);
1903
1904int dev_printk(const char *level, const struct device *dev,
1905 const char *fmt, ...)
1906{
1907 struct va_format vaf;
1908 va_list args;
1909 int r;
1910
1911 va_start(args, fmt);
1912
1913 vaf.fmt = fmt;
1914 vaf.va = &args;
1915
1916 r = __dev_printk(level, dev, &vaf);
1917 va_end(args);
1918
1919 return r;
1920}
1921EXPORT_SYMBOL(dev_printk);
1922
1923#define define_dev_printk_level(func, kern_level) \
1924int func(const struct device *dev, const char *fmt, ...) \
1925{ \
1926 struct va_format vaf; \
1927 va_list args; \
1928 int r; \
1929 \
1930 va_start(args, fmt); \
1931 \
1932 vaf.fmt = fmt; \
1933 vaf.va = &args; \
1934 \
1935 r = __dev_printk(kern_level, dev, &vaf); \
1936 va_end(args); \
1937 \
1938 return r; \
1939} \
1940EXPORT_SYMBOL(func);
1941
1942define_dev_printk_level(dev_emerg, KERN_EMERG);
1943define_dev_printk_level(dev_alert, KERN_ALERT);
1944define_dev_printk_level(dev_crit, KERN_CRIT);
1945define_dev_printk_level(dev_err, KERN_ERR);
1946define_dev_printk_level(dev_warn, KERN_WARNING);
1947define_dev_printk_level(dev_notice, KERN_NOTICE);
1948define_dev_printk_level(_dev_info, KERN_INFO);
1949
1950#endif
1951