driver core: Don't ignore class_dir_create_and_add() failure.
[platform/kernel/linux-exynos.git] / drivers / base / core.c
1 /*
2  * drivers/base/core.c - core driver model code (device registration, etc)
3  *
4  * Copyright (c) 2002-3 Patrick Mochel
5  * Copyright (c) 2002-3 Open Source Development Labs
6  * Copyright (c) 2006 Greg Kroah-Hartman <gregkh@suse.de>
7  * Copyright (c) 2006 Novell, Inc.
8  *
9  * This file is released under the GPLv2
10  *
11  */
12
13 #include <linux/device.h>
14 #include <linux/err.h>
15 #include <linux/fwnode.h>
16 #include <linux/init.h>
17 #include <linux/module.h>
18 #include <linux/slab.h>
19 #include <linux/string.h>
20 #include <linux/kdev_t.h>
21 #include <linux/notifier.h>
22 #include <linux/of.h>
23 #include <linux/of_device.h>
24 #include <linux/genhd.h>
25 #include <linux/kallsyms.h>
26 #include <linux/mutex.h>
27 #include <linux/pm_runtime.h>
28 #include <linux/netdevice.h>
29 #include <linux/sched/signal.h>
30 #include <linux/sysfs.h>
31
32 #include "base.h"
33 #include "power/power.h"
34
35 #ifdef CONFIG_SYSFS_DEPRECATED
36 #ifdef CONFIG_SYSFS_DEPRECATED_V2
37 long sysfs_deprecated = 1;
38 #else
39 long sysfs_deprecated = 0;
40 #endif
41 static int __init sysfs_deprecated_setup(char *arg)
42 {
43         return kstrtol(arg, 10, &sysfs_deprecated);
44 }
45 early_param("sysfs.deprecated", sysfs_deprecated_setup);
46 #endif
47
48 /* Device links support. */
49
50 #ifdef CONFIG_SRCU
51 static DEFINE_MUTEX(device_links_lock);
52 DEFINE_STATIC_SRCU(device_links_srcu);
53
54 static inline void device_links_write_lock(void)
55 {
56         mutex_lock(&device_links_lock);
57 }
58
59 static inline void device_links_write_unlock(void)
60 {
61         mutex_unlock(&device_links_lock);
62 }
63
64 int device_links_read_lock(void)
65 {
66         return srcu_read_lock(&device_links_srcu);
67 }
68
69 void device_links_read_unlock(int idx)
70 {
71         srcu_read_unlock(&device_links_srcu, idx);
72 }
73 #else /* !CONFIG_SRCU */
74 static DECLARE_RWSEM(device_links_lock);
75
76 static inline void device_links_write_lock(void)
77 {
78         down_write(&device_links_lock);
79 }
80
81 static inline void device_links_write_unlock(void)
82 {
83         up_write(&device_links_lock);
84 }
85
86 int device_links_read_lock(void)
87 {
88         down_read(&device_links_lock);
89         return 0;
90 }
91
92 void device_links_read_unlock(int not_used)
93 {
94         up_read(&device_links_lock);
95 }
96 #endif /* !CONFIG_SRCU */
97
98 /**
99  * device_is_dependent - Check if one device depends on another one
100  * @dev: Device to check dependencies for.
101  * @target: Device to check against.
102  *
103  * Check if @target depends on @dev or any device dependent on it (its child or
104  * its consumer etc).  Return 1 if that is the case or 0 otherwise.
105  */
106 static int device_is_dependent(struct device *dev, void *target)
107 {
108         struct device_link *link;
109         int ret;
110
111         if (WARN_ON(dev == target))
112                 return 1;
113
114         ret = device_for_each_child(dev, target, device_is_dependent);
115         if (ret)
116                 return ret;
117
118         list_for_each_entry(link, &dev->links.consumers, s_node) {
119                 if (WARN_ON(link->consumer == target))
120                         return 1;
121
122                 ret = device_is_dependent(link->consumer, target);
123                 if (ret)
124                         break;
125         }
126         return ret;
127 }
128
129 static int device_reorder_to_tail(struct device *dev, void *not_used)
130 {
131         struct device_link *link;
132
133         /*
134          * Devices that have not been registered yet will be put to the ends
135          * of the lists during the registration, so skip them here.
136          */
137         if (device_is_registered(dev))
138                 devices_kset_move_last(dev);
139
140         if (device_pm_initialized(dev))
141                 device_pm_move_last(dev);
142
143         device_for_each_child(dev, NULL, device_reorder_to_tail);
144         list_for_each_entry(link, &dev->links.consumers, s_node)
145                 device_reorder_to_tail(link->consumer, NULL);
146
147         return 0;
148 }
149
150 /**
151  * device_link_add - Create a link between two devices.
152  * @consumer: Consumer end of the link.
153  * @supplier: Supplier end of the link.
154  * @flags: Link flags.
155  *
156  * The caller is responsible for the proper synchronization of the link creation
157  * with runtime PM.  First, setting the DL_FLAG_PM_RUNTIME flag will cause the
158  * runtime PM framework to take the link into account.  Second, if the
159  * DL_FLAG_RPM_ACTIVE flag is set in addition to it, the supplier devices will
160  * be forced into the active metastate and reference-counted upon the creation
161  * of the link.  If DL_FLAG_PM_RUNTIME is not set, DL_FLAG_RPM_ACTIVE will be
162  * ignored.
163  *
164  * If the DL_FLAG_AUTOREMOVE is set, the link will be removed automatically
165  * when the consumer device driver unbinds from it.  The combination of both
166  * DL_FLAG_AUTOREMOVE and DL_FLAG_STATELESS set is invalid and will cause NULL
167  * to be returned.
168  *
169  * A side effect of the link creation is re-ordering of dpm_list and the
170  * devices_kset list by moving the consumer device and all devices depending
171  * on it to the ends of these lists (that does not happen to devices that have
172  * not been registered when this function is called).
173  *
174  * The supplier device is required to be registered when this function is called
175  * and NULL will be returned if that is not the case.  The consumer device need
176  * not be registered, however.
177  */
178 struct device_link *device_link_add(struct device *consumer,
179                                     struct device *supplier, u32 flags)
180 {
181         struct device_link *link;
182
183         if (!consumer || !supplier ||
184             ((flags & DL_FLAG_STATELESS) && (flags & DL_FLAG_AUTOREMOVE)))
185                 return NULL;
186
187         device_links_write_lock();
188         device_pm_lock();
189
190         /*
191          * If the supplier has not been fully registered yet or there is a
192          * reverse dependency between the consumer and the supplier already in
193          * the graph, return NULL.
194          */
195         if (!device_pm_initialized(supplier)
196             || device_is_dependent(consumer, supplier)) {
197                 link = NULL;
198                 goto out;
199         }
200
201         list_for_each_entry(link, &supplier->links.consumers, s_node)
202                 if (link->consumer == consumer)
203                         goto out;
204
205         link = kzalloc(sizeof(*link), GFP_KERNEL);
206         if (!link)
207                 goto out;
208
209         if (flags & DL_FLAG_PM_RUNTIME) {
210                 if (flags & DL_FLAG_RPM_ACTIVE) {
211                         if (pm_runtime_get_sync(supplier) < 0) {
212                                 pm_runtime_put_noidle(supplier);
213                                 kfree(link);
214                                 link = NULL;
215                                 goto out;
216                         }
217                         link->rpm_active = true;
218                 }
219                 pm_runtime_new_link(consumer);
220         }
221         get_device(supplier);
222         link->supplier = supplier;
223         INIT_LIST_HEAD(&link->s_node);
224         get_device(consumer);
225         link->consumer = consumer;
226         INIT_LIST_HEAD(&link->c_node);
227         link->flags = flags;
228
229         /* Determine the initial link state. */
230         if (flags & DL_FLAG_STATELESS) {
231                 link->status = DL_STATE_NONE;
232         } else {
233                 switch (supplier->links.status) {
234                 case DL_DEV_DRIVER_BOUND:
235                         switch (consumer->links.status) {
236                         case DL_DEV_PROBING:
237                                 /*
238                                  * Balance the decrementation of the supplier's
239                                  * runtime PM usage counter after consumer probe
240                                  * in driver_probe_device().
241                                  */
242                                 if (flags & DL_FLAG_PM_RUNTIME)
243                                         pm_runtime_get_sync(supplier);
244
245                                 link->status = DL_STATE_CONSUMER_PROBE;
246                                 break;
247                         case DL_DEV_DRIVER_BOUND:
248                                 link->status = DL_STATE_ACTIVE;
249                                 break;
250                         default:
251                                 link->status = DL_STATE_AVAILABLE;
252                                 break;
253                         }
254                         break;
255                 case DL_DEV_UNBINDING:
256                         link->status = DL_STATE_SUPPLIER_UNBIND;
257                         break;
258                 default:
259                         link->status = DL_STATE_DORMANT;
260                         break;
261                 }
262         }
263
264         /*
265          * Move the consumer and all of the devices depending on it to the end
266          * of dpm_list and the devices_kset list.
267          *
268          * It is necessary to hold dpm_list locked throughout all that or else
269          * we may end up suspending with a wrong ordering of it.
270          */
271         device_reorder_to_tail(consumer, NULL);
272
273         list_add_tail_rcu(&link->s_node, &supplier->links.consumers);
274         list_add_tail_rcu(&link->c_node, &consumer->links.suppliers);
275
276         dev_info(consumer, "Linked as a consumer to %s\n", dev_name(supplier));
277
278  out:
279         device_pm_unlock();
280         device_links_write_unlock();
281         return link;
282 }
283 EXPORT_SYMBOL_GPL(device_link_add);
284
285 static void device_link_free(struct device_link *link)
286 {
287         put_device(link->consumer);
288         put_device(link->supplier);
289         kfree(link);
290 }
291
292 #ifdef CONFIG_SRCU
293 static void __device_link_free_srcu(struct rcu_head *rhead)
294 {
295         device_link_free(container_of(rhead, struct device_link, rcu_head));
296 }
297
298 static void __device_link_del(struct device_link *link)
299 {
300         dev_info(link->consumer, "Dropping the link to %s\n",
301                  dev_name(link->supplier));
302
303         if (link->flags & DL_FLAG_PM_RUNTIME)
304                 pm_runtime_drop_link(link->consumer);
305
306         list_del_rcu(&link->s_node);
307         list_del_rcu(&link->c_node);
308         call_srcu(&device_links_srcu, &link->rcu_head, __device_link_free_srcu);
309 }
310 #else /* !CONFIG_SRCU */
311 static void __device_link_del(struct device_link *link)
312 {
313         dev_info(link->consumer, "Dropping the link to %s\n",
314                  dev_name(link->supplier));
315
316         if (link->flags & DL_FLAG_PM_RUNTIME)
317                 pm_runtime_drop_link(link->consumer);
318
319         list_del(&link->s_node);
320         list_del(&link->c_node);
321         device_link_free(link);
322 }
323 #endif /* !CONFIG_SRCU */
324
325 /**
326  * device_link_del - Delete a link between two devices.
327  * @link: Device link to delete.
328  *
329  * The caller must ensure proper synchronization of this function with runtime
330  * PM.
331  */
332 void device_link_del(struct device_link *link)
333 {
334         device_links_write_lock();
335         device_pm_lock();
336         __device_link_del(link);
337         device_pm_unlock();
338         device_links_write_unlock();
339 }
340 EXPORT_SYMBOL_GPL(device_link_del);
341
342 static void device_links_missing_supplier(struct device *dev)
343 {
344         struct device_link *link;
345
346         list_for_each_entry(link, &dev->links.suppliers, c_node)
347                 if (link->status == DL_STATE_CONSUMER_PROBE)
348                         WRITE_ONCE(link->status, DL_STATE_AVAILABLE);
349 }
350
351 /**
352  * device_links_check_suppliers - Check presence of supplier drivers.
353  * @dev: Consumer device.
354  *
355  * Check links from this device to any suppliers.  Walk the list of the device's
356  * links to suppliers and see if all of them are available.  If not, simply
357  * return -EPROBE_DEFER.
358  *
359  * We need to guarantee that the supplier will not go away after the check has
360  * been positive here.  It only can go away in __device_release_driver() and
361  * that function  checks the device's links to consumers.  This means we need to
362  * mark the link as "consumer probe in progress" to make the supplier removal
363  * wait for us to complete (or bad things may happen).
364  *
365  * Links with the DL_FLAG_STATELESS flag set are ignored.
366  */
367 int device_links_check_suppliers(struct device *dev)
368 {
369         struct device_link *link;
370         int ret = 0;
371
372         device_links_write_lock();
373
374         list_for_each_entry(link, &dev->links.suppliers, c_node) {
375                 if (link->flags & DL_FLAG_STATELESS)
376                         continue;
377
378                 if (link->status != DL_STATE_AVAILABLE) {
379                         device_links_missing_supplier(dev);
380                         ret = -EPROBE_DEFER;
381                         break;
382                 }
383                 WRITE_ONCE(link->status, DL_STATE_CONSUMER_PROBE);
384         }
385         dev->links.status = DL_DEV_PROBING;
386
387         device_links_write_unlock();
388         return ret;
389 }
390
391 /**
392  * device_links_driver_bound - Update device links after probing its driver.
393  * @dev: Device to update the links for.
394  *
395  * The probe has been successful, so update links from this device to any
396  * consumers by changing their status to "available".
397  *
398  * Also change the status of @dev's links to suppliers to "active".
399  *
400  * Links with the DL_FLAG_STATELESS flag set are ignored.
401  */
402 void device_links_driver_bound(struct device *dev)
403 {
404         struct device_link *link;
405
406         device_links_write_lock();
407
408         list_for_each_entry(link, &dev->links.consumers, s_node) {
409                 if (link->flags & DL_FLAG_STATELESS)
410                         continue;
411
412                 WARN_ON(link->status != DL_STATE_DORMANT);
413                 WRITE_ONCE(link->status, DL_STATE_AVAILABLE);
414         }
415
416         list_for_each_entry(link, &dev->links.suppliers, c_node) {
417                 if (link->flags & DL_FLAG_STATELESS)
418                         continue;
419
420                 WARN_ON(link->status != DL_STATE_CONSUMER_PROBE);
421                 WRITE_ONCE(link->status, DL_STATE_ACTIVE);
422         }
423
424         dev->links.status = DL_DEV_DRIVER_BOUND;
425
426         device_links_write_unlock();
427 }
428
429 /**
430  * __device_links_no_driver - Update links of a device without a driver.
431  * @dev: Device without a drvier.
432  *
433  * Delete all non-persistent links from this device to any suppliers.
434  *
435  * Persistent links stay around, but their status is changed to "available",
436  * unless they already are in the "supplier unbind in progress" state in which
437  * case they need not be updated.
438  *
439  * Links with the DL_FLAG_STATELESS flag set are ignored.
440  */
441 static void __device_links_no_driver(struct device *dev)
442 {
443         struct device_link *link, *ln;
444
445         list_for_each_entry_safe_reverse(link, ln, &dev->links.suppliers, c_node) {
446                 if (link->flags & DL_FLAG_STATELESS)
447                         continue;
448
449                 if (link->flags & DL_FLAG_AUTOREMOVE)
450                         __device_link_del(link);
451                 else if (link->status != DL_STATE_SUPPLIER_UNBIND)
452                         WRITE_ONCE(link->status, DL_STATE_AVAILABLE);
453         }
454
455         dev->links.status = DL_DEV_NO_DRIVER;
456 }
457
458 void device_links_no_driver(struct device *dev)
459 {
460         device_links_write_lock();
461         __device_links_no_driver(dev);
462         device_links_write_unlock();
463 }
464
465 /**
466  * device_links_driver_cleanup - Update links after driver removal.
467  * @dev: Device whose driver has just gone away.
468  *
469  * Update links to consumers for @dev by changing their status to "dormant" and
470  * invoke %__device_links_no_driver() to update links to suppliers for it as
471  * appropriate.
472  *
473  * Links with the DL_FLAG_STATELESS flag set are ignored.
474  */
475 void device_links_driver_cleanup(struct device *dev)
476 {
477         struct device_link *link;
478
479         device_links_write_lock();
480
481         list_for_each_entry(link, &dev->links.consumers, s_node) {
482                 if (link->flags & DL_FLAG_STATELESS)
483                         continue;
484
485                 WARN_ON(link->flags & DL_FLAG_AUTOREMOVE);
486                 WARN_ON(link->status != DL_STATE_SUPPLIER_UNBIND);
487                 WRITE_ONCE(link->status, DL_STATE_DORMANT);
488         }
489
490         __device_links_no_driver(dev);
491
492         device_links_write_unlock();
493 }
494
495 /**
496  * device_links_busy - Check if there are any busy links to consumers.
497  * @dev: Device to check.
498  *
499  * Check each consumer of the device and return 'true' if its link's status
500  * is one of "consumer probe" or "active" (meaning that the given consumer is
501  * probing right now or its driver is present).  Otherwise, change the link
502  * state to "supplier unbind" to prevent the consumer from being probed
503  * successfully going forward.
504  *
505  * Return 'false' if there are no probing or active consumers.
506  *
507  * Links with the DL_FLAG_STATELESS flag set are ignored.
508  */
509 bool device_links_busy(struct device *dev)
510 {
511         struct device_link *link;
512         bool ret = false;
513
514         device_links_write_lock();
515
516         list_for_each_entry(link, &dev->links.consumers, s_node) {
517                 if (link->flags & DL_FLAG_STATELESS)
518                         continue;
519
520                 if (link->status == DL_STATE_CONSUMER_PROBE
521                     || link->status == DL_STATE_ACTIVE) {
522                         ret = true;
523                         break;
524                 }
525                 WRITE_ONCE(link->status, DL_STATE_SUPPLIER_UNBIND);
526         }
527
528         dev->links.status = DL_DEV_UNBINDING;
529
530         device_links_write_unlock();
531         return ret;
532 }
533
534 /**
535  * device_links_unbind_consumers - Force unbind consumers of the given device.
536  * @dev: Device to unbind the consumers of.
537  *
538  * Walk the list of links to consumers for @dev and if any of them is in the
539  * "consumer probe" state, wait for all device probes in progress to complete
540  * and start over.
541  *
542  * If that's not the case, change the status of the link to "supplier unbind"
543  * and check if the link was in the "active" state.  If so, force the consumer
544  * driver to unbind and start over (the consumer will not re-probe as we have
545  * changed the state of the link already).
546  *
547  * Links with the DL_FLAG_STATELESS flag set are ignored.
548  */
549 void device_links_unbind_consumers(struct device *dev)
550 {
551         struct device_link *link;
552
553  start:
554         device_links_write_lock();
555
556         list_for_each_entry(link, &dev->links.consumers, s_node) {
557                 enum device_link_state status;
558
559                 if (link->flags & DL_FLAG_STATELESS)
560                         continue;
561
562                 status = link->status;
563                 if (status == DL_STATE_CONSUMER_PROBE) {
564                         device_links_write_unlock();
565
566                         wait_for_device_probe();
567                         goto start;
568                 }
569                 WRITE_ONCE(link->status, DL_STATE_SUPPLIER_UNBIND);
570                 if (status == DL_STATE_ACTIVE) {
571                         struct device *consumer = link->consumer;
572
573                         get_device(consumer);
574
575                         device_links_write_unlock();
576
577                         device_release_driver_internal(consumer, NULL,
578                                                        consumer->parent);
579                         put_device(consumer);
580                         goto start;
581                 }
582         }
583
584         device_links_write_unlock();
585 }
586
587 /**
588  * device_links_purge - Delete existing links to other devices.
589  * @dev: Target device.
590  */
591 static void device_links_purge(struct device *dev)
592 {
593         struct device_link *link, *ln;
594
595         /*
596          * Delete all of the remaining links from this device to any other
597          * devices (either consumers or suppliers).
598          */
599         device_links_write_lock();
600
601         list_for_each_entry_safe_reverse(link, ln, &dev->links.suppliers, c_node) {
602                 WARN_ON(link->status == DL_STATE_ACTIVE);
603                 __device_link_del(link);
604         }
605
606         list_for_each_entry_safe_reverse(link, ln, &dev->links.consumers, s_node) {
607                 WARN_ON(link->status != DL_STATE_DORMANT &&
608                         link->status != DL_STATE_NONE);
609                 __device_link_del(link);
610         }
611
612         device_links_write_unlock();
613 }
614
615 /* Device links support end. */
616
617 int (*platform_notify)(struct device *dev) = NULL;
618 int (*platform_notify_remove)(struct device *dev) = NULL;
619 static struct kobject *dev_kobj;
620 struct kobject *sysfs_dev_char_kobj;
621 struct kobject *sysfs_dev_block_kobj;
622
623 static DEFINE_MUTEX(device_hotplug_lock);
624
625 void lock_device_hotplug(void)
626 {
627         mutex_lock(&device_hotplug_lock);
628 }
629
630 void unlock_device_hotplug(void)
631 {
632         mutex_unlock(&device_hotplug_lock);
633 }
634
635 int lock_device_hotplug_sysfs(void)
636 {
637         if (mutex_trylock(&device_hotplug_lock))
638                 return 0;
639
640         /* Avoid busy looping (5 ms of sleep should do). */
641         msleep(5);
642         return restart_syscall();
643 }
644
645 #ifdef CONFIG_BLOCK
646 static inline int device_is_not_partition(struct device *dev)
647 {
648         return !(dev->type == &part_type);
649 }
650 #else
651 static inline int device_is_not_partition(struct device *dev)
652 {
653         return 1;
654 }
655 #endif
656
657 /**
658  * dev_driver_string - Return a device's driver name, if at all possible
659  * @dev: struct device to get the name of
660  *
661  * Will return the device's driver's name if it is bound to a device.  If
662  * the device is not bound to a driver, it will return the name of the bus
663  * it is attached to.  If it is not attached to a bus either, an empty
664  * string will be returned.
665  */
666 const char *dev_driver_string(const struct device *dev)
667 {
668         struct device_driver *drv;
669
670         /* dev->driver can change to NULL underneath us because of unbinding,
671          * so be careful about accessing it.  dev->bus and dev->class should
672          * never change once they are set, so they don't need special care.
673          */
674         drv = ACCESS_ONCE(dev->driver);
675         return drv ? drv->name :
676                         (dev->bus ? dev->bus->name :
677                         (dev->class ? dev->class->name : ""));
678 }
679 EXPORT_SYMBOL(dev_driver_string);
680
681 #define to_dev_attr(_attr) container_of(_attr, struct device_attribute, attr)
682
683 static ssize_t dev_attr_show(struct kobject *kobj, struct attribute *attr,
684                              char *buf)
685 {
686         struct device_attribute *dev_attr = to_dev_attr(attr);
687         struct device *dev = kobj_to_dev(kobj);
688         ssize_t ret = -EIO;
689
690         if (dev_attr->show)
691                 ret = dev_attr->show(dev, dev_attr, buf);
692         if (ret >= (ssize_t)PAGE_SIZE) {
693                 print_symbol("dev_attr_show: %s returned bad count\n",
694                                 (unsigned long)dev_attr->show);
695         }
696         return ret;
697 }
698
699 static ssize_t dev_attr_store(struct kobject *kobj, struct attribute *attr,
700                               const char *buf, size_t count)
701 {
702         struct device_attribute *dev_attr = to_dev_attr(attr);
703         struct device *dev = kobj_to_dev(kobj);
704         ssize_t ret = -EIO;
705
706         if (dev_attr->store)
707                 ret = dev_attr->store(dev, dev_attr, buf, count);
708         return ret;
709 }
710
711 static const struct sysfs_ops dev_sysfs_ops = {
712         .show   = dev_attr_show,
713         .store  = dev_attr_store,
714 };
715
716 #define to_ext_attr(x) container_of(x, struct dev_ext_attribute, attr)
717
718 ssize_t device_store_ulong(struct device *dev,
719                            struct device_attribute *attr,
720                            const char *buf, size_t size)
721 {
722         struct dev_ext_attribute *ea = to_ext_attr(attr);
723         char *end;
724         unsigned long new = simple_strtoul(buf, &end, 0);
725         if (end == buf)
726                 return -EINVAL;
727         *(unsigned long *)(ea->var) = new;
728         /* Always return full write size even if we didn't consume all */
729         return size;
730 }
731 EXPORT_SYMBOL_GPL(device_store_ulong);
732
733 ssize_t device_show_ulong(struct device *dev,
734                           struct device_attribute *attr,
735                           char *buf)
736 {
737         struct dev_ext_attribute *ea = to_ext_attr(attr);
738         return snprintf(buf, PAGE_SIZE, "%lx\n", *(unsigned long *)(ea->var));
739 }
740 EXPORT_SYMBOL_GPL(device_show_ulong);
741
742 ssize_t device_store_int(struct device *dev,
743                          struct device_attribute *attr,
744                          const char *buf, size_t size)
745 {
746         struct dev_ext_attribute *ea = to_ext_attr(attr);
747         char *end;
748         long new = simple_strtol(buf, &end, 0);
749         if (end == buf || new > INT_MAX || new < INT_MIN)
750                 return -EINVAL;
751         *(int *)(ea->var) = new;
752         /* Always return full write size even if we didn't consume all */
753         return size;
754 }
755 EXPORT_SYMBOL_GPL(device_store_int);
756
757 ssize_t device_show_int(struct device *dev,
758                         struct device_attribute *attr,
759                         char *buf)
760 {
761         struct dev_ext_attribute *ea = to_ext_attr(attr);
762
763         return snprintf(buf, PAGE_SIZE, "%d\n", *(int *)(ea->var));
764 }
765 EXPORT_SYMBOL_GPL(device_show_int);
766
767 ssize_t device_store_bool(struct device *dev, struct device_attribute *attr,
768                           const char *buf, size_t size)
769 {
770         struct dev_ext_attribute *ea = to_ext_attr(attr);
771
772         if (strtobool(buf, ea->var) < 0)
773                 return -EINVAL;
774
775         return size;
776 }
777 EXPORT_SYMBOL_GPL(device_store_bool);
778
779 ssize_t device_show_bool(struct device *dev, struct device_attribute *attr,
780                          char *buf)
781 {
782         struct dev_ext_attribute *ea = to_ext_attr(attr);
783
784         return snprintf(buf, PAGE_SIZE, "%d\n", *(bool *)(ea->var));
785 }
786 EXPORT_SYMBOL_GPL(device_show_bool);
787
788 /**
789  * device_release - free device structure.
790  * @kobj: device's kobject.
791  *
792  * This is called once the reference count for the object
793  * reaches 0. We forward the call to the device's release
794  * method, which should handle actually freeing the structure.
795  */
796 static void device_release(struct kobject *kobj)
797 {
798         struct device *dev = kobj_to_dev(kobj);
799         struct device_private *p = dev->p;
800
801         /*
802          * Some platform devices are driven without driver attached
803          * and managed resources may have been acquired.  Make sure
804          * all resources are released.
805          *
806          * Drivers still can add resources into device after device
807          * is deleted but alive, so release devres here to avoid
808          * possible memory leak.
809          */
810         devres_release_all(dev);
811
812         if (dev->release)
813                 dev->release(dev);
814         else if (dev->type && dev->type->release)
815                 dev->type->release(dev);
816         else if (dev->class && dev->class->dev_release)
817                 dev->class->dev_release(dev);
818         else
819                 WARN(1, KERN_ERR "Device '%s' does not have a release() "
820                         "function, it is broken and must be fixed.\n",
821                         dev_name(dev));
822         kfree(p);
823 }
824
825 static const void *device_namespace(struct kobject *kobj)
826 {
827         struct device *dev = kobj_to_dev(kobj);
828         const void *ns = NULL;
829
830         if (dev->class && dev->class->ns_type)
831                 ns = dev->class->namespace(dev);
832
833         return ns;
834 }
835
836 static struct kobj_type device_ktype = {
837         .release        = device_release,
838         .sysfs_ops      = &dev_sysfs_ops,
839         .namespace      = device_namespace,
840 };
841
842
843 static int dev_uevent_filter(struct kset *kset, struct kobject *kobj)
844 {
845         struct kobj_type *ktype = get_ktype(kobj);
846
847         if (ktype == &device_ktype) {
848                 struct device *dev = kobj_to_dev(kobj);
849                 if (dev->bus)
850                         return 1;
851                 if (dev->class)
852                         return 1;
853         }
854         return 0;
855 }
856
857 static const char *dev_uevent_name(struct kset *kset, struct kobject *kobj)
858 {
859         struct device *dev = kobj_to_dev(kobj);
860
861         if (dev->bus)
862                 return dev->bus->name;
863         if (dev->class)
864                 return dev->class->name;
865         return NULL;
866 }
867
868 static int dev_uevent(struct kset *kset, struct kobject *kobj,
869                       struct kobj_uevent_env *env)
870 {
871         struct device *dev = kobj_to_dev(kobj);
872         int retval = 0;
873
874         /* add device node properties if present */
875         if (MAJOR(dev->devt)) {
876                 const char *tmp;
877                 const char *name;
878                 umode_t mode = 0;
879                 kuid_t uid = GLOBAL_ROOT_UID;
880                 kgid_t gid = GLOBAL_ROOT_GID;
881
882                 add_uevent_var(env, "MAJOR=%u", MAJOR(dev->devt));
883                 add_uevent_var(env, "MINOR=%u", MINOR(dev->devt));
884                 name = device_get_devnode(dev, &mode, &uid, &gid, &tmp);
885                 if (name) {
886                         add_uevent_var(env, "DEVNAME=%s", name);
887                         if (mode)
888                                 add_uevent_var(env, "DEVMODE=%#o", mode & 0777);
889                         if (!uid_eq(uid, GLOBAL_ROOT_UID))
890                                 add_uevent_var(env, "DEVUID=%u", from_kuid(&init_user_ns, uid));
891                         if (!gid_eq(gid, GLOBAL_ROOT_GID))
892                                 add_uevent_var(env, "DEVGID=%u", from_kgid(&init_user_ns, gid));
893                         kfree(tmp);
894                 }
895         }
896
897         if (dev->type && dev->type->name)
898                 add_uevent_var(env, "DEVTYPE=%s", dev->type->name);
899
900         if (dev->driver)
901                 add_uevent_var(env, "DRIVER=%s", dev->driver->name);
902
903         /* Add common DT information about the device */
904         of_device_uevent(dev, env);
905
906         /* have the bus specific function add its stuff */
907         if (dev->bus && dev->bus->uevent) {
908                 retval = dev->bus->uevent(dev, env);
909                 if (retval)
910                         pr_debug("device: '%s': %s: bus uevent() returned %d\n",
911                                  dev_name(dev), __func__, retval);
912         }
913
914         /* have the class specific function add its stuff */
915         if (dev->class && dev->class->dev_uevent) {
916                 retval = dev->class->dev_uevent(dev, env);
917                 if (retval)
918                         pr_debug("device: '%s': %s: class uevent() "
919                                  "returned %d\n", dev_name(dev),
920                                  __func__, retval);
921         }
922
923         /* have the device type specific function add its stuff */
924         if (dev->type && dev->type->uevent) {
925                 retval = dev->type->uevent(dev, env);
926                 if (retval)
927                         pr_debug("device: '%s': %s: dev_type uevent() "
928                                  "returned %d\n", dev_name(dev),
929                                  __func__, retval);
930         }
931
932         return retval;
933 }
934
935 static const struct kset_uevent_ops device_uevent_ops = {
936         .filter =       dev_uevent_filter,
937         .name =         dev_uevent_name,
938         .uevent =       dev_uevent,
939 };
940
941 static ssize_t uevent_show(struct device *dev, struct device_attribute *attr,
942                            char *buf)
943 {
944         struct kobject *top_kobj;
945         struct kset *kset;
946         struct kobj_uevent_env *env = NULL;
947         int i;
948         size_t count = 0;
949         int retval;
950
951         /* search the kset, the device belongs to */
952         top_kobj = &dev->kobj;
953         while (!top_kobj->kset && top_kobj->parent)
954                 top_kobj = top_kobj->parent;
955         if (!top_kobj->kset)
956                 goto out;
957
958         kset = top_kobj->kset;
959         if (!kset->uevent_ops || !kset->uevent_ops->uevent)
960                 goto out;
961
962         /* respect filter */
963         if (kset->uevent_ops && kset->uevent_ops->filter)
964                 if (!kset->uevent_ops->filter(kset, &dev->kobj))
965                         goto out;
966
967         env = kzalloc(sizeof(struct kobj_uevent_env), GFP_KERNEL);
968         if (!env)
969                 return -ENOMEM;
970
971         /* let the kset specific function add its keys */
972         retval = kset->uevent_ops->uevent(kset, &dev->kobj, env);
973         if (retval)
974                 goto out;
975
976         /* copy keys to file */
977         for (i = 0; i < env->envp_idx; i++)
978                 count += sprintf(&buf[count], "%s\n", env->envp[i]);
979 out:
980         kfree(env);
981         return count;
982 }
983
984 static ssize_t uevent_store(struct device *dev, struct device_attribute *attr,
985                             const char *buf, size_t count)
986 {
987         if (kobject_synth_uevent(&dev->kobj, buf, count))
988                 dev_err(dev, "uevent: failed to send synthetic uevent\n");
989
990         return count;
991 }
992 static DEVICE_ATTR_RW(uevent);
993
994 static ssize_t online_show(struct device *dev, struct device_attribute *attr,
995                            char *buf)
996 {
997         bool val;
998
999         device_lock(dev);
1000         val = !dev->offline;
1001         device_unlock(dev);
1002         return sprintf(buf, "%u\n", val);
1003 }
1004
1005 static ssize_t online_store(struct device *dev, struct device_attribute *attr,
1006                             const char *buf, size_t count)
1007 {
1008         bool val;
1009         int ret;
1010
1011         ret = strtobool(buf, &val);
1012         if (ret < 0)
1013                 return ret;
1014
1015         ret = lock_device_hotplug_sysfs();
1016         if (ret)
1017                 return ret;
1018
1019         ret = val ? device_online(dev) : device_offline(dev);
1020         unlock_device_hotplug();
1021         return ret < 0 ? ret : count;
1022 }
1023 static DEVICE_ATTR_RW(online);
1024
1025 int device_add_groups(struct device *dev, const struct attribute_group **groups)
1026 {
1027         return sysfs_create_groups(&dev->kobj, groups);
1028 }
1029 EXPORT_SYMBOL_GPL(device_add_groups);
1030
1031 void device_remove_groups(struct device *dev,
1032                           const struct attribute_group **groups)
1033 {
1034         sysfs_remove_groups(&dev->kobj, groups);
1035 }
1036 EXPORT_SYMBOL_GPL(device_remove_groups);
1037
1038 union device_attr_group_devres {
1039         const struct attribute_group *group;
1040         const struct attribute_group **groups;
1041 };
1042
1043 static int devm_attr_group_match(struct device *dev, void *res, void *data)
1044 {
1045         return ((union device_attr_group_devres *)res)->group == data;
1046 }
1047
1048 static void devm_attr_group_remove(struct device *dev, void *res)
1049 {
1050         union device_attr_group_devres *devres = res;
1051         const struct attribute_group *group = devres->group;
1052
1053         dev_dbg(dev, "%s: removing group %p\n", __func__, group);
1054         sysfs_remove_group(&dev->kobj, group);
1055 }
1056
1057 static void devm_attr_groups_remove(struct device *dev, void *res)
1058 {
1059         union device_attr_group_devres *devres = res;
1060         const struct attribute_group **groups = devres->groups;
1061
1062         dev_dbg(dev, "%s: removing groups %p\n", __func__, groups);
1063         sysfs_remove_groups(&dev->kobj, groups);
1064 }
1065
1066 /**
1067  * devm_device_add_group - given a device, create a managed attribute group
1068  * @dev:        The device to create the group for
1069  * @grp:        The attribute group to create
1070  *
1071  * This function creates a group for the first time.  It will explicitly
1072  * warn and error if any of the attribute files being created already exist.
1073  *
1074  * Returns 0 on success or error code on failure.
1075  */
1076 int devm_device_add_group(struct device *dev, const struct attribute_group *grp)
1077 {
1078         union device_attr_group_devres *devres;
1079         int error;
1080
1081         devres = devres_alloc(devm_attr_group_remove,
1082                               sizeof(*devres), GFP_KERNEL);
1083         if (!devres)
1084                 return -ENOMEM;
1085
1086         error = sysfs_create_group(&dev->kobj, grp);
1087         if (error) {
1088                 devres_free(devres);
1089                 return error;
1090         }
1091
1092         devres->group = grp;
1093         devres_add(dev, devres);
1094         return 0;
1095 }
1096 EXPORT_SYMBOL_GPL(devm_device_add_group);
1097
1098 /**
1099  * devm_device_remove_group: remove a managed group from a device
1100  * @dev:        device to remove the group from
1101  * @grp:        group to remove
1102  *
1103  * This function removes a group of attributes from a device. The attributes
1104  * previously have to have been created for this group, otherwise it will fail.
1105  */
1106 void devm_device_remove_group(struct device *dev,
1107                               const struct attribute_group *grp)
1108 {
1109         WARN_ON(devres_release(dev, devm_attr_group_remove,
1110                                devm_attr_group_match,
1111                                /* cast away const */ (void *)grp));
1112 }
1113 EXPORT_SYMBOL_GPL(devm_device_remove_group);
1114
1115 /**
1116  * devm_device_add_groups - create a bunch of managed attribute groups
1117  * @dev:        The device to create the group for
1118  * @groups:     The attribute groups to create, NULL terminated
1119  *
1120  * This function creates a bunch of managed attribute groups.  If an error
1121  * occurs when creating a group, all previously created groups will be
1122  * removed, unwinding everything back to the original state when this
1123  * function was called.  It will explicitly warn and error if any of the
1124  * attribute files being created already exist.
1125  *
1126  * Returns 0 on success or error code from sysfs_create_group on failure.
1127  */
1128 int devm_device_add_groups(struct device *dev,
1129                            const struct attribute_group **groups)
1130 {
1131         union device_attr_group_devres *devres;
1132         int error;
1133
1134         devres = devres_alloc(devm_attr_groups_remove,
1135                               sizeof(*devres), GFP_KERNEL);
1136         if (!devres)
1137                 return -ENOMEM;
1138
1139         error = sysfs_create_groups(&dev->kobj, groups);
1140         if (error) {
1141                 devres_free(devres);
1142                 return error;
1143         }
1144
1145         devres->groups = groups;
1146         devres_add(dev, devres);
1147         return 0;
1148 }
1149 EXPORT_SYMBOL_GPL(devm_device_add_groups);
1150
1151 /**
1152  * devm_device_remove_groups - remove a list of managed groups
1153  *
1154  * @dev:        The device for the groups to be removed from
1155  * @groups:     NULL terminated list of groups to be removed
1156  *
1157  * If groups is not NULL, remove the specified groups from the device.
1158  */
1159 void devm_device_remove_groups(struct device *dev,
1160                                const struct attribute_group **groups)
1161 {
1162         WARN_ON(devres_release(dev, devm_attr_groups_remove,
1163                                devm_attr_group_match,
1164                                /* cast away const */ (void *)groups));
1165 }
1166 EXPORT_SYMBOL_GPL(devm_device_remove_groups);
1167
1168 static int device_add_attrs(struct device *dev)
1169 {
1170         struct class *class = dev->class;
1171         const struct device_type *type = dev->type;
1172         int error;
1173
1174         if (class) {
1175                 error = device_add_groups(dev, class->dev_groups);
1176                 if (error)
1177                         return error;
1178         }
1179
1180         if (type) {
1181                 error = device_add_groups(dev, type->groups);
1182                 if (error)
1183                         goto err_remove_class_groups;
1184         }
1185
1186         error = device_add_groups(dev, dev->groups);
1187         if (error)
1188                 goto err_remove_type_groups;
1189
1190         if (device_supports_offline(dev) && !dev->offline_disabled) {
1191                 error = device_create_file(dev, &dev_attr_online);
1192                 if (error)
1193                         goto err_remove_dev_groups;
1194         }
1195
1196         return 0;
1197
1198  err_remove_dev_groups:
1199         device_remove_groups(dev, dev->groups);
1200  err_remove_type_groups:
1201         if (type)
1202                 device_remove_groups(dev, type->groups);
1203  err_remove_class_groups:
1204         if (class)
1205                 device_remove_groups(dev, class->dev_groups);
1206
1207         return error;
1208 }
1209
1210 static void device_remove_attrs(struct device *dev)
1211 {
1212         struct class *class = dev->class;
1213         const struct device_type *type = dev->type;
1214
1215         device_remove_file(dev, &dev_attr_online);
1216         device_remove_groups(dev, dev->groups);
1217
1218         if (type)
1219                 device_remove_groups(dev, type->groups);
1220
1221         if (class)
1222                 device_remove_groups(dev, class->dev_groups);
1223 }
1224
1225 static ssize_t dev_show(struct device *dev, struct device_attribute *attr,
1226                         char *buf)
1227 {
1228         return print_dev_t(buf, dev->devt);
1229 }
1230 static DEVICE_ATTR_RO(dev);
1231
1232 /* /sys/devices/ */
1233 struct kset *devices_kset;
1234
1235 /**
1236  * devices_kset_move_before - Move device in the devices_kset's list.
1237  * @deva: Device to move.
1238  * @devb: Device @deva should come before.
1239  */
1240 static void devices_kset_move_before(struct device *deva, struct device *devb)
1241 {
1242         if (!devices_kset)
1243                 return;
1244         pr_debug("devices_kset: Moving %s before %s\n",
1245                  dev_name(deva), dev_name(devb));
1246         spin_lock(&devices_kset->list_lock);
1247         list_move_tail(&deva->kobj.entry, &devb->kobj.entry);
1248         spin_unlock(&devices_kset->list_lock);
1249 }
1250
1251 /**
1252  * devices_kset_move_after - Move device in the devices_kset's list.
1253  * @deva: Device to move
1254  * @devb: Device @deva should come after.
1255  */
1256 static void devices_kset_move_after(struct device *deva, struct device *devb)
1257 {
1258         if (!devices_kset)
1259                 return;
1260         pr_debug("devices_kset: Moving %s after %s\n",
1261                  dev_name(deva), dev_name(devb));
1262         spin_lock(&devices_kset->list_lock);
1263         list_move(&deva->kobj.entry, &devb->kobj.entry);
1264         spin_unlock(&devices_kset->list_lock);
1265 }
1266
1267 /**
1268  * devices_kset_move_last - move the device to the end of devices_kset's list.
1269  * @dev: device to move
1270  */
1271 void devices_kset_move_last(struct device *dev)
1272 {
1273         if (!devices_kset)
1274                 return;
1275         pr_debug("devices_kset: Moving %s to end of list\n", dev_name(dev));
1276         spin_lock(&devices_kset->list_lock);
1277         list_move_tail(&dev->kobj.entry, &devices_kset->list);
1278         spin_unlock(&devices_kset->list_lock);
1279 }
1280
1281 /**
1282  * device_create_file - create sysfs attribute file for device.
1283  * @dev: device.
1284  * @attr: device attribute descriptor.
1285  */
1286 int device_create_file(struct device *dev,
1287                        const struct device_attribute *attr)
1288 {
1289         int error = 0;
1290
1291         if (dev) {
1292                 WARN(((attr->attr.mode & S_IWUGO) && !attr->store),
1293                         "Attribute %s: write permission without 'store'\n",
1294                         attr->attr.name);
1295                 WARN(((attr->attr.mode & S_IRUGO) && !attr->show),
1296                         "Attribute %s: read permission without 'show'\n",
1297                         attr->attr.name);
1298                 error = sysfs_create_file(&dev->kobj, &attr->attr);
1299         }
1300
1301         return error;
1302 }
1303 EXPORT_SYMBOL_GPL(device_create_file);
1304
1305 /**
1306  * device_remove_file - remove sysfs attribute file.
1307  * @dev: device.
1308  * @attr: device attribute descriptor.
1309  */
1310 void device_remove_file(struct device *dev,
1311                         const struct device_attribute *attr)
1312 {
1313         if (dev)
1314                 sysfs_remove_file(&dev->kobj, &attr->attr);
1315 }
1316 EXPORT_SYMBOL_GPL(device_remove_file);
1317
1318 /**
1319  * device_remove_file_self - remove sysfs attribute file from its own method.
1320  * @dev: device.
1321  * @attr: device attribute descriptor.
1322  *
1323  * See kernfs_remove_self() for details.
1324  */
1325 bool device_remove_file_self(struct device *dev,
1326                              const struct device_attribute *attr)
1327 {
1328         if (dev)
1329                 return sysfs_remove_file_self(&dev->kobj, &attr->attr);
1330         else
1331                 return false;
1332 }
1333 EXPORT_SYMBOL_GPL(device_remove_file_self);
1334
1335 /**
1336  * device_create_bin_file - create sysfs binary attribute file for device.
1337  * @dev: device.
1338  * @attr: device binary attribute descriptor.
1339  */
1340 int device_create_bin_file(struct device *dev,
1341                            const struct bin_attribute *attr)
1342 {
1343         int error = -EINVAL;
1344         if (dev)
1345                 error = sysfs_create_bin_file(&dev->kobj, attr);
1346         return error;
1347 }
1348 EXPORT_SYMBOL_GPL(device_create_bin_file);
1349
1350 /**
1351  * device_remove_bin_file - remove sysfs binary attribute file
1352  * @dev: device.
1353  * @attr: device binary attribute descriptor.
1354  */
1355 void device_remove_bin_file(struct device *dev,
1356                             const struct bin_attribute *attr)
1357 {
1358         if (dev)
1359                 sysfs_remove_bin_file(&dev->kobj, attr);
1360 }
1361 EXPORT_SYMBOL_GPL(device_remove_bin_file);
1362
1363 static void klist_children_get(struct klist_node *n)
1364 {
1365         struct device_private *p = to_device_private_parent(n);
1366         struct device *dev = p->device;
1367
1368         get_device(dev);
1369 }
1370
1371 static void klist_children_put(struct klist_node *n)
1372 {
1373         struct device_private *p = to_device_private_parent(n);
1374         struct device *dev = p->device;
1375
1376         put_device(dev);
1377 }
1378
1379 /**
1380  * device_initialize - init device structure.
1381  * @dev: device.
1382  *
1383  * This prepares the device for use by other layers by initializing
1384  * its fields.
1385  * It is the first half of device_register(), if called by
1386  * that function, though it can also be called separately, so one
1387  * may use @dev's fields. In particular, get_device()/put_device()
1388  * may be used for reference counting of @dev after calling this
1389  * function.
1390  *
1391  * All fields in @dev must be initialized by the caller to 0, except
1392  * for those explicitly set to some other value.  The simplest
1393  * approach is to use kzalloc() to allocate the structure containing
1394  * @dev.
1395  *
1396  * NOTE: Use put_device() to give up your reference instead of freeing
1397  * @dev directly once you have called this function.
1398  */
1399 void device_initialize(struct device *dev)
1400 {
1401         dev->kobj.kset = devices_kset;
1402         kobject_init(&dev->kobj, &device_ktype);
1403         INIT_LIST_HEAD(&dev->dma_pools);
1404         mutex_init(&dev->mutex);
1405         lockdep_set_novalidate_class(&dev->mutex);
1406         spin_lock_init(&dev->devres_lock);
1407         INIT_LIST_HEAD(&dev->devres_head);
1408         device_pm_init(dev);
1409         set_dev_node(dev, -1);
1410 #ifdef CONFIG_GENERIC_MSI_IRQ
1411         INIT_LIST_HEAD(&dev->msi_list);
1412 #endif
1413         INIT_LIST_HEAD(&dev->links.consumers);
1414         INIT_LIST_HEAD(&dev->links.suppliers);
1415         dev->links.status = DL_DEV_NO_DRIVER;
1416 }
1417 EXPORT_SYMBOL_GPL(device_initialize);
1418
1419 struct kobject *virtual_device_parent(struct device *dev)
1420 {
1421         static struct kobject *virtual_dir = NULL;
1422
1423         if (!virtual_dir)
1424                 virtual_dir = kobject_create_and_add("virtual",
1425                                                      &devices_kset->kobj);
1426
1427         return virtual_dir;
1428 }
1429
1430 struct class_dir {
1431         struct kobject kobj;
1432         struct class *class;
1433 };
1434
1435 #define to_class_dir(obj) container_of(obj, struct class_dir, kobj)
1436
1437 static void class_dir_release(struct kobject *kobj)
1438 {
1439         struct class_dir *dir = to_class_dir(kobj);
1440         kfree(dir);
1441 }
1442
1443 static const
1444 struct kobj_ns_type_operations *class_dir_child_ns_type(struct kobject *kobj)
1445 {
1446         struct class_dir *dir = to_class_dir(kobj);
1447         return dir->class->ns_type;
1448 }
1449
1450 static struct kobj_type class_dir_ktype = {
1451         .release        = class_dir_release,
1452         .sysfs_ops      = &kobj_sysfs_ops,
1453         .child_ns_type  = class_dir_child_ns_type
1454 };
1455
1456 static struct kobject *
1457 class_dir_create_and_add(struct class *class, struct kobject *parent_kobj)
1458 {
1459         struct class_dir *dir;
1460         int retval;
1461
1462         dir = kzalloc(sizeof(*dir), GFP_KERNEL);
1463         if (!dir)
1464                 return ERR_PTR(-ENOMEM);
1465
1466         dir->class = class;
1467         kobject_init(&dir->kobj, &class_dir_ktype);
1468
1469         dir->kobj.kset = &class->p->glue_dirs;
1470
1471         retval = kobject_add(&dir->kobj, parent_kobj, "%s", class->name);
1472         if (retval < 0) {
1473                 kobject_put(&dir->kobj);
1474                 return ERR_PTR(retval);
1475         }
1476         return &dir->kobj;
1477 }
1478
1479 static DEFINE_MUTEX(gdp_mutex);
1480
1481 static struct kobject *get_device_parent(struct device *dev,
1482                                          struct device *parent)
1483 {
1484         if (dev->class) {
1485                 struct kobject *kobj = NULL;
1486                 struct kobject *parent_kobj;
1487                 struct kobject *k;
1488
1489 #ifdef CONFIG_BLOCK
1490                 /* block disks show up in /sys/block */
1491                 if (sysfs_deprecated && dev->class == &block_class) {
1492                         if (parent && parent->class == &block_class)
1493                                 return &parent->kobj;
1494                         return &block_class.p->subsys.kobj;
1495                 }
1496 #endif
1497
1498                 /*
1499                  * If we have no parent, we live in "virtual".
1500                  * Class-devices with a non class-device as parent, live
1501                  * in a "glue" directory to prevent namespace collisions.
1502                  */
1503                 if (parent == NULL)
1504                         parent_kobj = virtual_device_parent(dev);
1505                 else if (parent->class && !dev->class->ns_type)
1506                         return &parent->kobj;
1507                 else
1508                         parent_kobj = &parent->kobj;
1509
1510                 mutex_lock(&gdp_mutex);
1511
1512                 /* find our class-directory at the parent and reference it */
1513                 spin_lock(&dev->class->p->glue_dirs.list_lock);
1514                 list_for_each_entry(k, &dev->class->p->glue_dirs.list, entry)
1515                         if (k->parent == parent_kobj) {
1516                                 kobj = kobject_get(k);
1517                                 break;
1518                         }
1519                 spin_unlock(&dev->class->p->glue_dirs.list_lock);
1520                 if (kobj) {
1521                         mutex_unlock(&gdp_mutex);
1522                         return kobj;
1523                 }
1524
1525                 /* or create a new class-directory at the parent device */
1526                 k = class_dir_create_and_add(dev->class, parent_kobj);
1527                 /* do not emit an uevent for this simple "glue" directory */
1528                 mutex_unlock(&gdp_mutex);
1529                 return k;
1530         }
1531
1532         /* subsystems can specify a default root directory for their devices */
1533         if (!parent && dev->bus && dev->bus->dev_root)
1534                 return &dev->bus->dev_root->kobj;
1535
1536         if (parent)
1537                 return &parent->kobj;
1538         return NULL;
1539 }
1540
1541 static inline bool live_in_glue_dir(struct kobject *kobj,
1542                                     struct device *dev)
1543 {
1544         if (!kobj || !dev->class ||
1545             kobj->kset != &dev->class->p->glue_dirs)
1546                 return false;
1547         return true;
1548 }
1549
1550 static inline struct kobject *get_glue_dir(struct device *dev)
1551 {
1552         return dev->kobj.parent;
1553 }
1554
1555 /*
1556  * make sure cleaning up dir as the last step, we need to make
1557  * sure .release handler of kobject is run with holding the
1558  * global lock
1559  */
1560 static void cleanup_glue_dir(struct device *dev, struct kobject *glue_dir)
1561 {
1562         /* see if we live in a "glue" directory */
1563         if (!live_in_glue_dir(glue_dir, dev))
1564                 return;
1565
1566         mutex_lock(&gdp_mutex);
1567         kobject_put(glue_dir);
1568         mutex_unlock(&gdp_mutex);
1569 }
1570
1571 static int device_add_class_symlinks(struct device *dev)
1572 {
1573         struct device_node *of_node = dev_of_node(dev);
1574         int error;
1575
1576         if (of_node) {
1577                 error = sysfs_create_link(&dev->kobj, &of_node->kobj,"of_node");
1578                 if (error)
1579                         dev_warn(dev, "Error %d creating of_node link\n",error);
1580                 /* An error here doesn't warrant bringing down the device */
1581         }
1582
1583         if (!dev->class)
1584                 return 0;
1585
1586         error = sysfs_create_link(&dev->kobj,
1587                                   &dev->class->p->subsys.kobj,
1588                                   "subsystem");
1589         if (error)
1590                 goto out_devnode;
1591
1592         if (dev->parent && device_is_not_partition(dev)) {
1593                 error = sysfs_create_link(&dev->kobj, &dev->parent->kobj,
1594                                           "device");
1595                 if (error)
1596                         goto out_subsys;
1597         }
1598
1599 #ifdef CONFIG_BLOCK
1600         /* /sys/block has directories and does not need symlinks */
1601         if (sysfs_deprecated && dev->class == &block_class)
1602                 return 0;
1603 #endif
1604
1605         /* link in the class directory pointing to the device */
1606         error = sysfs_create_link(&dev->class->p->subsys.kobj,
1607                                   &dev->kobj, dev_name(dev));
1608         if (error)
1609                 goto out_device;
1610
1611         return 0;
1612
1613 out_device:
1614         sysfs_remove_link(&dev->kobj, "device");
1615
1616 out_subsys:
1617         sysfs_remove_link(&dev->kobj, "subsystem");
1618 out_devnode:
1619         sysfs_remove_link(&dev->kobj, "of_node");
1620         return error;
1621 }
1622
1623 static void device_remove_class_symlinks(struct device *dev)
1624 {
1625         if (dev_of_node(dev))
1626                 sysfs_remove_link(&dev->kobj, "of_node");
1627
1628         if (!dev->class)
1629                 return;
1630
1631         if (dev->parent && device_is_not_partition(dev))
1632                 sysfs_remove_link(&dev->kobj, "device");
1633         sysfs_remove_link(&dev->kobj, "subsystem");
1634 #ifdef CONFIG_BLOCK
1635         if (sysfs_deprecated && dev->class == &block_class)
1636                 return;
1637 #endif
1638         sysfs_delete_link(&dev->class->p->subsys.kobj, &dev->kobj, dev_name(dev));
1639 }
1640
1641 /**
1642  * dev_set_name - set a device name
1643  * @dev: device
1644  * @fmt: format string for the device's name
1645  */
1646 int dev_set_name(struct device *dev, const char *fmt, ...)
1647 {
1648         va_list vargs;
1649         int err;
1650
1651         va_start(vargs, fmt);
1652         err = kobject_set_name_vargs(&dev->kobj, fmt, vargs);
1653         va_end(vargs);
1654         return err;
1655 }
1656 EXPORT_SYMBOL_GPL(dev_set_name);
1657
1658 /**
1659  * device_to_dev_kobj - select a /sys/dev/ directory for the device
1660  * @dev: device
1661  *
1662  * By default we select char/ for new entries.  Setting class->dev_obj
1663  * to NULL prevents an entry from being created.  class->dev_kobj must
1664  * be set (or cleared) before any devices are registered to the class
1665  * otherwise device_create_sys_dev_entry() and
1666  * device_remove_sys_dev_entry() will disagree about the presence of
1667  * the link.
1668  */
1669 static struct kobject *device_to_dev_kobj(struct device *dev)
1670 {
1671         struct kobject *kobj;
1672
1673         if (dev->class)
1674                 kobj = dev->class->dev_kobj;
1675         else
1676                 kobj = sysfs_dev_char_kobj;
1677
1678         return kobj;
1679 }
1680
1681 static int device_create_sys_dev_entry(struct device *dev)
1682 {
1683         struct kobject *kobj = device_to_dev_kobj(dev);
1684         int error = 0;
1685         char devt_str[15];
1686
1687         if (kobj) {
1688                 format_dev_t(devt_str, dev->devt);
1689                 error = sysfs_create_link(kobj, &dev->kobj, devt_str);
1690         }
1691
1692         return error;
1693 }
1694
1695 static void device_remove_sys_dev_entry(struct device *dev)
1696 {
1697         struct kobject *kobj = device_to_dev_kobj(dev);
1698         char devt_str[15];
1699
1700         if (kobj) {
1701                 format_dev_t(devt_str, dev->devt);
1702                 sysfs_remove_link(kobj, devt_str);
1703         }
1704 }
1705
1706 int device_private_init(struct device *dev)
1707 {
1708         dev->p = kzalloc(sizeof(*dev->p), GFP_KERNEL);
1709         if (!dev->p)
1710                 return -ENOMEM;
1711         dev->p->device = dev;
1712         klist_init(&dev->p->klist_children, klist_children_get,
1713                    klist_children_put);
1714         INIT_LIST_HEAD(&dev->p->deferred_probe);
1715         return 0;
1716 }
1717
1718 /**
1719  * device_add - add device to device hierarchy.
1720  * @dev: device.
1721  *
1722  * This is part 2 of device_register(), though may be called
1723  * separately _iff_ device_initialize() has been called separately.
1724  *
1725  * This adds @dev to the kobject hierarchy via kobject_add(), adds it
1726  * to the global and sibling lists for the device, then
1727  * adds it to the other relevant subsystems of the driver model.
1728  *
1729  * Do not call this routine or device_register() more than once for
1730  * any device structure.  The driver model core is not designed to work
1731  * with devices that get unregistered and then spring back to life.
1732  * (Among other things, it's very hard to guarantee that all references
1733  * to the previous incarnation of @dev have been dropped.)  Allocate
1734  * and register a fresh new struct device instead.
1735  *
1736  * NOTE: _Never_ directly free @dev after calling this function, even
1737  * if it returned an error! Always use put_device() to give up your
1738  * reference instead.
1739  */
1740 int device_add(struct device *dev)
1741 {
1742         struct device *parent;
1743         struct kobject *kobj;
1744         struct class_interface *class_intf;
1745         int error = -EINVAL;
1746         struct kobject *glue_dir = NULL;
1747
1748         dev = get_device(dev);
1749         if (!dev)
1750                 goto done;
1751
1752         if (!dev->p) {
1753                 error = device_private_init(dev);
1754                 if (error)
1755                         goto done;
1756         }
1757
1758         /*
1759          * for statically allocated devices, which should all be converted
1760          * some day, we need to initialize the name. We prevent reading back
1761          * the name, and force the use of dev_name()
1762          */
1763         if (dev->init_name) {
1764                 dev_set_name(dev, "%s", dev->init_name);
1765                 dev->init_name = NULL;
1766         }
1767
1768         /* subsystems can specify simple device enumeration */
1769         if (!dev_name(dev) && dev->bus && dev->bus->dev_name)
1770                 dev_set_name(dev, "%s%u", dev->bus->dev_name, dev->id);
1771
1772         if (!dev_name(dev)) {
1773                 error = -EINVAL;
1774                 goto name_error;
1775         }
1776
1777         pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1778
1779         parent = get_device(dev->parent);
1780         kobj = get_device_parent(dev, parent);
1781         if (IS_ERR(kobj)) {
1782                 error = PTR_ERR(kobj);
1783                 goto parent_error;
1784         }
1785         if (kobj)
1786                 dev->kobj.parent = kobj;
1787
1788         /* use parent numa_node */
1789         if (parent && (dev_to_node(dev) == NUMA_NO_NODE))
1790                 set_dev_node(dev, dev_to_node(parent));
1791
1792         /* first, register with generic layer. */
1793         /* we require the name to be set before, and pass NULL */
1794         error = kobject_add(&dev->kobj, dev->kobj.parent, NULL);
1795         if (error) {
1796                 glue_dir = get_glue_dir(dev);
1797                 goto Error;
1798         }
1799
1800         /* notify platform of device entry */
1801         if (platform_notify)
1802                 platform_notify(dev);
1803
1804         error = device_create_file(dev, &dev_attr_uevent);
1805         if (error)
1806                 goto attrError;
1807
1808         error = device_add_class_symlinks(dev);
1809         if (error)
1810                 goto SymlinkError;
1811         error = device_add_attrs(dev);
1812         if (error)
1813                 goto AttrsError;
1814         error = bus_add_device(dev);
1815         if (error)
1816                 goto BusError;
1817         error = dpm_sysfs_add(dev);
1818         if (error)
1819                 goto DPMError;
1820         device_pm_add(dev);
1821
1822         if (MAJOR(dev->devt)) {
1823                 error = device_create_file(dev, &dev_attr_dev);
1824                 if (error)
1825                         goto DevAttrError;
1826
1827                 error = device_create_sys_dev_entry(dev);
1828                 if (error)
1829                         goto SysEntryError;
1830
1831                 devtmpfs_create_node(dev);
1832         }
1833
1834         /* Notify clients of device addition.  This call must come
1835          * after dpm_sysfs_add() and before kobject_uevent().
1836          */
1837         if (dev->bus)
1838                 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1839                                              BUS_NOTIFY_ADD_DEVICE, dev);
1840
1841         kobject_uevent(&dev->kobj, KOBJ_ADD);
1842         bus_probe_device(dev);
1843         if (parent)
1844                 klist_add_tail(&dev->p->knode_parent,
1845                                &parent->p->klist_children);
1846
1847         if (dev->class) {
1848                 mutex_lock(&dev->class->p->mutex);
1849                 /* tie the class to the device */
1850                 klist_add_tail(&dev->knode_class,
1851                                &dev->class->p->klist_devices);
1852
1853                 /* notify any interfaces that the device is here */
1854                 list_for_each_entry(class_intf,
1855                                     &dev->class->p->interfaces, node)
1856                         if (class_intf->add_dev)
1857                                 class_intf->add_dev(dev, class_intf);
1858                 mutex_unlock(&dev->class->p->mutex);
1859         }
1860 done:
1861         put_device(dev);
1862         return error;
1863  SysEntryError:
1864         if (MAJOR(dev->devt))
1865                 device_remove_file(dev, &dev_attr_dev);
1866  DevAttrError:
1867         device_pm_remove(dev);
1868         dpm_sysfs_remove(dev);
1869  DPMError:
1870         bus_remove_device(dev);
1871  BusError:
1872         device_remove_attrs(dev);
1873  AttrsError:
1874         device_remove_class_symlinks(dev);
1875  SymlinkError:
1876         device_remove_file(dev, &dev_attr_uevent);
1877  attrError:
1878         kobject_uevent(&dev->kobj, KOBJ_REMOVE);
1879         glue_dir = get_glue_dir(dev);
1880         kobject_del(&dev->kobj);
1881  Error:
1882         cleanup_glue_dir(dev, glue_dir);
1883 parent_error:
1884         put_device(parent);
1885 name_error:
1886         kfree(dev->p);
1887         dev->p = NULL;
1888         goto done;
1889 }
1890 EXPORT_SYMBOL_GPL(device_add);
1891
1892 /**
1893  * device_register - register a device with the system.
1894  * @dev: pointer to the device structure
1895  *
1896  * This happens in two clean steps - initialize the device
1897  * and add it to the system. The two steps can be called
1898  * separately, but this is the easiest and most common.
1899  * I.e. you should only call the two helpers separately if
1900  * have a clearly defined need to use and refcount the device
1901  * before it is added to the hierarchy.
1902  *
1903  * For more information, see the kerneldoc for device_initialize()
1904  * and device_add().
1905  *
1906  * NOTE: _Never_ directly free @dev after calling this function, even
1907  * if it returned an error! Always use put_device() to give up the
1908  * reference initialized in this function instead.
1909  */
1910 int device_register(struct device *dev)
1911 {
1912         device_initialize(dev);
1913         return device_add(dev);
1914 }
1915 EXPORT_SYMBOL_GPL(device_register);
1916
1917 /**
1918  * get_device - increment reference count for device.
1919  * @dev: device.
1920  *
1921  * This simply forwards the call to kobject_get(), though
1922  * we do take care to provide for the case that we get a NULL
1923  * pointer passed in.
1924  */
1925 struct device *get_device(struct device *dev)
1926 {
1927         return dev ? kobj_to_dev(kobject_get(&dev->kobj)) : NULL;
1928 }
1929 EXPORT_SYMBOL_GPL(get_device);
1930
1931 /**
1932  * put_device - decrement reference count.
1933  * @dev: device in question.
1934  */
1935 void put_device(struct device *dev)
1936 {
1937         /* might_sleep(); */
1938         if (dev)
1939                 kobject_put(&dev->kobj);
1940 }
1941 EXPORT_SYMBOL_GPL(put_device);
1942
1943 /**
1944  * device_del - delete device from system.
1945  * @dev: device.
1946  *
1947  * This is the first part of the device unregistration
1948  * sequence. This removes the device from the lists we control
1949  * from here, has it removed from the other driver model
1950  * subsystems it was added to in device_add(), and removes it
1951  * from the kobject hierarchy.
1952  *
1953  * NOTE: this should be called manually _iff_ device_add() was
1954  * also called manually.
1955  */
1956 void device_del(struct device *dev)
1957 {
1958         struct device *parent = dev->parent;
1959         struct kobject *glue_dir = NULL;
1960         struct class_interface *class_intf;
1961
1962         /* Notify clients of device removal.  This call must come
1963          * before dpm_sysfs_remove().
1964          */
1965         if (dev->bus)
1966                 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
1967                                              BUS_NOTIFY_DEL_DEVICE, dev);
1968
1969         device_links_purge(dev);
1970         dpm_sysfs_remove(dev);
1971         if (parent)
1972                 klist_del(&dev->p->knode_parent);
1973         if (MAJOR(dev->devt)) {
1974                 devtmpfs_delete_node(dev);
1975                 device_remove_sys_dev_entry(dev);
1976                 device_remove_file(dev, &dev_attr_dev);
1977         }
1978         if (dev->class) {
1979                 device_remove_class_symlinks(dev);
1980
1981                 mutex_lock(&dev->class->p->mutex);
1982                 /* notify any interfaces that the device is now gone */
1983                 list_for_each_entry(class_intf,
1984                                     &dev->class->p->interfaces, node)
1985                         if (class_intf->remove_dev)
1986                                 class_intf->remove_dev(dev, class_intf);
1987                 /* remove the device from the class list */
1988                 klist_del(&dev->knode_class);
1989                 mutex_unlock(&dev->class->p->mutex);
1990         }
1991         device_remove_file(dev, &dev_attr_uevent);
1992         device_remove_attrs(dev);
1993         bus_remove_device(dev);
1994         device_pm_remove(dev);
1995         driver_deferred_probe_del(dev);
1996         device_remove_properties(dev);
1997
1998         /* Notify the platform of the removal, in case they
1999          * need to do anything...
2000          */
2001         if (platform_notify_remove)
2002                 platform_notify_remove(dev);
2003         if (dev->bus)
2004                 blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
2005                                              BUS_NOTIFY_REMOVED_DEVICE, dev);
2006         kobject_uevent(&dev->kobj, KOBJ_REMOVE);
2007         glue_dir = get_glue_dir(dev);
2008         kobject_del(&dev->kobj);
2009         cleanup_glue_dir(dev, glue_dir);
2010         put_device(parent);
2011 }
2012 EXPORT_SYMBOL_GPL(device_del);
2013
2014 /**
2015  * device_unregister - unregister device from system.
2016  * @dev: device going away.
2017  *
2018  * We do this in two parts, like we do device_register(). First,
2019  * we remove it from all the subsystems with device_del(), then
2020  * we decrement the reference count via put_device(). If that
2021  * is the final reference count, the device will be cleaned up
2022  * via device_release() above. Otherwise, the structure will
2023  * stick around until the final reference to the device is dropped.
2024  */
2025 void device_unregister(struct device *dev)
2026 {
2027         pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
2028         device_del(dev);
2029         put_device(dev);
2030 }
2031 EXPORT_SYMBOL_GPL(device_unregister);
2032
2033 static struct device *prev_device(struct klist_iter *i)
2034 {
2035         struct klist_node *n = klist_prev(i);
2036         struct device *dev = NULL;
2037         struct device_private *p;
2038
2039         if (n) {
2040                 p = to_device_private_parent(n);
2041                 dev = p->device;
2042         }
2043         return dev;
2044 }
2045
2046 static struct device *next_device(struct klist_iter *i)
2047 {
2048         struct klist_node *n = klist_next(i);
2049         struct device *dev = NULL;
2050         struct device_private *p;
2051
2052         if (n) {
2053                 p = to_device_private_parent(n);
2054                 dev = p->device;
2055         }
2056         return dev;
2057 }
2058
2059 /**
2060  * device_get_devnode - path of device node file
2061  * @dev: device
2062  * @mode: returned file access mode
2063  * @uid: returned file owner
2064  * @gid: returned file group
2065  * @tmp: possibly allocated string
2066  *
2067  * Return the relative path of a possible device node.
2068  * Non-default names may need to allocate a memory to compose
2069  * a name. This memory is returned in tmp and needs to be
2070  * freed by the caller.
2071  */
2072 const char *device_get_devnode(struct device *dev,
2073                                umode_t *mode, kuid_t *uid, kgid_t *gid,
2074                                const char **tmp)
2075 {
2076         char *s;
2077
2078         *tmp = NULL;
2079
2080         /* the device type may provide a specific name */
2081         if (dev->type && dev->type->devnode)
2082                 *tmp = dev->type->devnode(dev, mode, uid, gid);
2083         if (*tmp)
2084                 return *tmp;
2085
2086         /* the class may provide a specific name */
2087         if (dev->class && dev->class->devnode)
2088                 *tmp = dev->class->devnode(dev, mode);
2089         if (*tmp)
2090                 return *tmp;
2091
2092         /* return name without allocation, tmp == NULL */
2093         if (strchr(dev_name(dev), '!') == NULL)
2094                 return dev_name(dev);
2095
2096         /* replace '!' in the name with '/' */
2097         s = kstrdup(dev_name(dev), GFP_KERNEL);
2098         if (!s)
2099                 return NULL;
2100         strreplace(s, '!', '/');
2101         return *tmp = s;
2102 }
2103
2104 /**
2105  * device_for_each_child - device child iterator.
2106  * @parent: parent struct device.
2107  * @fn: function to be called for each device.
2108  * @data: data for the callback.
2109  *
2110  * Iterate over @parent's child devices, and call @fn for each,
2111  * passing it @data.
2112  *
2113  * We check the return of @fn each time. If it returns anything
2114  * other than 0, we break out and return that value.
2115  */
2116 int device_for_each_child(struct device *parent, void *data,
2117                           int (*fn)(struct device *dev, void *data))
2118 {
2119         struct klist_iter i;
2120         struct device *child;
2121         int error = 0;
2122
2123         if (!parent->p)
2124                 return 0;
2125
2126         klist_iter_init(&parent->p->klist_children, &i);
2127         while ((child = next_device(&i)) && !error)
2128                 error = fn(child, data);
2129         klist_iter_exit(&i);
2130         return error;
2131 }
2132 EXPORT_SYMBOL_GPL(device_for_each_child);
2133
2134 /**
2135  * device_for_each_child_reverse - device child iterator in reversed order.
2136  * @parent: parent struct device.
2137  * @fn: function to be called for each device.
2138  * @data: data for the callback.
2139  *
2140  * Iterate over @parent's child devices, and call @fn for each,
2141  * passing it @data.
2142  *
2143  * We check the return of @fn each time. If it returns anything
2144  * other than 0, we break out and return that value.
2145  */
2146 int device_for_each_child_reverse(struct device *parent, void *data,
2147                                   int (*fn)(struct device *dev, void *data))
2148 {
2149         struct klist_iter i;
2150         struct device *child;
2151         int error = 0;
2152
2153         if (!parent->p)
2154                 return 0;
2155
2156         klist_iter_init(&parent->p->klist_children, &i);
2157         while ((child = prev_device(&i)) && !error)
2158                 error = fn(child, data);
2159         klist_iter_exit(&i);
2160         return error;
2161 }
2162 EXPORT_SYMBOL_GPL(device_for_each_child_reverse);
2163
2164 /**
2165  * device_find_child - device iterator for locating a particular device.
2166  * @parent: parent struct device
2167  * @match: Callback function to check device
2168  * @data: Data to pass to match function
2169  *
2170  * This is similar to the device_for_each_child() function above, but it
2171  * returns a reference to a device that is 'found' for later use, as
2172  * determined by the @match callback.
2173  *
2174  * The callback should return 0 if the device doesn't match and non-zero
2175  * if it does.  If the callback returns non-zero and a reference to the
2176  * current device can be obtained, this function will return to the caller
2177  * and not iterate over any more devices.
2178  *
2179  * NOTE: you will need to drop the reference with put_device() after use.
2180  */
2181 struct device *device_find_child(struct device *parent, void *data,
2182                                  int (*match)(struct device *dev, void *data))
2183 {
2184         struct klist_iter i;
2185         struct device *child;
2186
2187         if (!parent)
2188                 return NULL;
2189
2190         klist_iter_init(&parent->p->klist_children, &i);
2191         while ((child = next_device(&i)))
2192                 if (match(child, data) && get_device(child))
2193                         break;
2194         klist_iter_exit(&i);
2195         return child;
2196 }
2197 EXPORT_SYMBOL_GPL(device_find_child);
2198
2199 int __init devices_init(void)
2200 {
2201         devices_kset = kset_create_and_add("devices", &device_uevent_ops, NULL);
2202         if (!devices_kset)
2203                 return -ENOMEM;
2204         dev_kobj = kobject_create_and_add("dev", NULL);
2205         if (!dev_kobj)
2206                 goto dev_kobj_err;
2207         sysfs_dev_block_kobj = kobject_create_and_add("block", dev_kobj);
2208         if (!sysfs_dev_block_kobj)
2209                 goto block_kobj_err;
2210         sysfs_dev_char_kobj = kobject_create_and_add("char", dev_kobj);
2211         if (!sysfs_dev_char_kobj)
2212                 goto char_kobj_err;
2213
2214         return 0;
2215
2216  char_kobj_err:
2217         kobject_put(sysfs_dev_block_kobj);
2218  block_kobj_err:
2219         kobject_put(dev_kobj);
2220  dev_kobj_err:
2221         kset_unregister(devices_kset);
2222         return -ENOMEM;
2223 }
2224
2225 static int device_check_offline(struct device *dev, void *not_used)
2226 {
2227         int ret;
2228
2229         ret = device_for_each_child(dev, NULL, device_check_offline);
2230         if (ret)
2231                 return ret;
2232
2233         return device_supports_offline(dev) && !dev->offline ? -EBUSY : 0;
2234 }
2235
2236 /**
2237  * device_offline - Prepare the device for hot-removal.
2238  * @dev: Device to be put offline.
2239  *
2240  * Execute the device bus type's .offline() callback, if present, to prepare
2241  * the device for a subsequent hot-removal.  If that succeeds, the device must
2242  * not be used until either it is removed or its bus type's .online() callback
2243  * is executed.
2244  *
2245  * Call under device_hotplug_lock.
2246  */
2247 int device_offline(struct device *dev)
2248 {
2249         int ret;
2250
2251         if (dev->offline_disabled)
2252                 return -EPERM;
2253
2254         ret = device_for_each_child(dev, NULL, device_check_offline);
2255         if (ret)
2256                 return ret;
2257
2258         device_lock(dev);
2259         if (device_supports_offline(dev)) {
2260                 if (dev->offline) {
2261                         ret = 1;
2262                 } else {
2263                         ret = dev->bus->offline(dev);
2264                         if (!ret) {
2265                                 kobject_uevent(&dev->kobj, KOBJ_OFFLINE);
2266                                 dev->offline = true;
2267                         }
2268                 }
2269         }
2270         device_unlock(dev);
2271
2272         return ret;
2273 }
2274
2275 /**
2276  * device_online - Put the device back online after successful device_offline().
2277  * @dev: Device to be put back online.
2278  *
2279  * If device_offline() has been successfully executed for @dev, but the device
2280  * has not been removed subsequently, execute its bus type's .online() callback
2281  * to indicate that the device can be used again.
2282  *
2283  * Call under device_hotplug_lock.
2284  */
2285 int device_online(struct device *dev)
2286 {
2287         int ret = 0;
2288
2289         device_lock(dev);
2290         if (device_supports_offline(dev)) {
2291                 if (dev->offline) {
2292                         ret = dev->bus->online(dev);
2293                         if (!ret) {
2294                                 kobject_uevent(&dev->kobj, KOBJ_ONLINE);
2295                                 dev->offline = false;
2296                         }
2297                 } else {
2298                         ret = 1;
2299                 }
2300         }
2301         device_unlock(dev);
2302
2303         return ret;
2304 }
2305
2306 struct root_device {
2307         struct device dev;
2308         struct module *owner;
2309 };
2310
2311 static inline struct root_device *to_root_device(struct device *d)
2312 {
2313         return container_of(d, struct root_device, dev);
2314 }
2315
2316 static void root_device_release(struct device *dev)
2317 {
2318         kfree(to_root_device(dev));
2319 }
2320
2321 /**
2322  * __root_device_register - allocate and register a root device
2323  * @name: root device name
2324  * @owner: owner module of the root device, usually THIS_MODULE
2325  *
2326  * This function allocates a root device and registers it
2327  * using device_register(). In order to free the returned
2328  * device, use root_device_unregister().
2329  *
2330  * Root devices are dummy devices which allow other devices
2331  * to be grouped under /sys/devices. Use this function to
2332  * allocate a root device and then use it as the parent of
2333  * any device which should appear under /sys/devices/{name}
2334  *
2335  * The /sys/devices/{name} directory will also contain a
2336  * 'module' symlink which points to the @owner directory
2337  * in sysfs.
2338  *
2339  * Returns &struct device pointer on success, or ERR_PTR() on error.
2340  *
2341  * Note: You probably want to use root_device_register().
2342  */
2343 struct device *__root_device_register(const char *name, struct module *owner)
2344 {
2345         struct root_device *root;
2346         int err = -ENOMEM;
2347
2348         root = kzalloc(sizeof(struct root_device), GFP_KERNEL);
2349         if (!root)
2350                 return ERR_PTR(err);
2351
2352         err = dev_set_name(&root->dev, "%s", name);
2353         if (err) {
2354                 kfree(root);
2355                 return ERR_PTR(err);
2356         }
2357
2358         root->dev.release = root_device_release;
2359
2360         err = device_register(&root->dev);
2361         if (err) {
2362                 put_device(&root->dev);
2363                 return ERR_PTR(err);
2364         }
2365
2366 #ifdef CONFIG_MODULES   /* gotta find a "cleaner" way to do this */
2367         if (owner) {
2368                 struct module_kobject *mk = &owner->mkobj;
2369
2370                 err = sysfs_create_link(&root->dev.kobj, &mk->kobj, "module");
2371                 if (err) {
2372                         device_unregister(&root->dev);
2373                         return ERR_PTR(err);
2374                 }
2375                 root->owner = owner;
2376         }
2377 #endif
2378
2379         return &root->dev;
2380 }
2381 EXPORT_SYMBOL_GPL(__root_device_register);
2382
2383 /**
2384  * root_device_unregister - unregister and free a root device
2385  * @dev: device going away
2386  *
2387  * This function unregisters and cleans up a device that was created by
2388  * root_device_register().
2389  */
2390 void root_device_unregister(struct device *dev)
2391 {
2392         struct root_device *root = to_root_device(dev);
2393
2394         if (root->owner)
2395                 sysfs_remove_link(&root->dev.kobj, "module");
2396
2397         device_unregister(dev);
2398 }
2399 EXPORT_SYMBOL_GPL(root_device_unregister);
2400
2401
2402 static void device_create_release(struct device *dev)
2403 {
2404         pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
2405         kfree(dev);
2406 }
2407
2408 static struct device *
2409 device_create_groups_vargs(struct class *class, struct device *parent,
2410                            dev_t devt, void *drvdata,
2411                            const struct attribute_group **groups,
2412                            const char *fmt, va_list args)
2413 {
2414         struct device *dev = NULL;
2415         int retval = -ENODEV;
2416
2417         if (class == NULL || IS_ERR(class))
2418                 goto error;
2419
2420         dev = kzalloc(sizeof(*dev), GFP_KERNEL);
2421         if (!dev) {
2422                 retval = -ENOMEM;
2423                 goto error;
2424         }
2425
2426         device_initialize(dev);
2427         dev->devt = devt;
2428         dev->class = class;
2429         dev->parent = parent;
2430         dev->groups = groups;
2431         dev->release = device_create_release;
2432         dev_set_drvdata(dev, drvdata);
2433
2434         retval = kobject_set_name_vargs(&dev->kobj, fmt, args);
2435         if (retval)
2436                 goto error;
2437
2438         retval = device_add(dev);
2439         if (retval)
2440                 goto error;
2441
2442         return dev;
2443
2444 error:
2445         put_device(dev);
2446         return ERR_PTR(retval);
2447 }
2448
2449 /**
2450  * device_create_vargs - creates a device and registers it with sysfs
2451  * @class: pointer to the struct class that this device should be registered to
2452  * @parent: pointer to the parent struct device of this new device, if any
2453  * @devt: the dev_t for the char device to be added
2454  * @drvdata: the data to be added to the device for callbacks
2455  * @fmt: string for the device's name
2456  * @args: va_list for the device's name
2457  *
2458  * This function can be used by char device classes.  A struct device
2459  * will be created in sysfs, registered to the specified class.
2460  *
2461  * A "dev" file will be created, showing the dev_t for the device, if
2462  * the dev_t is not 0,0.
2463  * If a pointer to a parent struct device is passed in, the newly created
2464  * struct device will be a child of that device in sysfs.
2465  * The pointer to the struct device will be returned from the call.
2466  * Any further sysfs files that might be required can be created using this
2467  * pointer.
2468  *
2469  * Returns &struct device pointer on success, or ERR_PTR() on error.
2470  *
2471  * Note: the struct class passed to this function must have previously
2472  * been created with a call to class_create().
2473  */
2474 struct device *device_create_vargs(struct class *class, struct device *parent,
2475                                    dev_t devt, void *drvdata, const char *fmt,
2476                                    va_list args)
2477 {
2478         return device_create_groups_vargs(class, parent, devt, drvdata, NULL,
2479                                           fmt, args);
2480 }
2481 EXPORT_SYMBOL_GPL(device_create_vargs);
2482
2483 /**
2484  * device_create - creates a device and registers it with sysfs
2485  * @class: pointer to the struct class that this device should be registered to
2486  * @parent: pointer to the parent struct device of this new device, if any
2487  * @devt: the dev_t for the char device to be added
2488  * @drvdata: the data to be added to the device for callbacks
2489  * @fmt: string for the device's name
2490  *
2491  * This function can be used by char device classes.  A struct device
2492  * will be created in sysfs, registered to the specified class.
2493  *
2494  * A "dev" file will be created, showing the dev_t for the device, if
2495  * the dev_t is not 0,0.
2496  * If a pointer to a parent struct device is passed in, the newly created
2497  * struct device will be a child of that device in sysfs.
2498  * The pointer to the struct device will be returned from the call.
2499  * Any further sysfs files that might be required can be created using this
2500  * pointer.
2501  *
2502  * Returns &struct device pointer on success, or ERR_PTR() on error.
2503  *
2504  * Note: the struct class passed to this function must have previously
2505  * been created with a call to class_create().
2506  */
2507 struct device *device_create(struct class *class, struct device *parent,
2508                              dev_t devt, void *drvdata, const char *fmt, ...)
2509 {
2510         va_list vargs;
2511         struct device *dev;
2512
2513         va_start(vargs, fmt);
2514         dev = device_create_vargs(class, parent, devt, drvdata, fmt, vargs);
2515         va_end(vargs);
2516         return dev;
2517 }
2518 EXPORT_SYMBOL_GPL(device_create);
2519
2520 /**
2521  * device_create_with_groups - creates a device and registers it with sysfs
2522  * @class: pointer to the struct class that this device should be registered to
2523  * @parent: pointer to the parent struct device of this new device, if any
2524  * @devt: the dev_t for the char device to be added
2525  * @drvdata: the data to be added to the device for callbacks
2526  * @groups: NULL-terminated list of attribute groups to be created
2527  * @fmt: string for the device's name
2528  *
2529  * This function can be used by char device classes.  A struct device
2530  * will be created in sysfs, registered to the specified class.
2531  * Additional attributes specified in the groups parameter will also
2532  * be created automatically.
2533  *
2534  * A "dev" file will be created, showing the dev_t for the device, if
2535  * the dev_t is not 0,0.
2536  * If a pointer to a parent struct device is passed in, the newly created
2537  * struct device will be a child of that device in sysfs.
2538  * The pointer to the struct device will be returned from the call.
2539  * Any further sysfs files that might be required can be created using this
2540  * pointer.
2541  *
2542  * Returns &struct device pointer on success, or ERR_PTR() on error.
2543  *
2544  * Note: the struct class passed to this function must have previously
2545  * been created with a call to class_create().
2546  */
2547 struct device *device_create_with_groups(struct class *class,
2548                                          struct device *parent, dev_t devt,
2549                                          void *drvdata,
2550                                          const struct attribute_group **groups,
2551                                          const char *fmt, ...)
2552 {
2553         va_list vargs;
2554         struct device *dev;
2555
2556         va_start(vargs, fmt);
2557         dev = device_create_groups_vargs(class, parent, devt, drvdata, groups,
2558                                          fmt, vargs);
2559         va_end(vargs);
2560         return dev;
2561 }
2562 EXPORT_SYMBOL_GPL(device_create_with_groups);
2563
2564 static int __match_devt(struct device *dev, const void *data)
2565 {
2566         const dev_t *devt = data;
2567
2568         return dev->devt == *devt;
2569 }
2570
2571 /**
2572  * device_destroy - removes a device that was created with device_create()
2573  * @class: pointer to the struct class that this device was registered with
2574  * @devt: the dev_t of the device that was previously registered
2575  *
2576  * This call unregisters and cleans up a device that was created with a
2577  * call to device_create().
2578  */
2579 void device_destroy(struct class *class, dev_t devt)
2580 {
2581         struct device *dev;
2582
2583         dev = class_find_device(class, NULL, &devt, __match_devt);
2584         if (dev) {
2585                 put_device(dev);
2586                 device_unregister(dev);
2587         }
2588 }
2589 EXPORT_SYMBOL_GPL(device_destroy);
2590
2591 /**
2592  * device_rename - renames a device
2593  * @dev: the pointer to the struct device to be renamed
2594  * @new_name: the new name of the device
2595  *
2596  * It is the responsibility of the caller to provide mutual
2597  * exclusion between two different calls of device_rename
2598  * on the same device to ensure that new_name is valid and
2599  * won't conflict with other devices.
2600  *
2601  * Note: Don't call this function.  Currently, the networking layer calls this
2602  * function, but that will change.  The following text from Kay Sievers offers
2603  * some insight:
2604  *
2605  * Renaming devices is racy at many levels, symlinks and other stuff are not
2606  * replaced atomically, and you get a "move" uevent, but it's not easy to
2607  * connect the event to the old and new device. Device nodes are not renamed at
2608  * all, there isn't even support for that in the kernel now.
2609  *
2610  * In the meantime, during renaming, your target name might be taken by another
2611  * driver, creating conflicts. Or the old name is taken directly after you
2612  * renamed it -- then you get events for the same DEVPATH, before you even see
2613  * the "move" event. It's just a mess, and nothing new should ever rely on
2614  * kernel device renaming. Besides that, it's not even implemented now for
2615  * other things than (driver-core wise very simple) network devices.
2616  *
2617  * We are currently about to change network renaming in udev to completely
2618  * disallow renaming of devices in the same namespace as the kernel uses,
2619  * because we can't solve the problems properly, that arise with swapping names
2620  * of multiple interfaces without races. Means, renaming of eth[0-9]* will only
2621  * be allowed to some other name than eth[0-9]*, for the aforementioned
2622  * reasons.
2623  *
2624  * Make up a "real" name in the driver before you register anything, or add
2625  * some other attributes for userspace to find the device, or use udev to add
2626  * symlinks -- but never rename kernel devices later, it's a complete mess. We
2627  * don't even want to get into that and try to implement the missing pieces in
2628  * the core. We really have other pieces to fix in the driver core mess. :)
2629  */
2630 int device_rename(struct device *dev, const char *new_name)
2631 {
2632         struct kobject *kobj = &dev->kobj;
2633         char *old_device_name = NULL;
2634         int error;
2635
2636         dev = get_device(dev);
2637         if (!dev)
2638                 return -EINVAL;
2639
2640         dev_dbg(dev, "renaming to %s\n", new_name);
2641
2642         old_device_name = kstrdup(dev_name(dev), GFP_KERNEL);
2643         if (!old_device_name) {
2644                 error = -ENOMEM;
2645                 goto out;
2646         }
2647
2648         if (dev->class) {
2649                 error = sysfs_rename_link_ns(&dev->class->p->subsys.kobj,
2650                                              kobj, old_device_name,
2651                                              new_name, kobject_namespace(kobj));
2652                 if (error)
2653                         goto out;
2654         }
2655
2656         error = kobject_rename(kobj, new_name);
2657         if (error)
2658                 goto out;
2659
2660 out:
2661         put_device(dev);
2662
2663         kfree(old_device_name);
2664
2665         return error;
2666 }
2667 EXPORT_SYMBOL_GPL(device_rename);
2668
2669 static int device_move_class_links(struct device *dev,
2670                                    struct device *old_parent,
2671                                    struct device *new_parent)
2672 {
2673         int error = 0;
2674
2675         if (old_parent)
2676                 sysfs_remove_link(&dev->kobj, "device");
2677         if (new_parent)
2678                 error = sysfs_create_link(&dev->kobj, &new_parent->kobj,
2679                                           "device");
2680         return error;
2681 }
2682
2683 /**
2684  * device_move - moves a device to a new parent
2685  * @dev: the pointer to the struct device to be moved
2686  * @new_parent: the new parent of the device (can by NULL)
2687  * @dpm_order: how to reorder the dpm_list
2688  */
2689 int device_move(struct device *dev, struct device *new_parent,
2690                 enum dpm_order dpm_order)
2691 {
2692         int error;
2693         struct device *old_parent;
2694         struct kobject *new_parent_kobj;
2695
2696         dev = get_device(dev);
2697         if (!dev)
2698                 return -EINVAL;
2699
2700         device_pm_lock();
2701         new_parent = get_device(new_parent);
2702         new_parent_kobj = get_device_parent(dev, new_parent);
2703         if (IS_ERR(new_parent_kobj)) {
2704                 error = PTR_ERR(new_parent_kobj);
2705                 put_device(new_parent);
2706                 goto out;
2707         }
2708
2709         pr_debug("device: '%s': %s: moving to '%s'\n", dev_name(dev),
2710                  __func__, new_parent ? dev_name(new_parent) : "<NULL>");
2711         error = kobject_move(&dev->kobj, new_parent_kobj);
2712         if (error) {
2713                 cleanup_glue_dir(dev, new_parent_kobj);
2714                 put_device(new_parent);
2715                 goto out;
2716         }
2717         old_parent = dev->parent;
2718         dev->parent = new_parent;
2719         if (old_parent)
2720                 klist_remove(&dev->p->knode_parent);
2721         if (new_parent) {
2722                 klist_add_tail(&dev->p->knode_parent,
2723                                &new_parent->p->klist_children);
2724                 set_dev_node(dev, dev_to_node(new_parent));
2725         }
2726
2727         if (dev->class) {
2728                 error = device_move_class_links(dev, old_parent, new_parent);
2729                 if (error) {
2730                         /* We ignore errors on cleanup since we're hosed anyway... */
2731                         device_move_class_links(dev, new_parent, old_parent);
2732                         if (!kobject_move(&dev->kobj, &old_parent->kobj)) {
2733                                 if (new_parent)
2734                                         klist_remove(&dev->p->knode_parent);
2735                                 dev->parent = old_parent;
2736                                 if (old_parent) {
2737                                         klist_add_tail(&dev->p->knode_parent,
2738                                                        &old_parent->p->klist_children);
2739                                         set_dev_node(dev, dev_to_node(old_parent));
2740                                 }
2741                         }
2742                         cleanup_glue_dir(dev, new_parent_kobj);
2743                         put_device(new_parent);
2744                         goto out;
2745                 }
2746         }
2747         switch (dpm_order) {
2748         case DPM_ORDER_NONE:
2749                 break;
2750         case DPM_ORDER_DEV_AFTER_PARENT:
2751                 device_pm_move_after(dev, new_parent);
2752                 devices_kset_move_after(dev, new_parent);
2753                 break;
2754         case DPM_ORDER_PARENT_BEFORE_DEV:
2755                 device_pm_move_before(new_parent, dev);
2756                 devices_kset_move_before(new_parent, dev);
2757                 break;
2758         case DPM_ORDER_DEV_LAST:
2759                 device_pm_move_last(dev);
2760                 devices_kset_move_last(dev);
2761                 break;
2762         }
2763
2764         put_device(old_parent);
2765 out:
2766         device_pm_unlock();
2767         put_device(dev);
2768         return error;
2769 }
2770 EXPORT_SYMBOL_GPL(device_move);
2771
2772 /**
2773  * device_shutdown - call ->shutdown() on each device to shutdown.
2774  */
2775 void device_shutdown(void)
2776 {
2777         struct device *dev, *parent;
2778
2779         spin_lock(&devices_kset->list_lock);
2780         /*
2781          * Walk the devices list backward, shutting down each in turn.
2782          * Beware that device unplug events may also start pulling
2783          * devices offline, even as the system is shutting down.
2784          */
2785         while (!list_empty(&devices_kset->list)) {
2786                 dev = list_entry(devices_kset->list.prev, struct device,
2787                                 kobj.entry);
2788
2789                 /*
2790                  * hold reference count of device's parent to
2791                  * prevent it from being freed because parent's
2792                  * lock is to be held
2793                  */
2794                 parent = get_device(dev->parent);
2795                 get_device(dev);
2796                 /*
2797                  * Make sure the device is off the kset list, in the
2798                  * event that dev->*->shutdown() doesn't remove it.
2799                  */
2800                 list_del_init(&dev->kobj.entry);
2801                 spin_unlock(&devices_kset->list_lock);
2802
2803                 /* hold lock to avoid race with probe/release */
2804                 if (parent)
2805                         device_lock(parent);
2806                 device_lock(dev);
2807
2808                 /* Don't allow any more runtime suspends */
2809                 pm_runtime_get_noresume(dev);
2810                 pm_runtime_barrier(dev);
2811
2812                 if (dev->class && dev->class->shutdown_pre) {
2813                         if (initcall_debug)
2814                                 dev_info(dev, "shutdown_pre\n");
2815                         dev->class->shutdown_pre(dev);
2816                 }
2817                 if (dev->bus && dev->bus->shutdown) {
2818                         if (initcall_debug)
2819                                 dev_info(dev, "shutdown\n");
2820                         dev->bus->shutdown(dev);
2821                 } else if (dev->driver && dev->driver->shutdown) {
2822                         if (initcall_debug)
2823                                 dev_info(dev, "shutdown\n");
2824                         dev->driver->shutdown(dev);
2825                 }
2826
2827                 device_unlock(dev);
2828                 if (parent)
2829                         device_unlock(parent);
2830
2831                 put_device(dev);
2832                 put_device(parent);
2833
2834                 spin_lock(&devices_kset->list_lock);
2835         }
2836         spin_unlock(&devices_kset->list_lock);
2837 }
2838
2839 /*
2840  * Device logging functions
2841  */
2842
2843 #ifdef CONFIG_PRINTK
2844 static int
2845 create_syslog_header(const struct device *dev, char *hdr, size_t hdrlen)
2846 {
2847         const char *subsys;
2848         size_t pos = 0;
2849
2850         if (dev->class)
2851                 subsys = dev->class->name;
2852         else if (dev->bus)
2853                 subsys = dev->bus->name;
2854         else
2855                 return 0;
2856
2857         pos += snprintf(hdr + pos, hdrlen - pos, "SUBSYSTEM=%s", subsys);
2858         if (pos >= hdrlen)
2859                 goto overflow;
2860
2861         /*
2862          * Add device identifier DEVICE=:
2863          *   b12:8         block dev_t
2864          *   c127:3        char dev_t
2865          *   n8            netdev ifindex
2866          *   +sound:card0  subsystem:devname
2867          */
2868         if (MAJOR(dev->devt)) {
2869                 char c;
2870
2871                 if (strcmp(subsys, "block") == 0)
2872                         c = 'b';
2873                 else
2874                         c = 'c';
2875                 pos++;
2876                 pos += snprintf(hdr + pos, hdrlen - pos,
2877                                 "DEVICE=%c%u:%u",
2878                                 c, MAJOR(dev->devt), MINOR(dev->devt));
2879         } else if (strcmp(subsys, "net") == 0) {
2880                 struct net_device *net = to_net_dev(dev);
2881
2882                 pos++;
2883                 pos += snprintf(hdr + pos, hdrlen - pos,
2884                                 "DEVICE=n%u", net->ifindex);
2885         } else {
2886                 pos++;
2887                 pos += snprintf(hdr + pos, hdrlen - pos,
2888                                 "DEVICE=+%s:%s", subsys, dev_name(dev));
2889         }
2890
2891         if (pos >= hdrlen)
2892                 goto overflow;
2893
2894         return pos;
2895
2896 overflow:
2897         dev_WARN(dev, "device/subsystem name too long");
2898         return 0;
2899 }
2900
2901 int dev_vprintk_emit(int level, const struct device *dev,
2902                      const char *fmt, va_list args)
2903 {
2904         char hdr[128];
2905         size_t hdrlen;
2906
2907         hdrlen = create_syslog_header(dev, hdr, sizeof(hdr));
2908
2909         return vprintk_emit(0, level, hdrlen ? hdr : NULL, hdrlen, fmt, args);
2910 }
2911 EXPORT_SYMBOL(dev_vprintk_emit);
2912
2913 int dev_printk_emit(int level, const struct device *dev, const char *fmt, ...)
2914 {
2915         va_list args;
2916         int r;
2917
2918         va_start(args, fmt);
2919
2920         r = dev_vprintk_emit(level, dev, fmt, args);
2921
2922         va_end(args);
2923
2924         return r;
2925 }
2926 EXPORT_SYMBOL(dev_printk_emit);
2927
2928 static void __dev_printk(const char *level, const struct device *dev,
2929                         struct va_format *vaf)
2930 {
2931         if (dev)
2932                 dev_printk_emit(level[1] - '0', dev, "%s %s: %pV",
2933                                 dev_driver_string(dev), dev_name(dev), vaf);
2934         else
2935                 printk("%s(NULL device *): %pV", level, vaf);
2936 }
2937
2938 void dev_printk(const char *level, const struct device *dev,
2939                 const char *fmt, ...)
2940 {
2941         struct va_format vaf;
2942         va_list args;
2943
2944         va_start(args, fmt);
2945
2946         vaf.fmt = fmt;
2947         vaf.va = &args;
2948
2949         __dev_printk(level, dev, &vaf);
2950
2951         va_end(args);
2952 }
2953 EXPORT_SYMBOL(dev_printk);
2954
2955 #define define_dev_printk_level(func, kern_level)               \
2956 void func(const struct device *dev, const char *fmt, ...)       \
2957 {                                                               \
2958         struct va_format vaf;                                   \
2959         va_list args;                                           \
2960                                                                 \
2961         va_start(args, fmt);                                    \
2962                                                                 \
2963         vaf.fmt = fmt;                                          \
2964         vaf.va = &args;                                         \
2965                                                                 \
2966         __dev_printk(kern_level, dev, &vaf);                    \
2967                                                                 \
2968         va_end(args);                                           \
2969 }                                                               \
2970 EXPORT_SYMBOL(func);
2971
2972 define_dev_printk_level(dev_emerg, KERN_EMERG);
2973 define_dev_printk_level(dev_alert, KERN_ALERT);
2974 define_dev_printk_level(dev_crit, KERN_CRIT);
2975 define_dev_printk_level(dev_err, KERN_ERR);
2976 define_dev_printk_level(dev_warn, KERN_WARNING);
2977 define_dev_printk_level(dev_notice, KERN_NOTICE);
2978 define_dev_printk_level(_dev_info, KERN_INFO);
2979
2980 #endif
2981
2982 static inline bool fwnode_is_primary(struct fwnode_handle *fwnode)
2983 {
2984         return fwnode && !IS_ERR(fwnode->secondary);
2985 }
2986
2987 /**
2988  * set_primary_fwnode - Change the primary firmware node of a given device.
2989  * @dev: Device to handle.
2990  * @fwnode: New primary firmware node of the device.
2991  *
2992  * Set the device's firmware node pointer to @fwnode, but if a secondary
2993  * firmware node of the device is present, preserve it.
2994  */
2995 void set_primary_fwnode(struct device *dev, struct fwnode_handle *fwnode)
2996 {
2997         if (fwnode) {
2998                 struct fwnode_handle *fn = dev->fwnode;
2999
3000                 if (fwnode_is_primary(fn))
3001                         fn = fn->secondary;
3002
3003                 if (fn) {
3004                         WARN_ON(fwnode->secondary);
3005                         fwnode->secondary = fn;
3006                 }
3007                 dev->fwnode = fwnode;
3008         } else {
3009                 dev->fwnode = fwnode_is_primary(dev->fwnode) ?
3010                         dev->fwnode->secondary : NULL;
3011         }
3012 }
3013 EXPORT_SYMBOL_GPL(set_primary_fwnode);
3014
3015 /**
3016  * set_secondary_fwnode - Change the secondary firmware node of a given device.
3017  * @dev: Device to handle.
3018  * @fwnode: New secondary firmware node of the device.
3019  *
3020  * If a primary firmware node of the device is present, set its secondary
3021  * pointer to @fwnode.  Otherwise, set the device's firmware node pointer to
3022  * @fwnode.
3023  */
3024 void set_secondary_fwnode(struct device *dev, struct fwnode_handle *fwnode)
3025 {
3026         if (fwnode)
3027                 fwnode->secondary = ERR_PTR(-ENODEV);
3028
3029         if (fwnode_is_primary(dev->fwnode))
3030                 dev->fwnode->secondary = fwnode;
3031         else
3032                 dev->fwnode = fwnode;
3033 }
3034
3035 /**
3036  * device_set_of_node_from_dev - reuse device-tree node of another device
3037  * @dev: device whose device-tree node is being set
3038  * @dev2: device whose device-tree node is being reused
3039  *
3040  * Takes another reference to the new device-tree node after first dropping
3041  * any reference held to the old node.
3042  */
3043 void device_set_of_node_from_dev(struct device *dev, const struct device *dev2)
3044 {
3045         of_node_put(dev->of_node);
3046         dev->of_node = of_node_get(dev2->of_node);
3047         dev->of_node_reused = true;
3048 }
3049 EXPORT_SYMBOL_GPL(device_set_of_node_from_dev);