]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/base/core.c
driver-core: Move kobj_to_dev from genhd.h to device.h
[mirror_ubuntu-bionic-kernel.git] / drivers / base / core.c
CommitLineData
1da177e4
LT
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
64bb5d2c
GKH
6 * Copyright (c) 2006 Greg Kroah-Hartman <gregkh@suse.de>
7 * Copyright (c) 2006 Novell, Inc.
1da177e4
LT
8 *
9 * This file is released under the GPLv2
10 *
11 */
12
1da177e4
LT
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>
23681e47 19#include <linux/kdev_t.h>
116af378 20#include <linux/notifier.h>
07d57a32
GL
21#include <linux/of.h>
22#include <linux/of_device.h>
da231fd5 23#include <linux/genhd.h>
815d2d50 24#include <linux/kallsyms.h>
f75b1c60 25#include <linux/mutex.h>
401097ea 26#include <linux/async.h>
af8db150 27#include <linux/pm_runtime.h>
c4e00daa 28#include <linux/netdevice.h>
1da177e4
LT
29
30#include "base.h"
31#include "power/power.h"
32
e52eec13
AK
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
4a3ad20c
GKH
46int (*platform_notify)(struct device *dev) = NULL;
47int (*platform_notify_remove)(struct device *dev) = NULL;
e105b8bf
DW
48static struct kobject *dev_kobj;
49struct kobject *sysfs_dev_char_kobj;
50struct kobject *sysfs_dev_block_kobj;
1da177e4 51
4e886c29
GKH
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
1da177e4 63
3e95637a
AS
64/**
65 * dev_driver_string - Return a device's driver name, if at all possible
66 * @dev: struct device to get the name of
67 *
68 * Will return the device's driver's name if it is bound to a device. If
9169c012 69 * the device is not bound to a driver, it will return the name of the bus
3e95637a
AS
70 * it is attached to. If it is not attached to a bus either, an empty
71 * string will be returned.
72 */
bf9ca69f 73const char *dev_driver_string(const struct device *dev)
3e95637a 74{
3589972e
AS
75 struct device_driver *drv;
76
77 /* dev->driver can change to NULL underneath us because of unbinding,
78 * so be careful about accessing it. dev->bus and dev->class should
79 * never change once they are set, so they don't need special care.
80 */
81 drv = ACCESS_ONCE(dev->driver);
82 return drv ? drv->name :
a456b702
JD
83 (dev->bus ? dev->bus->name :
84 (dev->class ? dev->class->name : ""));
3e95637a 85}
310a922d 86EXPORT_SYMBOL(dev_driver_string);
3e95637a 87
1da177e4
LT
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
4a3ad20c
GKH
91static ssize_t dev_attr_show(struct kobject *kobj, struct attribute *attr,
92 char *buf)
1da177e4 93{
4a3ad20c
GKH
94 struct device_attribute *dev_attr = to_dev_attr(attr);
95 struct device *dev = to_dev(kobj);
4a0c20bf 96 ssize_t ret = -EIO;
1da177e4
LT
97
98 if (dev_attr->show)
54b6f35c 99 ret = dev_attr->show(dev, dev_attr, buf);
815d2d50
AM
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 }
1da177e4
LT
104 return ret;
105}
106
4a3ad20c
GKH
107static ssize_t dev_attr_store(struct kobject *kobj, struct attribute *attr,
108 const char *buf, size_t count)
1da177e4 109{
4a3ad20c
GKH
110 struct device_attribute *dev_attr = to_dev_attr(attr);
111 struct device *dev = to_dev(kobj);
4a0c20bf 112 ssize_t ret = -EIO;
1da177e4
LT
113
114 if (dev_attr->store)
54b6f35c 115 ret = dev_attr->store(dev, dev_attr, buf, count);
1da177e4
LT
116 return ret;
117}
118
52cf25d0 119static const struct sysfs_ops dev_sysfs_ops = {
1da177e4
LT
120 .show = dev_attr_show,
121 .store = dev_attr_store,
122};
123
ca22e56d
KS
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 /* Always return full write size even if we didn't consume all */
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 /* Always return full write size even if we didn't consume all */
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);
1da177e4
LT
174
175/**
176 * device_release - free device structure.
177 * @kobj: device's kobject.
178 *
179 * This is called once the reference count for the object
180 * reaches 0. We forward the call to the device's release
181 * method, which should handle actually freeing the structure.
182 */
4a3ad20c 183static void device_release(struct kobject *kobj)
1da177e4 184{
4a3ad20c 185 struct device *dev = to_dev(kobj);
fb069a5d 186 struct device_private *p = dev->p;
1da177e4
LT
187
188 if (dev->release)
189 dev->release(dev);
f9f852df
KS
190 else if (dev->type && dev->type->release)
191 dev->type->release(dev);
2620efef
GKH
192 else if (dev->class && dev->class->dev_release)
193 dev->class->dev_release(dev);
f810a5cf
AV
194 else
195 WARN(1, KERN_ERR "Device '%s' does not have a release() "
4a3ad20c 196 "function, it is broken and must be fixed.\n",
1e0b2cf9 197 dev_name(dev));
fb069a5d 198 kfree(p);
1da177e4
LT
199}
200
bc451f20
EB
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
8f4afc41 212static struct kobj_type device_ktype = {
1da177e4
LT
213 .release = device_release,
214 .sysfs_ops = &dev_sysfs_ops,
bc451f20 215 .namespace = device_namespace,
1da177e4
LT
216};
217
218
312c004d 219static int dev_uevent_filter(struct kset *kset, struct kobject *kobj)
1da177e4
LT
220{
221 struct kobj_type *ktype = get_ktype(kobj);
222
8f4afc41 223 if (ktype == &device_ktype) {
1da177e4
LT
224 struct device *dev = to_dev(kobj);
225 if (dev->bus)
226 return 1;
23681e47
GKH
227 if (dev->class)
228 return 1;
1da177e4
LT
229 }
230 return 0;
231}
232
312c004d 233static const char *dev_uevent_name(struct kset *kset, struct kobject *kobj)
1da177e4
LT
234{
235 struct device *dev = to_dev(kobj);
236
23681e47
GKH
237 if (dev->bus)
238 return dev->bus->name;
239 if (dev->class)
240 return dev->class->name;
241 return NULL;
1da177e4
LT
242}
243
7eff2e7a
KS
244static int dev_uevent(struct kset *kset, struct kobject *kobj,
245 struct kobj_uevent_env *env)
1da177e4
LT
246{
247 struct device *dev = to_dev(kobj);
1da177e4
LT
248 int retval = 0;
249
6fcf53ac 250 /* add device node properties if present */
23681e47 251 if (MAJOR(dev->devt)) {
6fcf53ac
KS
252 const char *tmp;
253 const char *name;
2c9ede55 254 umode_t mode = 0;
6fcf53ac 255
7eff2e7a
KS
256 add_uevent_var(env, "MAJOR=%u", MAJOR(dev->devt));
257 add_uevent_var(env, "MINOR=%u", MINOR(dev->devt));
e454cea2 258 name = device_get_devnode(dev, &mode, &tmp);
6fcf53ac
KS
259 if (name) {
260 add_uevent_var(env, "DEVNAME=%s", name);
261 kfree(tmp);
e454cea2
KS
262 if (mode)
263 add_uevent_var(env, "DEVMODE=%#o", mode & 0777);
6fcf53ac 264 }
23681e47
GKH
265 }
266
414264f9 267 if (dev->type && dev->type->name)
7eff2e7a 268 add_uevent_var(env, "DEVTYPE=%s", dev->type->name);
414264f9 269
239378f1 270 if (dev->driver)
7eff2e7a 271 add_uevent_var(env, "DRIVER=%s", dev->driver->name);
239378f1 272
07d57a32
GL
273 /* Add common DT information about the device */
274 of_device_uevent(dev, env);
275
7eff2e7a 276 /* have the bus specific function add its stuff */
312c004d 277 if (dev->bus && dev->bus->uevent) {
7eff2e7a 278 retval = dev->bus->uevent(dev, env);
f9f852df 279 if (retval)
7dc72b28 280 pr_debug("device: '%s': %s: bus uevent() returned %d\n",
1e0b2cf9 281 dev_name(dev), __func__, retval);
1da177e4
LT
282 }
283
7eff2e7a 284 /* have the class specific function add its stuff */
2620efef 285 if (dev->class && dev->class->dev_uevent) {
7eff2e7a 286 retval = dev->class->dev_uevent(dev, env);
f9f852df 287 if (retval)
7dc72b28 288 pr_debug("device: '%s': %s: class uevent() "
1e0b2cf9 289 "returned %d\n", dev_name(dev),
2b3a302a 290 __func__, retval);
f9f852df
KS
291 }
292
eef35c2d 293 /* have the device type specific function add its stuff */
f9f852df 294 if (dev->type && dev->type->uevent) {
7eff2e7a 295 retval = dev->type->uevent(dev, env);
f9f852df 296 if (retval)
7dc72b28 297 pr_debug("device: '%s': %s: dev_type uevent() "
1e0b2cf9 298 "returned %d\n", dev_name(dev),
2b3a302a 299 __func__, retval);
2620efef
GKH
300 }
301
1da177e4
LT
302 return retval;
303}
304
9cd43611 305static const struct kset_uevent_ops device_uevent_ops = {
312c004d
KS
306 .filter = dev_uevent_filter,
307 .name = dev_uevent_name,
308 .uevent = dev_uevent,
1da177e4
LT
309};
310
16574dcc
KS
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;
7eff2e7a 316 struct kobj_uevent_env *env = NULL;
16574dcc
KS
317 int i;
318 size_t count = 0;
319 int retval;
320
321 /* search the kset, the device belongs to */
322 top_kobj = &dev->kobj;
5c5daf65
KS
323 while (!top_kobj->kset && top_kobj->parent)
324 top_kobj = top_kobj->parent;
16574dcc
KS
325 if (!top_kobj->kset)
326 goto out;
5c5daf65 327
16574dcc
KS
328 kset = top_kobj->kset;
329 if (!kset->uevent_ops || !kset->uevent_ops->uevent)
330 goto out;
331
332 /* respect filter */
333 if (kset->uevent_ops && kset->uevent_ops->filter)
334 if (!kset->uevent_ops->filter(kset, &dev->kobj))
335 goto out;
336
7eff2e7a
KS
337 env = kzalloc(sizeof(struct kobj_uevent_env), GFP_KERNEL);
338 if (!env)
c7308c81
GKH
339 return -ENOMEM;
340
16574dcc 341 /* let the kset specific function add its keys */
7eff2e7a 342 retval = kset->uevent_ops->uevent(kset, &dev->kobj, env);
16574dcc
KS
343 if (retval)
344 goto out;
345
346 /* copy keys to file */
7eff2e7a
KS
347 for (i = 0; i < env->envp_idx; i++)
348 count += sprintf(&buf[count], "%s\n", env->envp[i]);
16574dcc 349out:
7eff2e7a 350 kfree(env);
16574dcc
KS
351 return count;
352}
353
a7fd6706
KS
354static ssize_t store_uevent(struct device *dev, struct device_attribute *attr,
355 const char *buf, size_t count)
356{
60a96a59
KS
357 enum kobject_action action;
358
3f5468c9 359 if (kobject_action_type(buf, count, &action) == 0)
60a96a59 360 kobject_uevent(&dev->kobj, action);
3f5468c9
KS
361 else
362 dev_err(dev, "uevent: unknown action-string\n");
a7fd6706
KS
363 return count;
364}
365
ad6a1e1c
TH
366static struct device_attribute uevent_attr =
367 __ATTR(uevent, S_IRUGO | S_IWUSR, show_uevent, store_uevent);
368
621a1672
DT
369static int device_add_attributes(struct device *dev,
370 struct device_attribute *attrs)
de0ff00d 371{
621a1672 372 int error = 0;
de0ff00d 373 int i;
621a1672
DT
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
c97415a7
SA
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
621a1672 427static int device_add_groups(struct device *dev,
a4dbd674 428 const struct attribute_group **groups)
621a1672 429{
de0ff00d 430 int error = 0;
621a1672 431 int i;
de0ff00d 432
621a1672
DT
433 if (groups) {
434 for (i = 0; groups[i]; i++) {
435 error = sysfs_create_group(&dev->kobj, groups[i]);
de0ff00d
GKH
436 if (error) {
437 while (--i >= 0)
4a3ad20c
GKH
438 sysfs_remove_group(&dev->kobj,
439 groups[i]);
621a1672 440 break;
de0ff00d
GKH
441 }
442 }
443 }
de0ff00d
GKH
444 return error;
445}
446
621a1672 447static void device_remove_groups(struct device *dev,
a4dbd674 448 const struct attribute_group **groups)
de0ff00d
GKH
449{
450 int i;
621a1672
DT
451
452 if (groups)
453 for (i = 0; groups[i]; i++)
454 sysfs_remove_group(&dev->kobj, groups[i]);
de0ff00d
GKH
455}
456
2620efef
GKH
457static int device_add_attrs(struct device *dev)
458{
459 struct class *class = dev->class;
aed65af1 460 const struct device_type *type = dev->type;
621a1672 461 int error;
2620efef 462
621a1672
DT
463 if (class) {
464 error = device_add_attributes(dev, class->dev_attrs);
f9f852df 465 if (error)
621a1672 466 return error;
c97415a7
SA
467 error = device_add_bin_attributes(dev, class->dev_bin_attrs);
468 if (error)
469 goto err_remove_class_attrs;
2620efef 470 }
f9f852df 471
621a1672
DT
472 if (type) {
473 error = device_add_groups(dev, type->groups);
f9f852df 474 if (error)
c97415a7 475 goto err_remove_class_bin_attrs;
f9f852df
KS
476 }
477
621a1672
DT
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);
c97415a7
SA
487 err_remove_class_bin_attrs:
488 if (class)
489 device_remove_bin_attributes(dev, class->dev_bin_attrs);
621a1672
DT
490 err_remove_class_attrs:
491 if (class)
492 device_remove_attributes(dev, class->dev_attrs);
493
2620efef
GKH
494 return error;
495}
496
497static void device_remove_attrs(struct device *dev)
498{
499 struct class *class = dev->class;
aed65af1 500 const struct device_type *type = dev->type;
2620efef 501
621a1672 502 device_remove_groups(dev, dev->groups);
f9f852df 503
621a1672
DT
504 if (type)
505 device_remove_groups(dev, type->groups);
506
c97415a7 507 if (class) {
621a1672 508 device_remove_attributes(dev, class->dev_attrs);
c97415a7
SA
509 device_remove_bin_attributes(dev, class->dev_bin_attrs);
510 }
2620efef
GKH
511}
512
513
23681e47
GKH
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
ad6a1e1c
TH
520static struct device_attribute devt_attr =
521 __ATTR(dev, S_IRUGO, show_dev, NULL);
522
ca22e56d 523/* /sys/devices/ */
881c6cfd 524struct kset *devices_kset;
1da177e4 525
1da177e4 526/**
4a3ad20c
GKH
527 * device_create_file - create sysfs attribute file for device.
528 * @dev: device.
529 * @attr: device attribute descriptor.
1da177e4 530 */
26579ab7
PC
531int device_create_file(struct device *dev,
532 const struct device_attribute *attr)
1da177e4
LT
533{
534 int error = 0;
0c98b19f 535 if (dev)
1da177e4 536 error = sysfs_create_file(&dev->kobj, &attr->attr);
1da177e4
LT
537 return error;
538}
539
540/**
4a3ad20c
GKH
541 * device_remove_file - remove sysfs attribute file.
542 * @dev: device.
543 * @attr: device attribute descriptor.
1da177e4 544 */
26579ab7
PC
545void device_remove_file(struct device *dev,
546 const struct device_attribute *attr)
1da177e4 547{
0c98b19f 548 if (dev)
1da177e4 549 sysfs_remove_file(&dev->kobj, &attr->attr);
1da177e4
LT
550}
551
2589f188
GKH
552/**
553 * device_create_bin_file - create sysfs binary attribute file for device.
554 * @dev: device.
555 * @attr: device binary attribute descriptor.
556 */
66ecb92b
PC
557int device_create_bin_file(struct device *dev,
558 const struct bin_attribute *attr)
2589f188
GKH
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 * device_remove_bin_file - remove sysfs binary attribute file
569 * @dev: device.
570 * @attr: device binary attribute descriptor.
571 */
66ecb92b
PC
572void device_remove_bin_file(struct device *dev,
573 const struct bin_attribute *attr)
2589f188
GKH
574{
575 if (dev)
576 sysfs_remove_bin_file(&dev->kobj, attr);
577}
578EXPORT_SYMBOL_GPL(device_remove_bin_file);
579
d9a9cdfb 580/**
523ded71 581 * device_schedule_callback_owner - helper to schedule a callback for a device
d9a9cdfb
AS
582 * @dev: device.
583 * @func: callback function to invoke later.
523ded71 584 * @owner: module owning the callback routine
d9a9cdfb
AS
585 *
586 * Attribute methods must not unregister themselves or their parent device
587 * (which would amount to the same thing). Attempts to do so will deadlock,
588 * since unregistration is mutually exclusive with driver callbacks.
589 *
590 * Instead methods can call this routine, which will attempt to allocate
591 * and schedule a workqueue request to call back @func with @dev as its
592 * argument in the workqueue's process context. @dev will be pinned until
593 * @func returns.
594 *
523ded71
AS
595 * This routine is usually called via the inline device_schedule_callback(),
596 * which automatically sets @owner to THIS_MODULE.
597 *
d9a9cdfb 598 * Returns 0 if the request was submitted, -ENOMEM if storage could not
523ded71 599 * be allocated, -ENODEV if a reference to @owner isn't available.
d9a9cdfb
AS
600 *
601 * NOTE: This routine won't work if CONFIG_SYSFS isn't set! It uses an
602 * underlying sysfs routine (since it is intended for use by attribute
603 * methods), and if sysfs isn't available you'll get nothing but -ENOSYS.
604 */
523ded71
AS
605int device_schedule_callback_owner(struct device *dev,
606 void (*func)(struct device *), struct module *owner)
d9a9cdfb
AS
607{
608 return sysfs_schedule_callback(&dev->kobj,
523ded71 609 (void (*)(void *)) func, dev, owner);
d9a9cdfb 610}
523ded71 611EXPORT_SYMBOL_GPL(device_schedule_callback_owner);
d9a9cdfb 612
34bb61f9
JB
613static void klist_children_get(struct klist_node *n)
614{
f791b8c8
GKH
615 struct device_private *p = to_device_private_parent(n);
616 struct device *dev = p->device;
34bb61f9
JB
617
618 get_device(dev);
619}
620
621static void klist_children_put(struct klist_node *n)
622{
f791b8c8
GKH
623 struct device_private *p = to_device_private_parent(n);
624 struct device *dev = p->device;
34bb61f9
JB
625
626 put_device(dev);
627}
628
1da177e4 629/**
4a3ad20c
GKH
630 * device_initialize - init device structure.
631 * @dev: device.
1da177e4 632 *
5739411a
CH
633 * This prepares the device for use by other layers by initializing
634 * its fields.
4a3ad20c 635 * It is the first half of device_register(), if called by
5739411a
CH
636 * that function, though it can also be called separately, so one
637 * may use @dev's fields. In particular, get_device()/put_device()
638 * may be used for reference counting of @dev after calling this
639 * function.
640 *
b10d5efd
AS
641 * All fields in @dev must be initialized by the caller to 0, except
642 * for those explicitly set to some other value. The simplest
643 * approach is to use kzalloc() to allocate the structure containing
644 * @dev.
645 *
5739411a
CH
646 * NOTE: Use put_device() to give up your reference instead of freeing
647 * @dev directly once you have called this function.
1da177e4 648 */
1da177e4
LT
649void device_initialize(struct device *dev)
650{
881c6cfd 651 dev->kobj.kset = devices_kset;
f9cb074b 652 kobject_init(&dev->kobj, &device_ktype);
1da177e4 653 INIT_LIST_HEAD(&dev->dma_pools);
3142788b 654 mutex_init(&dev->mutex);
1704f47b 655 lockdep_set_novalidate_class(&dev->mutex);
9ac7849e
TH
656 spin_lock_init(&dev->devres_lock);
657 INIT_LIST_HEAD(&dev->devres_head);
3b98aeaf 658 device_pm_init(dev);
87348136 659 set_dev_node(dev, -1);
1da177e4
LT
660}
661
86406245 662static struct kobject *virtual_device_parent(struct device *dev)
f0ee61a6 663{
86406245 664 static struct kobject *virtual_dir = NULL;
f0ee61a6 665
86406245 666 if (!virtual_dir)
4ff6abff 667 virtual_dir = kobject_create_and_add("virtual",
881c6cfd 668 &devices_kset->kobj);
f0ee61a6 669
86406245 670 return virtual_dir;
f0ee61a6
GKH
671}
672
bc451f20
EB
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)
40fa5422 688{
bc451f20
EB
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;
43968d2f
GKH
703 int retval;
704
bc451f20
EB
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
6b6e39a6 712 dir->kobj.kset = &class->p->glue_dirs;
bc451f20
EB
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{
86406245 726 if (dev->class) {
77d3d7c1 727 static DEFINE_MUTEX(gdp_mutex);
86406245
KS
728 struct kobject *kobj = NULL;
729 struct kobject *parent_kobj;
730 struct kobject *k;
731
ead454fe 732#ifdef CONFIG_BLOCK
39aba963 733 /* block disks show up in /sys/block */
e52eec13 734 if (sysfs_deprecated && dev->class == &block_class) {
39aba963
KS
735 if (parent && parent->class == &block_class)
736 return &parent->kobj;
6b6e39a6 737 return &block_class.p->subsys.kobj;
39aba963 738 }
ead454fe 739#endif
e52eec13 740
86406245
KS
741 /*
742 * If we have no parent, we live in "virtual".
0f4dafc0
KS
743 * Class-devices with a non class-device as parent, live
744 * in a "glue" directory to prevent namespace collisions.
86406245
KS
745 */
746 if (parent == NULL)
747 parent_kobj = virtual_device_parent(dev);
24b1442d 748 else if (parent->class && !dev->class->ns_type)
86406245
KS
749 return &parent->kobj;
750 else
751 parent_kobj = &parent->kobj;
752
77d3d7c1
TH
753 mutex_lock(&gdp_mutex);
754
86406245 755 /* find our class-directory at the parent and reference it */
6b6e39a6
KS
756 spin_lock(&dev->class->p->glue_dirs.list_lock);
757 list_for_each_entry(k, &dev->class->p->glue_dirs.list, entry)
86406245
KS
758 if (k->parent == parent_kobj) {
759 kobj = kobject_get(k);
760 break;
761 }
6b6e39a6 762 spin_unlock(&dev->class->p->glue_dirs.list_lock);
77d3d7c1
TH
763 if (kobj) {
764 mutex_unlock(&gdp_mutex);
86406245 765 return kobj;
77d3d7c1 766 }
86406245
KS
767
768 /* or create a new class-directory at the parent device */
bc451f20 769 k = class_dir_create_and_add(dev->class, parent_kobj);
0f4dafc0 770 /* do not emit an uevent for this simple "glue" directory */
77d3d7c1 771 mutex_unlock(&gdp_mutex);
43968d2f 772 return k;
86406245
KS
773 }
774
ca22e56d
KS
775 /* subsystems can specify a default root directory for their devices */
776 if (!parent && dev->bus && dev->bus->dev_root)
777 return &dev->bus->dev_root->kobj;
778
86406245 779 if (parent)
c744aeae
CH
780 return &parent->kobj;
781 return NULL;
782}
da231fd5 783
63b6971a 784static void cleanup_glue_dir(struct device *dev, struct kobject *glue_dir)
da231fd5 785{
0f4dafc0 786 /* see if we live in a "glue" directory */
c1fe539a 787 if (!glue_dir || !dev->class ||
6b6e39a6 788 glue_dir->kset != &dev->class->p->glue_dirs)
da231fd5
KS
789 return;
790
0f4dafc0 791 kobject_put(glue_dir);
da231fd5 792}
63b6971a
CH
793
794static void cleanup_device_parent(struct device *dev)
795{
796 cleanup_glue_dir(dev, dev->kobj.parent);
797}
86406245 798
2ee97caf
CH
799static int device_add_class_symlinks(struct device *dev)
800{
801 int error;
802
803 if (!dev->class)
804 return 0;
da231fd5 805
1fbfee6c 806 error = sysfs_create_link(&dev->kobj,
6b6e39a6 807 &dev->class->p->subsys.kobj,
2ee97caf
CH
808 "subsystem");
809 if (error)
810 goto out;
da231fd5 811
4e886c29 812 if (dev->parent && device_is_not_partition(dev)) {
39aba963 813 error = sysfs_create_link(&dev->kobj, &dev->parent->kobj,
4f01a757
DT
814 "device");
815 if (error)
39aba963 816 goto out_subsys;
2ee97caf 817 }
2ee97caf 818
ead454fe 819#ifdef CONFIG_BLOCK
39aba963 820 /* /sys/block has directories and does not need symlinks */
e52eec13 821 if (sysfs_deprecated && dev->class == &block_class)
39aba963 822 return 0;
ead454fe 823#endif
39aba963 824
da231fd5 825 /* link in the class directory pointing to the device */
6b6e39a6 826 error = sysfs_create_link(&dev->class->p->subsys.kobj,
1e0b2cf9 827 &dev->kobj, dev_name(dev));
da231fd5 828 if (error)
39aba963 829 goto out_device;
da231fd5 830
da231fd5
KS
831 return 0;
832
39aba963
KS
833out_device:
834 sysfs_remove_link(&dev->kobj, "device");
da231fd5 835
2ee97caf
CH
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;
da231fd5 846
4e886c29 847 if (dev->parent && device_is_not_partition(dev))
da231fd5 848 sysfs_remove_link(&dev->kobj, "device");
2ee97caf 849 sysfs_remove_link(&dev->kobj, "subsystem");
ead454fe 850#ifdef CONFIG_BLOCK
e52eec13 851 if (sysfs_deprecated && dev->class == &block_class)
39aba963 852 return;
ead454fe 853#endif
6b6e39a6 854 sysfs_delete_link(&dev->class->p->subsys.kobj, &dev->kobj, dev_name(dev));
2ee97caf
CH
855}
856
413c239f
SR
857/**
858 * dev_set_name - set a device name
859 * @dev: device
46232366 860 * @fmt: format string for the device's name
413c239f
SR
861 */
862int dev_set_name(struct device *dev, const char *fmt, ...)
863{
864 va_list vargs;
1fa5ae85 865 int err;
413c239f
SR
866
867 va_start(vargs, fmt);
1fa5ae85 868 err = kobject_set_name_vargs(&dev->kobj, fmt, vargs);
413c239f 869 va_end(vargs);
1fa5ae85 870 return err;
413c239f
SR
871}
872EXPORT_SYMBOL_GPL(dev_set_name);
873
e105b8bf
DW
874/**
875 * device_to_dev_kobj - select a /sys/dev/ directory for the device
876 * @dev: device
877 *
878 * By default we select char/ for new entries. Setting class->dev_obj
879 * to NULL prevents an entry from being created. class->dev_kobj must
880 * be set (or cleared) before any devices are registered to the class
881 * otherwise device_create_sys_dev_entry() and
0d4e293c
PK
882 * device_remove_sys_dev_entry() will disagree about the presence of
883 * the link.
e105b8bf
DW
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
b4028437
GKH
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);
ef8a3fd6 930 INIT_LIST_HEAD(&dev->p->deferred_probe);
b4028437
GKH
931 return 0;
932}
933
1da177e4 934/**
4a3ad20c
GKH
935 * device_add - add device to device hierarchy.
936 * @dev: device.
1da177e4 937 *
4a3ad20c
GKH
938 * This is part 2 of device_register(), though may be called
939 * separately _iff_ device_initialize() has been called separately.
1da177e4 940 *
5739411a 941 * This adds @dev to the kobject hierarchy via kobject_add(), adds it
4a3ad20c
GKH
942 * to the global and sibling lists for the device, then
943 * adds it to the other relevant subsystems of the driver model.
5739411a 944 *
b10d5efd
AS
945 * Do not call this routine or device_register() more than once for
946 * any device structure. The driver model core is not designed to work
947 * with devices that get unregistered and then spring back to life.
948 * (Among other things, it's very hard to guarantee that all references
949 * to the previous incarnation of @dev have been dropped.) Allocate
950 * and register a fresh new struct device instead.
951 *
5739411a
CH
952 * NOTE: _Never_ directly free @dev after calling this function, even
953 * if it returned an error! Always use put_device() to give up your
954 * reference instead.
1da177e4
LT
955 */
956int device_add(struct device *dev)
957{
958 struct device *parent = NULL;
ca22e56d 959 struct kobject *kobj;
c47ed219 960 struct class_interface *class_intf;
c906a48a 961 int error = -EINVAL;
775b64d2 962
1da177e4 963 dev = get_device(dev);
c906a48a
GKH
964 if (!dev)
965 goto done;
966
fb069a5d 967 if (!dev->p) {
b4028437
GKH
968 error = device_private_init(dev);
969 if (error)
970 goto done;
fb069a5d 971 }
fb069a5d 972
1fa5ae85
KS
973 /*
974 * for statically allocated devices, which should all be converted
975 * some day, we need to initialize the name. We prevent reading back
976 * the name, and force the use of dev_name()
977 */
978 if (dev->init_name) {
acc0e90f 979 dev_set_name(dev, "%s", dev->init_name);
1fa5ae85
KS
980 dev->init_name = NULL;
981 }
c906a48a 982
ca22e56d
KS
983 /* subsystems can specify simple device enumeration */
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
e6309e75
TG
987 if (!dev_name(dev)) {
988 error = -EINVAL;
5c8563d7 989 goto name_error;
e6309e75 990 }
1da177e4 991
1e0b2cf9 992 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
c205ef48 993
1da177e4 994 parent = get_device(dev->parent);
ca22e56d
KS
995 kobj = get_device_parent(dev, parent);
996 if (kobj)
997 dev->kobj.parent = kobj;
1da177e4 998
0d358f22
YL
999 /* use parent numa_node */
1000 if (parent)
1001 set_dev_node(dev, dev_to_node(parent));
1002
1da177e4 1003 /* first, register with generic layer. */
8a577ffc
KS
1004 /* we require the name to be set before, and pass NULL */
1005 error = kobject_add(&dev->kobj, dev->kobj.parent, NULL);
40fa5422 1006 if (error)
1da177e4 1007 goto Error;
a7fd6706 1008
37022644
BW
1009 /* notify platform of device entry */
1010 if (platform_notify)
1011 platform_notify(dev);
1012
ad6a1e1c 1013 error = device_create_file(dev, &uevent_attr);
a306eea4
CH
1014 if (error)
1015 goto attrError;
a7fd6706 1016
23681e47 1017 if (MAJOR(dev->devt)) {
ad6a1e1c
TH
1018 error = device_create_file(dev, &devt_attr);
1019 if (error)
a306eea4 1020 goto ueventattrError;
e105b8bf
DW
1021
1022 error = device_create_sys_dev_entry(dev);
1023 if (error)
1024 goto devtattrError;
2b2af54a
KS
1025
1026 devtmpfs_create_node(dev);
23681e47
GKH
1027 }
1028
2ee97caf
CH
1029 error = device_add_class_symlinks(dev);
1030 if (error)
1031 goto SymlinkError;
dc0afa83
CH
1032 error = device_add_attrs(dev);
1033 if (error)
2620efef 1034 goto AttrsError;
dc0afa83
CH
1035 error = bus_add_device(dev);
1036 if (error)
1da177e4 1037 goto BusError;
3b98aeaf 1038 error = dpm_sysfs_add(dev);
57eee3d2 1039 if (error)
3b98aeaf
AS
1040 goto DPMError;
1041 device_pm_add(dev);
ec0676ee
AS
1042
1043 /* Notify clients of device addition. This call must come
268863f4 1044 * after dpm_sysfs_add() and before kobject_uevent().
ec0676ee
AS
1045 */
1046 if (dev->bus)
1047 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1048 BUS_NOTIFY_ADD_DEVICE, dev);
1049
83b5fb4c 1050 kobject_uevent(&dev->kobj, KOBJ_ADD);
2023c610 1051 bus_probe_device(dev);
1da177e4 1052 if (parent)
f791b8c8
GKH
1053 klist_add_tail(&dev->p->knode_parent,
1054 &parent->p->klist_children);
1da177e4 1055
5d9fd169 1056 if (dev->class) {
ca22e56d 1057 mutex_lock(&dev->class->p->mutex);
c47ed219 1058 /* tie the class to the device */
5a3ceb86 1059 klist_add_tail(&dev->knode_class,
6b6e39a6 1060 &dev->class->p->klist_devices);
c47ed219
GKH
1061
1062 /* notify any interfaces that the device is here */
184f1f77 1063 list_for_each_entry(class_intf,
ca22e56d 1064 &dev->class->p->interfaces, node)
c47ed219
GKH
1065 if (class_intf->add_dev)
1066 class_intf->add_dev(dev, class_intf);
ca22e56d 1067 mutex_unlock(&dev->class->p->mutex);
5d9fd169 1068 }
c906a48a 1069done:
1da177e4
LT
1070 put_device(dev);
1071 return error;
3b98aeaf 1072 DPMError:
57eee3d2
RW
1073 bus_remove_device(dev);
1074 BusError:
82f0cf9b 1075 device_remove_attrs(dev);
2620efef 1076 AttrsError:
2ee97caf
CH
1077 device_remove_class_symlinks(dev);
1078 SymlinkError:
ad72956d
KS
1079 if (MAJOR(dev->devt))
1080 devtmpfs_delete_node(dev);
e105b8bf
DW
1081 if (MAJOR(dev->devt))
1082 device_remove_sys_dev_entry(dev);
1083 devtattrError:
ad6a1e1c
TH
1084 if (MAJOR(dev->devt))
1085 device_remove_file(dev, &devt_attr);
a306eea4 1086 ueventattrError:
ad6a1e1c 1087 device_remove_file(dev, &uevent_attr);
23681e47 1088 attrError:
312c004d 1089 kobject_uevent(&dev->kobj, KOBJ_REMOVE);
1da177e4
LT
1090 kobject_del(&dev->kobj);
1091 Error:
63b6971a 1092 cleanup_device_parent(dev);
1da177e4
LT
1093 if (parent)
1094 put_device(parent);
5c8563d7
KS
1095name_error:
1096 kfree(dev->p);
1097 dev->p = NULL;
c906a48a 1098 goto done;
1da177e4
LT
1099}
1100
1da177e4 1101/**
4a3ad20c
GKH
1102 * device_register - register a device with the system.
1103 * @dev: pointer to the device structure
1da177e4 1104 *
4a3ad20c
GKH
1105 * This happens in two clean steps - initialize the device
1106 * and add it to the system. The two steps can be called
1107 * separately, but this is the easiest and most common.
1108 * I.e. you should only call the two helpers separately if
1109 * have a clearly defined need to use and refcount the device
1110 * before it is added to the hierarchy.
5739411a 1111 *
b10d5efd
AS
1112 * For more information, see the kerneldoc for device_initialize()
1113 * and device_add().
1114 *
5739411a
CH
1115 * NOTE: _Never_ directly free @dev after calling this function, even
1116 * if it returned an error! Always use put_device() to give up the
1117 * reference initialized in this function instead.
1da177e4 1118 */
1da177e4
LT
1119int device_register(struct device *dev)
1120{
1121 device_initialize(dev);
1122 return device_add(dev);
1123}
1124
1da177e4 1125/**
4a3ad20c
GKH
1126 * get_device - increment reference count for device.
1127 * @dev: device.
1da177e4 1128 *
4a3ad20c
GKH
1129 * This simply forwards the call to kobject_get(), though
1130 * we do take care to provide for the case that we get a NULL
1131 * pointer passed in.
1da177e4 1132 */
4a3ad20c 1133struct device *get_device(struct device *dev)
1da177e4
LT
1134{
1135 return dev ? to_dev(kobject_get(&dev->kobj)) : NULL;
1136}
1137
1da177e4 1138/**
4a3ad20c
GKH
1139 * put_device - decrement reference count.
1140 * @dev: device in question.
1da177e4 1141 */
4a3ad20c 1142void put_device(struct device *dev)
1da177e4 1143{
edfaa7c3 1144 /* might_sleep(); */
1da177e4
LT
1145 if (dev)
1146 kobject_put(&dev->kobj);
1147}
1148
1da177e4 1149/**
4a3ad20c
GKH
1150 * device_del - delete device from system.
1151 * @dev: device.
1da177e4 1152 *
4a3ad20c
GKH
1153 * This is the first part of the device unregistration
1154 * sequence. This removes the device from the lists we control
1155 * from here, has it removed from the other driver model
1156 * subsystems it was added to in device_add(), and removes it
1157 * from the kobject hierarchy.
1da177e4 1158 *
4a3ad20c
GKH
1159 * NOTE: this should be called manually _iff_ device_add() was
1160 * also called manually.
1da177e4 1161 */
4a3ad20c 1162void device_del(struct device *dev)
1da177e4 1163{
4a3ad20c 1164 struct device *parent = dev->parent;
c47ed219 1165 struct class_interface *class_intf;
1da177e4 1166
ec0676ee
AS
1167 /* Notify clients of device removal. This call must come
1168 * before dpm_sysfs_remove().
1169 */
1170 if (dev->bus)
1171 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1172 BUS_NOTIFY_DEL_DEVICE, dev);
775b64d2 1173 device_pm_remove(dev);
3b98aeaf 1174 dpm_sysfs_remove(dev);
1da177e4 1175 if (parent)
f791b8c8 1176 klist_del(&dev->p->knode_parent);
e105b8bf 1177 if (MAJOR(dev->devt)) {
2b2af54a 1178 devtmpfs_delete_node(dev);
e105b8bf 1179 device_remove_sys_dev_entry(dev);
ad6a1e1c 1180 device_remove_file(dev, &devt_attr);
e105b8bf 1181 }
b9d9c82b 1182 if (dev->class) {
da231fd5 1183 device_remove_class_symlinks(dev);
99ef3ef8 1184
ca22e56d 1185 mutex_lock(&dev->class->p->mutex);
c47ed219 1186 /* notify any interfaces that the device is now gone */
184f1f77 1187 list_for_each_entry(class_intf,
ca22e56d 1188 &dev->class->p->interfaces, node)
c47ed219
GKH
1189 if (class_intf->remove_dev)
1190 class_intf->remove_dev(dev, class_intf);
1191 /* remove the device from the class list */
5a3ceb86 1192 klist_del(&dev->knode_class);
ca22e56d 1193 mutex_unlock(&dev->class->p->mutex);
b9d9c82b 1194 }
ad6a1e1c 1195 device_remove_file(dev, &uevent_attr);
2620efef 1196 device_remove_attrs(dev);
28953533 1197 bus_remove_device(dev);
d1c3414c 1198 driver_deferred_probe_del(dev);
1da177e4 1199
2f8d16a9
TH
1200 /*
1201 * Some platform devices are driven without driver attached
1202 * and managed resources may have been acquired. Make sure
1203 * all resources are released.
1204 */
1205 devres_release_all(dev);
1206
1da177e4
LT
1207 /* Notify the platform of the removal, in case they
1208 * need to do anything...
1209 */
1210 if (platform_notify_remove)
1211 platform_notify_remove(dev);
312c004d 1212 kobject_uevent(&dev->kobj, KOBJ_REMOVE);
da231fd5 1213 cleanup_device_parent(dev);
1da177e4 1214 kobject_del(&dev->kobj);
da231fd5 1215 put_device(parent);
1da177e4
LT
1216}
1217
1218/**
4a3ad20c
GKH
1219 * device_unregister - unregister device from system.
1220 * @dev: device going away.
1da177e4 1221 *
4a3ad20c
GKH
1222 * We do this in two parts, like we do device_register(). First,
1223 * we remove it from all the subsystems with device_del(), then
1224 * we decrement the reference count via put_device(). If that
1225 * is the final reference count, the device will be cleaned up
1226 * via device_release() above. Otherwise, the structure will
1227 * stick around until the final reference to the device is dropped.
1da177e4 1228 */
4a3ad20c 1229void device_unregister(struct device *dev)
1da177e4 1230{
1e0b2cf9 1231 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1da177e4
LT
1232 device_del(dev);
1233 put_device(dev);
1234}
1235
4a3ad20c 1236static struct device *next_device(struct klist_iter *i)
36239577 1237{
4a3ad20c 1238 struct klist_node *n = klist_next(i);
f791b8c8
GKH
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;
36239577
PM
1247}
1248
6fcf53ac 1249/**
e454cea2 1250 * device_get_devnode - path of device node file
6fcf53ac 1251 * @dev: device
e454cea2 1252 * @mode: returned file access mode
6fcf53ac
KS
1253 * @tmp: possibly allocated string
1254 *
1255 * Return the relative path of a possible device node.
1256 * Non-default names may need to allocate a memory to compose
1257 * a name. This memory is returned in tmp and needs to be
1258 * freed by the caller.
1259 */
e454cea2 1260const char *device_get_devnode(struct device *dev,
2c9ede55 1261 umode_t *mode, const char **tmp)
6fcf53ac
KS
1262{
1263 char *s;
1264
1265 *tmp = NULL;
1266
1267 /* the device type may provide a specific name */
e454cea2
KS
1268 if (dev->type && dev->type->devnode)
1269 *tmp = dev->type->devnode(dev, mode);
6fcf53ac
KS
1270 if (*tmp)
1271 return *tmp;
1272
1273 /* the class may provide a specific name */
e454cea2
KS
1274 if (dev->class && dev->class->devnode)
1275 *tmp = dev->class->devnode(dev, mode);
6fcf53ac
KS
1276 if (*tmp)
1277 return *tmp;
1278
1279 /* return name without allocation, tmp == NULL */
1280 if (strchr(dev_name(dev), '!') == NULL)
1281 return dev_name(dev);
1282
1283 /* replace '!' in the name with '/' */
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
1da177e4 1292/**
4a3ad20c
GKH
1293 * device_for_each_child - device child iterator.
1294 * @parent: parent struct device.
1295 * @data: data for the callback.
1296 * @fn: function to be called for each device.
1da177e4 1297 *
4a3ad20c
GKH
1298 * Iterate over @parent's child devices, and call @fn for each,
1299 * passing it @data.
1da177e4 1300 *
4a3ad20c
GKH
1301 * We check the return of @fn each time. If it returns anything
1302 * other than 0, we break out and return that value.
1da177e4 1303 */
4a3ad20c
GKH
1304int device_for_each_child(struct device *parent, void *data,
1305 int (*fn)(struct device *dev, void *data))
1da177e4 1306{
36239577 1307 struct klist_iter i;
4a3ad20c 1308 struct device *child;
1da177e4
LT
1309 int error = 0;
1310
014c90db
GKH
1311 if (!parent->p)
1312 return 0;
1313
f791b8c8 1314 klist_iter_init(&parent->p->klist_children, &i);
36239577
PM
1315 while ((child = next_device(&i)) && !error)
1316 error = fn(child, data);
1317 klist_iter_exit(&i);
1da177e4
LT
1318 return error;
1319}
1320
5ab69981
CH
1321/**
1322 * device_find_child - device iterator for locating a particular device.
1323 * @parent: parent struct device
1324 * @data: Data to pass to match function
1325 * @match: Callback function to check device
1326 *
1327 * This is similar to the device_for_each_child() function above, but it
1328 * returns a reference to a device that is 'found' for later use, as
1329 * determined by the @match callback.
1330 *
1331 * The callback should return 0 if the device doesn't match and non-zero
1332 * if it does. If the callback returns non-zero and a reference to the
1333 * current device can be obtained, this function will return to the caller
1334 * and not iterate over any more devices.
1335 */
4a3ad20c
GKH
1336struct device *device_find_child(struct device *parent, void *data,
1337 int (*match)(struct device *dev, void *data))
5ab69981
CH
1338{
1339 struct klist_iter i;
1340 struct device *child;
1341
1342 if (!parent)
1343 return NULL;
1344
f791b8c8 1345 klist_iter_init(&parent->p->klist_children, &i);
5ab69981
CH
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
1da177e4
LT
1353int __init devices_init(void)
1354{
881c6cfd
GKH
1355 devices_kset = kset_create_and_add("devices", &device_uevent_ops, NULL);
1356 if (!devices_kset)
1357 return -ENOMEM;
e105b8bf
DW
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
881c6cfd 1368 return 0;
e105b8bf
DW
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;
1da177e4
LT
1377}
1378
1379EXPORT_SYMBOL_GPL(device_for_each_child);
5ab69981 1380EXPORT_SYMBOL_GPL(device_find_child);
1da177e4
LT
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);
1da177e4
LT
1390
1391EXPORT_SYMBOL_GPL(device_create_file);
1392EXPORT_SYMBOL_GPL(device_remove_file);
23681e47 1393
7f100d15 1394struct root_device {
0aa0dc41
MM
1395 struct device dev;
1396 struct module *owner;
1397};
1398
481e2079
FW
1399inline struct root_device *to_root_device(struct device *d)
1400{
1401 return container_of(d, struct root_device, dev);
1402}
0aa0dc41
MM
1403
1404static void root_device_release(struct device *dev)
1405{
1406 kfree(to_root_device(dev));
1407}
1408
1409/**
1410 * __root_device_register - allocate and register a root device
1411 * @name: root device name
1412 * @owner: owner module of the root device, usually THIS_MODULE
1413 *
1414 * This function allocates a root device and registers it
1415 * using device_register(). In order to free the returned
1416 * device, use root_device_unregister().
1417 *
1418 * Root devices are dummy devices which allow other devices
1419 * to be grouped under /sys/devices. Use this function to
1420 * allocate a root device and then use it as the parent of
1421 * any device which should appear under /sys/devices/{name}
1422 *
1423 * The /sys/devices/{name} directory will also contain a
1424 * 'module' symlink which points to the @owner directory
1425 * in sysfs.
1426 *
f0eae0ed
JN
1427 * Returns &struct device pointer on success, or ERR_PTR() on error.
1428 *
0aa0dc41
MM
1429 * Note: You probably want to use root_device_register().
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
acc0e90f 1440 err = dev_set_name(&root->dev, "%s", name);
0aa0dc41
MM
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
1d9e882b 1454#ifdef CONFIG_MODULES /* gotta find a "cleaner" way to do this */
0aa0dc41
MM
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 * root_device_unregister - unregister and free a root device
7cbcf225 1473 * @dev: device going away
0aa0dc41
MM
1474 *
1475 * This function unregisters and cleans up a device that was created by
1476 * root_device_register().
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
23681e47
GKH
1489
1490static void device_create_release(struct device *dev)
1491{
1e0b2cf9 1492 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
23681e47
GKH
1493 kfree(dev);
1494}
1495
1496/**
8882b394 1497 * device_create_vargs - creates a device and registers it with sysfs
42734daf
HK
1498 * @class: pointer to the struct class that this device should be registered to
1499 * @parent: pointer to the parent struct device of this new device, if any
1500 * @devt: the dev_t for the char device to be added
8882b394 1501 * @drvdata: the data to be added to the device for callbacks
42734daf 1502 * @fmt: string for the device's name
8882b394 1503 * @args: va_list for the device's name
42734daf
HK
1504 *
1505 * This function can be used by char device classes. A struct device
1506 * will be created in sysfs, registered to the specified class.
23681e47 1507 *
23681e47
GKH
1508 * A "dev" file will be created, showing the dev_t for the device, if
1509 * the dev_t is not 0,0.
42734daf
HK
1510 * If a pointer to a parent struct device is passed in, the newly created
1511 * struct device will be a child of that device in sysfs.
1512 * The pointer to the struct device will be returned from the call.
1513 * Any further sysfs files that might be required can be created using this
23681e47
GKH
1514 * pointer.
1515 *
f0eae0ed
JN
1516 * Returns &struct device pointer on success, or ERR_PTR() on error.
1517 *
23681e47
GKH
1518 * Note: the struct class passed to this function must have previously
1519 * been created with a call to class_create().
1520 */
8882b394
GKH
1521struct device *device_create_vargs(struct class *class, struct device *parent,
1522 dev_t devt, void *drvdata, const char *fmt,
1523 va_list args)
23681e47 1524{
23681e47
GKH
1525 struct device *dev = NULL;
1526 int retval = -ENODEV;
1527
1528 if (class == NULL || IS_ERR(class))
1529 goto error;
23681e47
GKH
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;
8882b394 1541 dev_set_drvdata(dev, drvdata);
23681e47 1542
1fa5ae85
KS
1543 retval = kobject_set_name_vargs(&dev->kobj, fmt, args);
1544 if (retval)
1545 goto error;
1546
23681e47
GKH
1547 retval = device_register(dev);
1548 if (retval)
1549 goto error;
1550
23681e47
GKH
1551 return dev;
1552
1553error:
286661b3 1554 put_device(dev);
23681e47
GKH
1555 return ERR_PTR(retval);
1556}
8882b394
GKH
1557EXPORT_SYMBOL_GPL(device_create_vargs);
1558
1559/**
4e106739 1560 * device_create - creates a device and registers it with sysfs
8882b394
GKH
1561 * @class: pointer to the struct class that this device should be registered to
1562 * @parent: pointer to the parent struct device of this new device, if any
1563 * @devt: the dev_t for the char device to be added
1564 * @drvdata: the data to be added to the device for callbacks
1565 * @fmt: string for the device's name
1566 *
1567 * This function can be used by char device classes. A struct device
1568 * will be created in sysfs, registered to the specified class.
1569 *
1570 * A "dev" file will be created, showing the dev_t for the device, if
1571 * the dev_t is not 0,0.
1572 * If a pointer to a parent struct device is passed in, the newly created
1573 * struct device will be a child of that device in sysfs.
1574 * The pointer to the struct device will be returned from the call.
1575 * Any further sysfs files that might be required can be created using this
1576 * pointer.
1577 *
f0eae0ed
JN
1578 * Returns &struct device pointer on success, or ERR_PTR() on error.
1579 *
8882b394
GKH
1580 * Note: the struct class passed to this function must have previously
1581 * been created with a call to class_create().
1582 */
4e106739
GKH
1583struct device *device_create(struct class *class, struct device *parent,
1584 dev_t devt, void *drvdata, const char *fmt, ...)
8882b394
GKH
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}
4e106739 1594EXPORT_SYMBOL_GPL(device_create);
8882b394 1595
cd35449b 1596static int __match_devt(struct device *dev, void *data)
23681e47 1597{
cd35449b 1598 dev_t *devt = data;
23681e47 1599
cd35449b 1600 return dev->devt == *devt;
775b64d2
RW
1601}
1602
1603/**
1604 * device_destroy - removes a device that was created with device_create()
1605 * @class: pointer to the struct class that this device was registered with
1606 * @devt: the dev_t of the device that was previously registered
1607 *
1608 * This call unregisters and cleans up a device that was created with a
1609 * call to device_create().
1610 */
1611void device_destroy(struct class *class, dev_t devt)
1612{
1613 struct device *dev;
23681e47 1614
695794ae 1615 dev = class_find_device(class, NULL, &devt, __match_devt);
cd35449b
DY
1616 if (dev) {
1617 put_device(dev);
23681e47 1618 device_unregister(dev);
cd35449b 1619 }
23681e47
GKH
1620}
1621EXPORT_SYMBOL_GPL(device_destroy);
a2de48ca
GKH
1622
1623/**
1624 * device_rename - renames a device
1625 * @dev: the pointer to the struct device to be renamed
1626 * @new_name: the new name of the device
030c1d2b
EB
1627 *
1628 * It is the responsibility of the caller to provide mutual
1629 * exclusion between two different calls of device_rename
1630 * on the same device to ensure that new_name is valid and
1631 * won't conflict with other devices.
c6c0ac66 1632 *
a5462516
TT
1633 * Note: Don't call this function. Currently, the networking layer calls this
1634 * function, but that will change. The following text from Kay Sievers offers
1635 * some insight:
1636 *
1637 * Renaming devices is racy at many levels, symlinks and other stuff are not
1638 * replaced atomically, and you get a "move" uevent, but it's not easy to
1639 * connect the event to the old and new device. Device nodes are not renamed at
1640 * all, there isn't even support for that in the kernel now.
1641 *
1642 * In the meantime, during renaming, your target name might be taken by another
1643 * driver, creating conflicts. Or the old name is taken directly after you
1644 * renamed it -- then you get events for the same DEVPATH, before you even see
1645 * the "move" event. It's just a mess, and nothing new should ever rely on
1646 * kernel device renaming. Besides that, it's not even implemented now for
1647 * other things than (driver-core wise very simple) network devices.
1648 *
1649 * We are currently about to change network renaming in udev to completely
1650 * disallow renaming of devices in the same namespace as the kernel uses,
1651 * because we can't solve the problems properly, that arise with swapping names
1652 * of multiple interfaces without races. Means, renaming of eth[0-9]* will only
1653 * be allowed to some other name than eth[0-9]*, for the aforementioned
1654 * reasons.
1655 *
1656 * Make up a "real" name in the driver before you register anything, or add
1657 * some other attributes for userspace to find the device, or use udev to add
1658 * symlinks -- but never rename kernel devices later, it's a complete mess. We
1659 * don't even want to get into that and try to implement the missing pieces in
1660 * the core. We really have other pieces to fix in the driver core mess. :)
a2de48ca 1661 */
6937e8f8 1662int device_rename(struct device *dev, const char *new_name)
a2de48ca
GKH
1663{
1664 char *old_class_name = NULL;
1665 char *new_class_name = NULL;
2ee97caf 1666 char *old_device_name = NULL;
a2de48ca
GKH
1667 int error;
1668
1669 dev = get_device(dev);
1670 if (!dev)
1671 return -EINVAL;
1672
1e0b2cf9 1673 pr_debug("device: '%s': %s: renaming to '%s'\n", dev_name(dev),
2b3a302a 1674 __func__, new_name);
a2de48ca 1675
1fa5ae85 1676 old_device_name = kstrdup(dev_name(dev), GFP_KERNEL);
2ee97caf
CH
1677 if (!old_device_name) {
1678 error = -ENOMEM;
1679 goto out;
a2de48ca 1680 }
a2de48ca 1681
f349cf34 1682 if (dev->class) {
6b6e39a6 1683 error = sysfs_rename_link(&dev->class->p->subsys.kobj,
f349cf34
EB
1684 &dev->kobj, old_device_name, new_name);
1685 if (error)
1686 goto out;
1687 }
39aba963 1688
a2de48ca 1689 error = kobject_rename(&dev->kobj, new_name);
1fa5ae85 1690 if (error)
2ee97caf 1691 goto out;
a2de48ca 1692
2ee97caf 1693out:
a2de48ca
GKH
1694 put_device(dev);
1695
a2de48ca 1696 kfree(new_class_name);
952ab431 1697 kfree(old_class_name);
2ee97caf 1698 kfree(old_device_name);
a2de48ca
GKH
1699
1700 return error;
1701}
a2807dbc 1702EXPORT_SYMBOL_GPL(device_rename);
8a82472f
CH
1703
1704static int device_move_class_links(struct device *dev,
1705 struct device *old_parent,
1706 struct device *new_parent)
1707{
f7f3461d 1708 int error = 0;
8a82472f 1709
f7f3461d
GKH
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;
8a82472f
CH
1716}
1717
1718/**
1719 * device_move - moves a device to a new parent
1720 * @dev: the pointer to the struct device to be moved
c744aeae 1721 * @new_parent: the new parent of the device (can by NULL)
ffa6a705 1722 * @dpm_order: how to reorder the dpm_list
8a82472f 1723 */
ffa6a705
CH
1724int device_move(struct device *dev, struct device *new_parent,
1725 enum dpm_order dpm_order)
8a82472f
CH
1726{
1727 int error;
1728 struct device *old_parent;
c744aeae 1729 struct kobject *new_parent_kobj;
8a82472f
CH
1730
1731 dev = get_device(dev);
1732 if (!dev)
1733 return -EINVAL;
1734
ffa6a705 1735 device_pm_lock();
8a82472f 1736 new_parent = get_device(new_parent);
4a3ad20c 1737 new_parent_kobj = get_device_parent(dev, new_parent);
63b6971a 1738
1e0b2cf9
KS
1739 pr_debug("device: '%s': %s: moving to '%s'\n", dev_name(dev),
1740 __func__, new_parent ? dev_name(new_parent) : "<NULL>");
c744aeae 1741 error = kobject_move(&dev->kobj, new_parent_kobj);
8a82472f 1742 if (error) {
63b6971a 1743 cleanup_glue_dir(dev, new_parent_kobj);
8a82472f
CH
1744 put_device(new_parent);
1745 goto out;
1746 }
1747 old_parent = dev->parent;
1748 dev->parent = new_parent;
1749 if (old_parent)
f791b8c8 1750 klist_remove(&dev->p->knode_parent);
0d358f22 1751 if (new_parent) {
f791b8c8
GKH
1752 klist_add_tail(&dev->p->knode_parent,
1753 &new_parent->p->klist_children);
0d358f22
YL
1754 set_dev_node(dev, dev_to_node(new_parent));
1755 }
1756
bdd4034d
RV
1757 if (dev->class) {
1758 error = device_move_class_links(dev, old_parent, new_parent);
1759 if (error) {
1760 /* We ignore errors on cleanup since we're hosed anyway... */
1761 device_move_class_links(dev, new_parent, old_parent);
1762 if (!kobject_move(&dev->kobj, &old_parent->kobj)) {
1763 if (new_parent)
1764 klist_remove(&dev->p->knode_parent);
1765 dev->parent = old_parent;
1766 if (old_parent) {
1767 klist_add_tail(&dev->p->knode_parent,
1768 &old_parent->p->klist_children);
1769 set_dev_node(dev, dev_to_node(old_parent));
1770 }
0d358f22 1771 }
bdd4034d
RV
1772 cleanup_glue_dir(dev, new_parent_kobj);
1773 put_device(new_parent);
1774 goto out;
8a82472f 1775 }
8a82472f 1776 }
ffa6a705
CH
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 }
bdd4034d 1790
8a82472f
CH
1791 put_device(old_parent);
1792out:
ffa6a705 1793 device_pm_unlock();
8a82472f
CH
1794 put_device(dev);
1795 return error;
1796}
8a82472f 1797EXPORT_SYMBOL_GPL(device_move);
37b0c020
GKH
1798
1799/**
1800 * device_shutdown - call ->shutdown() on each device to shutdown.
1801 */
1802void device_shutdown(void)
1803{
6245838f
HD
1804 struct device *dev;
1805
1806 spin_lock(&devices_kset->list_lock);
1807 /*
1808 * Walk the devices list backward, shutting down each in turn.
1809 * Beware that device unplug events may also start pulling
1810 * devices offline, even as the system is shutting down.
1811 */
1812 while (!list_empty(&devices_kset->list)) {
1813 dev = list_entry(devices_kset->list.prev, struct device,
1814 kobj.entry);
d1c6c030
ML
1815
1816 /*
1817 * hold reference count of device's parent to
1818 * prevent it from being freed because parent's
1819 * lock is to be held
1820 */
1821 get_device(dev->parent);
6245838f
HD
1822 get_device(dev);
1823 /*
1824 * Make sure the device is off the kset list, in the
1825 * event that dev->*->shutdown() doesn't remove it.
1826 */
1827 list_del_init(&dev->kobj.entry);
1828 spin_unlock(&devices_kset->list_lock);
fe6b91f4 1829
d1c6c030
ML
1830 /* hold lock to avoid race with probe/release */
1831 if (dev->parent)
1832 device_lock(dev->parent);
1833 device_lock(dev);
1834
fe6b91f4
AS
1835 /* Don't allow any more runtime suspends */
1836 pm_runtime_get_noresume(dev);
1837 pm_runtime_barrier(dev);
37b0c020 1838
37b0c020
GKH
1839 if (dev->bus && dev->bus->shutdown) {
1840 dev_dbg(dev, "shutdown\n");
1841 dev->bus->shutdown(dev);
1842 } else if (dev->driver && dev->driver->shutdown) {
1843 dev_dbg(dev, "shutdown\n");
1844 dev->driver->shutdown(dev);
1845 }
d1c6c030
ML
1846
1847 device_unlock(dev);
1848 if (dev->parent)
1849 device_unlock(dev->parent);
1850
6245838f 1851 put_device(dev);
d1c6c030 1852 put_device(dev->parent);
6245838f
HD
1853
1854 spin_lock(&devices_kset->list_lock);
37b0c020 1855 }
6245838f 1856 spin_unlock(&devices_kset->list_lock);
401097ea 1857 async_synchronize_full();
37b0c020 1858}
99bcf217
JP
1859
1860/*
1861 * Device logging functions
1862 */
1863
1864#ifdef CONFIG_PRINTK
cbc46635
JP
1865int __dev_printk(const char *level, const struct device *dev,
1866 struct va_format *vaf)
99bcf217 1867{
c4e00daa
KS
1868 char dict[128];
1869 size_t dictlen = 0;
1870 const char *subsys;
1871
99bcf217
JP
1872 if (!dev)
1873 return printk("%s(NULL device *): %pV", level, vaf);
1874
c4e00daa
KS
1875 if (dev->class)
1876 subsys = dev->class->name;
1877 else if (dev->bus)
1878 subsys = dev->bus->name;
1879 else
1880 goto skip;
1881
1882 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1883 "SUBSYSTEM=%s", subsys);
1884
1885 /*
1886 * Add device identifier DEVICE=:
1887 * b12:8 block dev_t
1888 * c127:3 char dev_t
1889 * n8 netdev ifindex
1890 * +sound:card0 subsystem:devname
1891 */
1892 if (MAJOR(dev->devt)) {
1893 char c;
1894
1895 if (strcmp(subsys, "block") == 0)
1896 c = 'b';
1897 else
1898 c = 'c';
1899 dictlen++;
1900 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1901 "DEVICE=%c%u:%u",
1902 c, MAJOR(dev->devt), MINOR(dev->devt));
1903 } else if (strcmp(subsys, "net") == 0) {
1904 struct net_device *net = to_net_dev(dev);
1905
1906 dictlen++;
1907 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1908 "DEVICE=n%u", net->ifindex);
1909 } else {
1910 dictlen++;
1911 dictlen += snprintf(dict + dictlen, sizeof(dict) - dictlen,
1912 "DEVICE=+%s:%s", subsys, dev_name(dev));
1913 }
1914skip:
1915 return printk_emit(0, level[1] - '0',
1916 dictlen ? dict : NULL, dictlen,
1917 "%s %s: %pV",
1918 dev_driver_string(dev), dev_name(dev), vaf);
99bcf217 1919}
cbc46635 1920EXPORT_SYMBOL(__dev_printk);
99bcf217
JP
1921
1922int dev_printk(const char *level, const struct device *dev,
1923 const char *fmt, ...)
1924{
1925 struct va_format vaf;
1926 va_list args;
1927 int r;
1928
1929 va_start(args, fmt);
1930
1931 vaf.fmt = fmt;
1932 vaf.va = &args;
1933
1934 r = __dev_printk(level, dev, &vaf);
1935 va_end(args);
1936
1937 return r;
1938}
1939EXPORT_SYMBOL(dev_printk);
1940
1941#define define_dev_printk_level(func, kern_level) \
1942int func(const struct device *dev, const char *fmt, ...) \
1943{ \
1944 struct va_format vaf; \
1945 va_list args; \
1946 int r; \
1947 \
1948 va_start(args, fmt); \
1949 \
1950 vaf.fmt = fmt; \
1951 vaf.va = &args; \
1952 \
1953 r = __dev_printk(kern_level, dev, &vaf); \
1954 va_end(args); \
1955 \
1956 return r; \
1957} \
1958EXPORT_SYMBOL(func);
1959
1960define_dev_printk_level(dev_emerg, KERN_EMERG);
1961define_dev_printk_level(dev_alert, KERN_ALERT);
1962define_dev_printk_level(dev_crit, KERN_CRIT);
1963define_dev_printk_level(dev_err, KERN_ERR);
1964define_dev_printk_level(dev_warn, KERN_WARNING);
1965define_dev_printk_level(dev_notice, KERN_NOTICE);
1966define_dev_printk_level(_dev_info, KERN_INFO);
1967
1968#endif