Merge master.kernel.org:/pub/scm/linux/kernel/git/wim/linux-2.6-watchdog
[pandora-kernel.git] / drivers / base / bus.c
1 /*
2  * bus.c - bus driver management
3  *
4  * Copyright (c) 2002-3 Patrick Mochel
5  * Copyright (c) 2002-3 Open Source Development Labs
6  *
7  * This file is released under the GPLv2
8  *
9  */
10
11 #include <linux/config.h>
12 #include <linux/device.h>
13 #include <linux/module.h>
14 #include <linux/errno.h>
15 #include <linux/init.h>
16 #include <linux/string.h>
17 #include "base.h"
18 #include "power/power.h"
19
20 #define to_bus_attr(_attr) container_of(_attr, struct bus_attribute, attr)
21 #define to_bus(obj) container_of(obj, struct bus_type, subsys.kset.kobj)
22
23 /*
24  * sysfs bindings for drivers
25  */
26
27 #define to_drv_attr(_attr) container_of(_attr, struct driver_attribute, attr)
28 #define to_driver(obj) container_of(obj, struct device_driver, kobj)
29
30
31 static ssize_t
32 drv_attr_show(struct kobject * kobj, struct attribute * attr, char * buf)
33 {
34         struct driver_attribute * drv_attr = to_drv_attr(attr);
35         struct device_driver * drv = to_driver(kobj);
36         ssize_t ret = -EIO;
37
38         if (drv_attr->show)
39                 ret = drv_attr->show(drv, buf);
40         return ret;
41 }
42
43 static ssize_t
44 drv_attr_store(struct kobject * kobj, struct attribute * attr,
45                const char * buf, size_t count)
46 {
47         struct driver_attribute * drv_attr = to_drv_attr(attr);
48         struct device_driver * drv = to_driver(kobj);
49         ssize_t ret = -EIO;
50
51         if (drv_attr->store)
52                 ret = drv_attr->store(drv, buf, count);
53         return ret;
54 }
55
56 static struct sysfs_ops driver_sysfs_ops = {
57         .show   = drv_attr_show,
58         .store  = drv_attr_store,
59 };
60
61
62 static void driver_release(struct kobject * kobj)
63 {
64         struct device_driver * drv = to_driver(kobj);
65         complete(&drv->unloaded);
66 }
67
68 static struct kobj_type ktype_driver = {
69         .sysfs_ops      = &driver_sysfs_ops,
70         .release        = driver_release,
71 };
72
73
74 /*
75  * sysfs bindings for buses
76  */
77
78
79 static ssize_t
80 bus_attr_show(struct kobject * kobj, struct attribute * attr, char * buf)
81 {
82         struct bus_attribute * bus_attr = to_bus_attr(attr);
83         struct bus_type * bus = to_bus(kobj);
84         ssize_t ret = 0;
85
86         if (bus_attr->show)
87                 ret = bus_attr->show(bus, buf);
88         return ret;
89 }
90
91 static ssize_t
92 bus_attr_store(struct kobject * kobj, struct attribute * attr,
93                const char * buf, size_t count)
94 {
95         struct bus_attribute * bus_attr = to_bus_attr(attr);
96         struct bus_type * bus = to_bus(kobj);
97         ssize_t ret = 0;
98
99         if (bus_attr->store)
100                 ret = bus_attr->store(bus, buf, count);
101         return ret;
102 }
103
104 static struct sysfs_ops bus_sysfs_ops = {
105         .show   = bus_attr_show,
106         .store  = bus_attr_store,
107 };
108
109 int bus_create_file(struct bus_type * bus, struct bus_attribute * attr)
110 {
111         int error;
112         if (get_bus(bus)) {
113                 error = sysfs_create_file(&bus->subsys.kset.kobj, &attr->attr);
114                 put_bus(bus);
115         } else
116                 error = -EINVAL;
117         return error;
118 }
119
120 void bus_remove_file(struct bus_type * bus, struct bus_attribute * attr)
121 {
122         if (get_bus(bus)) {
123                 sysfs_remove_file(&bus->subsys.kset.kobj, &attr->attr);
124                 put_bus(bus);
125         }
126 }
127
128 static struct kobj_type ktype_bus = {
129         .sysfs_ops      = &bus_sysfs_ops,
130
131 };
132
133 decl_subsys(bus, &ktype_bus, NULL);
134
135
136 #ifdef CONFIG_HOTPLUG
137
138 /* Manually detach a device from its associated driver. */
139 static int driver_helper(struct device *dev, void *data)
140 {
141         const char *name = data;
142
143         if (strcmp(name, dev->bus_id) == 0)
144                 return 1;
145         return 0;
146 }
147
148 static ssize_t driver_unbind(struct device_driver *drv,
149                              const char *buf, size_t count)
150 {
151         struct bus_type *bus = get_bus(drv->bus);
152         struct device *dev;
153         int err = -ENODEV;
154
155         dev = bus_find_device(bus, NULL, (void *)buf, driver_helper);
156         if (dev && dev->driver == drv) {
157                 if (dev->parent)        /* Needed for USB */
158                         down(&dev->parent->sem);
159                 device_release_driver(dev);
160                 if (dev->parent)
161                         up(&dev->parent->sem);
162                 err = count;
163         }
164         put_device(dev);
165         put_bus(bus);
166         return err;
167 }
168 static DRIVER_ATTR(unbind, S_IWUSR, NULL, driver_unbind);
169
170 /*
171  * Manually attach a device to a driver.
172  * Note: the driver must want to bind to the device,
173  * it is not possible to override the driver's id table.
174  */
175 static ssize_t driver_bind(struct device_driver *drv,
176                            const char *buf, size_t count)
177 {
178         struct bus_type *bus = get_bus(drv->bus);
179         struct device *dev;
180         int err = -ENODEV;
181
182         dev = bus_find_device(bus, NULL, (void *)buf, driver_helper);
183         if (dev && dev->driver == NULL) {
184                 if (dev->parent)        /* Needed for USB */
185                         down(&dev->parent->sem);
186                 down(&dev->sem);
187                 err = driver_probe_device(drv, dev);
188                 up(&dev->sem);
189                 if (dev->parent)
190                         up(&dev->parent->sem);
191
192                 if (err > 0)            /* success */
193                         err = count;
194                 else if (err == 0)      /* driver didn't accept device */
195                         err = -ENODEV;
196         }
197         put_device(dev);
198         put_bus(bus);
199         return err;
200 }
201 static DRIVER_ATTR(bind, S_IWUSR, NULL, driver_bind);
202
203 #endif
204
205 static struct device * next_device(struct klist_iter * i)
206 {
207         struct klist_node * n = klist_next(i);
208         return n ? container_of(n, struct device, knode_bus) : NULL;
209 }
210
211 /**
212  *      bus_for_each_dev - device iterator.
213  *      @bus:   bus type.
214  *      @start: device to start iterating from.
215  *      @data:  data for the callback.
216  *      @fn:    function to be called for each device.
217  *
218  *      Iterate over @bus's list of devices, and call @fn for each,
219  *      passing it @data. If @start is not NULL, we use that device to
220  *      begin iterating from.
221  *
222  *      We check the return of @fn each time. If it returns anything
223  *      other than 0, we break out and return that value.
224  *
225  *      NOTE: The device that returns a non-zero value is not retained
226  *      in any way, nor is its refcount incremented. If the caller needs
227  *      to retain this data, it should do, and increment the reference
228  *      count in the supplied callback.
229  */
230
231 int bus_for_each_dev(struct bus_type * bus, struct device * start,
232                      void * data, int (*fn)(struct device *, void *))
233 {
234         struct klist_iter i;
235         struct device * dev;
236         int error = 0;
237
238         if (!bus)
239                 return -EINVAL;
240
241         klist_iter_init_node(&bus->klist_devices, &i,
242                              (start ? &start->knode_bus : NULL));
243         while ((dev = next_device(&i)) && !error)
244                 error = fn(dev, data);
245         klist_iter_exit(&i);
246         return error;
247 }
248
249 /**
250  * bus_find_device - device iterator for locating a particular device.
251  * @bus: bus type
252  * @start: Device to begin with
253  * @data: Data to pass to match function
254  * @match: Callback function to check device
255  *
256  * This is similar to the bus_for_each_dev() function above, but it
257  * returns a reference to a device that is 'found' for later use, as
258  * determined by the @match callback.
259  *
260  * The callback should return 0 if the device doesn't match and non-zero
261  * if it does.  If the callback returns non-zero, this function will
262  * return to the caller and not iterate over any more devices.
263  */
264 struct device * bus_find_device(struct bus_type *bus,
265                                 struct device *start, void *data,
266                                 int (*match)(struct device *, void *))
267 {
268         struct klist_iter i;
269         struct device *dev;
270
271         if (!bus)
272                 return NULL;
273
274         klist_iter_init_node(&bus->klist_devices, &i,
275                              (start ? &start->knode_bus : NULL));
276         while ((dev = next_device(&i)))
277                 if (match(dev, data) && get_device(dev))
278                         break;
279         klist_iter_exit(&i);
280         return dev;
281 }
282
283
284 static struct device_driver * next_driver(struct klist_iter * i)
285 {
286         struct klist_node * n = klist_next(i);
287         return n ? container_of(n, struct device_driver, knode_bus) : NULL;
288 }
289
290 /**
291  *      bus_for_each_drv - driver iterator
292  *      @bus:   bus we're dealing with.
293  *      @start: driver to start iterating on.
294  *      @data:  data to pass to the callback.
295  *      @fn:    function to call for each driver.
296  *
297  *      This is nearly identical to the device iterator above.
298  *      We iterate over each driver that belongs to @bus, and call
299  *      @fn for each. If @fn returns anything but 0, we break out
300  *      and return it. If @start is not NULL, we use it as the head
301  *      of the list.
302  *
303  *      NOTE: we don't return the driver that returns a non-zero
304  *      value, nor do we leave the reference count incremented for that
305  *      driver. If the caller needs to know that info, it must set it
306  *      in the callback. It must also be sure to increment the refcount
307  *      so it doesn't disappear before returning to the caller.
308  */
309
310 int bus_for_each_drv(struct bus_type * bus, struct device_driver * start,
311                      void * data, int (*fn)(struct device_driver *, void *))
312 {
313         struct klist_iter i;
314         struct device_driver * drv;
315         int error = 0;
316
317         if (!bus)
318                 return -EINVAL;
319
320         klist_iter_init_node(&bus->klist_drivers, &i,
321                              start ? &start->knode_bus : NULL);
322         while ((drv = next_driver(&i)) && !error)
323                 error = fn(drv, data);
324         klist_iter_exit(&i);
325         return error;
326 }
327
328 static int device_add_attrs(struct bus_type * bus, struct device * dev)
329 {
330         int error = 0;
331         int i;
332
333         if (bus->dev_attrs) {
334                 for (i = 0; attr_name(bus->dev_attrs[i]); i++) {
335                         error = device_create_file(dev,&bus->dev_attrs[i]);
336                         if (error)
337                                 goto Err;
338                 }
339         }
340  Done:
341         return error;
342  Err:
343         while (--i >= 0)
344                 device_remove_file(dev,&bus->dev_attrs[i]);
345         goto Done;
346 }
347
348
349 static void device_remove_attrs(struct bus_type * bus, struct device * dev)
350 {
351         int i;
352
353         if (bus->dev_attrs) {
354                 for (i = 0; attr_name(bus->dev_attrs[i]); i++)
355                         device_remove_file(dev,&bus->dev_attrs[i]);
356         }
357 }
358
359
360 /**
361  *      bus_add_device - add device to bus
362  *      @dev:   device being added
363  *
364  *      - Add the device to its bus's list of devices.
365  *      - Create link to device's bus.
366  */
367 int bus_add_device(struct device * dev)
368 {
369         struct bus_type * bus = get_bus(dev->bus);
370         int error = 0;
371
372         if (bus) {
373                 pr_debug("bus %s: add device %s\n", bus->name, dev->bus_id);
374                 error = device_add_attrs(bus, dev);
375                 if (!error) {
376                         sysfs_create_link(&bus->devices.kobj, &dev->kobj, dev->bus_id);
377                         sysfs_create_link(&dev->kobj, &dev->bus->subsys.kset.kobj, "subsystem");
378                         sysfs_create_link(&dev->kobj, &dev->bus->subsys.kset.kobj, "bus");
379                 }
380         }
381         return error;
382 }
383
384 /**
385  *      bus_attach_device - add device to bus
386  *      @dev:   device tried to attach to a driver
387  *
388  *      - Try to attach to driver.
389  */
390 void bus_attach_device(struct device * dev)
391 {
392         struct bus_type * bus = dev->bus;
393
394         if (bus) {
395                 device_attach(dev);
396                 klist_add_tail(&dev->knode_bus, &bus->klist_devices);
397         }
398 }
399
400 /**
401  *      bus_remove_device - remove device from bus
402  *      @dev:   device to be removed
403  *
404  *      - Remove symlink from bus's directory.
405  *      - Delete device from bus's list.
406  *      - Detach from its driver.
407  *      - Drop reference taken in bus_add_device().
408  */
409 void bus_remove_device(struct device * dev)
410 {
411         if (dev->bus) {
412                 sysfs_remove_link(&dev->kobj, "subsystem");
413                 sysfs_remove_link(&dev->kobj, "bus");
414                 sysfs_remove_link(&dev->bus->devices.kobj, dev->bus_id);
415                 device_remove_attrs(dev->bus, dev);
416                 klist_remove(&dev->knode_bus);
417                 pr_debug("bus %s: remove device %s\n", dev->bus->name, dev->bus_id);
418                 device_release_driver(dev);
419                 put_bus(dev->bus);
420         }
421 }
422
423 static int driver_add_attrs(struct bus_type * bus, struct device_driver * drv)
424 {
425         int error = 0;
426         int i;
427
428         if (bus->drv_attrs) {
429                 for (i = 0; attr_name(bus->drv_attrs[i]); i++) {
430                         error = driver_create_file(drv, &bus->drv_attrs[i]);
431                         if (error)
432                                 goto Err;
433                 }
434         }
435  Done:
436         return error;
437  Err:
438         while (--i >= 0)
439                 driver_remove_file(drv, &bus->drv_attrs[i]);
440         goto Done;
441 }
442
443
444 static void driver_remove_attrs(struct bus_type * bus, struct device_driver * drv)
445 {
446         int i;
447
448         if (bus->drv_attrs) {
449                 for (i = 0; attr_name(bus->drv_attrs[i]); i++)
450                         driver_remove_file(drv, &bus->drv_attrs[i]);
451         }
452 }
453
454 #ifdef CONFIG_HOTPLUG
455 /*
456  * Thanks to drivers making their tables __devinit, we can't allow manual
457  * bind and unbind from userspace unless CONFIG_HOTPLUG is enabled.
458  */
459 static void add_bind_files(struct device_driver *drv)
460 {
461         driver_create_file(drv, &driver_attr_unbind);
462         driver_create_file(drv, &driver_attr_bind);
463 }
464
465 static void remove_bind_files(struct device_driver *drv)
466 {
467         driver_remove_file(drv, &driver_attr_bind);
468         driver_remove_file(drv, &driver_attr_unbind);
469 }
470 #else
471 static inline void add_bind_files(struct device_driver *drv) {}
472 static inline void remove_bind_files(struct device_driver *drv) {}
473 #endif
474
475 /**
476  *      bus_add_driver - Add a driver to the bus.
477  *      @drv:   driver.
478  *
479  */
480 int bus_add_driver(struct device_driver * drv)
481 {
482         struct bus_type * bus = get_bus(drv->bus);
483         int error = 0;
484
485         if (bus) {
486                 pr_debug("bus %s: add driver %s\n", bus->name, drv->name);
487                 error = kobject_set_name(&drv->kobj, "%s", drv->name);
488                 if (error) {
489                         put_bus(bus);
490                         return error;
491                 }
492                 drv->kobj.kset = &bus->drivers;
493                 if ((error = kobject_register(&drv->kobj))) {
494                         put_bus(bus);
495                         return error;
496                 }
497
498                 driver_attach(drv);
499                 klist_add_tail(&drv->knode_bus, &bus->klist_drivers);
500                 module_add_driver(drv->owner, drv);
501
502                 driver_add_attrs(bus, drv);
503                 add_bind_files(drv);
504         }
505         return error;
506 }
507
508
509 /**
510  *      bus_remove_driver - delete driver from bus's knowledge.
511  *      @drv:   driver.
512  *
513  *      Detach the driver from the devices it controls, and remove
514  *      it from its bus's list of drivers. Finally, we drop the reference
515  *      to the bus we took in bus_add_driver().
516  */
517
518 void bus_remove_driver(struct device_driver * drv)
519 {
520         if (drv->bus) {
521                 remove_bind_files(drv);
522                 driver_remove_attrs(drv->bus, drv);
523                 klist_remove(&drv->knode_bus);
524                 pr_debug("bus %s: remove driver %s\n", drv->bus->name, drv->name);
525                 driver_detach(drv);
526                 module_remove_driver(drv);
527                 kobject_unregister(&drv->kobj);
528                 put_bus(drv->bus);
529         }
530 }
531
532
533 /* Helper for bus_rescan_devices's iter */
534 static int bus_rescan_devices_helper(struct device *dev, void *data)
535 {
536         if (!dev->driver) {
537                 if (dev->parent)        /* Needed for USB */
538                         down(&dev->parent->sem);
539                 device_attach(dev);
540                 if (dev->parent)
541                         up(&dev->parent->sem);
542         }
543         return 0;
544 }
545
546 /**
547  * bus_rescan_devices - rescan devices on the bus for possible drivers
548  * @bus: the bus to scan.
549  *
550  * This function will look for devices on the bus with no driver
551  * attached and rescan it against existing drivers to see if it matches
552  * any by calling device_attach() for the unbound devices.
553  */
554 void bus_rescan_devices(struct bus_type * bus)
555 {
556         bus_for_each_dev(bus, NULL, NULL, bus_rescan_devices_helper);
557 }
558
559 /**
560  * device_reprobe - remove driver for a device and probe for a new driver
561  * @dev: the device to reprobe
562  *
563  * This function detaches the attached driver (if any) for the given
564  * device and restarts the driver probing process.  It is intended
565  * to use if probing criteria changed during a devices lifetime and
566  * driver attachment should change accordingly.
567  */
568 void device_reprobe(struct device *dev)
569 {
570         if (dev->driver) {
571                 if (dev->parent)        /* Needed for USB */
572                         down(&dev->parent->sem);
573                 device_release_driver(dev);
574                 if (dev->parent)
575                         up(&dev->parent->sem);
576         }
577
578         bus_rescan_devices_helper(dev, NULL);
579 }
580 EXPORT_SYMBOL_GPL(device_reprobe);
581
582 struct bus_type * get_bus(struct bus_type * bus)
583 {
584         return bus ? container_of(subsys_get(&bus->subsys), struct bus_type, subsys) : NULL;
585 }
586
587 void put_bus(struct bus_type * bus)
588 {
589         subsys_put(&bus->subsys);
590 }
591
592
593 /**
594  *      find_bus - locate bus by name.
595  *      @name:  name of bus.
596  *
597  *      Call kset_find_obj() to iterate over list of buses to
598  *      find a bus by name. Return bus if found.
599  *
600  *      Note that kset_find_obj increments bus' reference count.
601  */
602
603 struct bus_type * find_bus(char * name)
604 {
605         struct kobject * k = kset_find_obj(&bus_subsys.kset, name);
606         return k ? to_bus(k) : NULL;
607 }
608
609
610 /**
611  *      bus_add_attrs - Add default attributes for this bus.
612  *      @bus:   Bus that has just been registered.
613  */
614
615 static int bus_add_attrs(struct bus_type * bus)
616 {
617         int error = 0;
618         int i;
619
620         if (bus->bus_attrs) {
621                 for (i = 0; attr_name(bus->bus_attrs[i]); i++) {
622                         if ((error = bus_create_file(bus,&bus->bus_attrs[i])))
623                                 goto Err;
624                 }
625         }
626  Done:
627         return error;
628  Err:
629         while (--i >= 0)
630                 bus_remove_file(bus,&bus->bus_attrs[i]);
631         goto Done;
632 }
633
634 static void bus_remove_attrs(struct bus_type * bus)
635 {
636         int i;
637
638         if (bus->bus_attrs) {
639                 for (i = 0; attr_name(bus->bus_attrs[i]); i++)
640                         bus_remove_file(bus,&bus->bus_attrs[i]);
641         }
642 }
643
644 static void klist_devices_get(struct klist_node *n)
645 {
646         struct device *dev = container_of(n, struct device, knode_bus);
647
648         get_device(dev);
649 }
650
651 static void klist_devices_put(struct klist_node *n)
652 {
653         struct device *dev = container_of(n, struct device, knode_bus);
654
655         put_device(dev);
656 }
657
658 static void klist_drivers_get(struct klist_node *n)
659 {
660         struct device_driver *drv = container_of(n, struct device_driver,
661                                                  knode_bus);
662
663         get_driver(drv);
664 }
665
666 static void klist_drivers_put(struct klist_node *n)
667 {
668         struct device_driver *drv = container_of(n, struct device_driver,
669                                                  knode_bus);
670
671         put_driver(drv);
672 }
673
674 /**
675  *      bus_register - register a bus with the system.
676  *      @bus:   bus.
677  *
678  *      Once we have that, we registered the bus with the kobject
679  *      infrastructure, then register the children subsystems it has:
680  *      the devices and drivers that belong to the bus.
681  */
682 int bus_register(struct bus_type * bus)
683 {
684         int retval;
685
686         retval = kobject_set_name(&bus->subsys.kset.kobj, "%s", bus->name);
687         if (retval)
688                 goto out;
689
690         subsys_set_kset(bus, bus_subsys);
691         retval = subsystem_register(&bus->subsys);
692         if (retval)
693                 goto out;
694
695         kobject_set_name(&bus->devices.kobj, "devices");
696         bus->devices.subsys = &bus->subsys;
697         retval = kset_register(&bus->devices);
698         if (retval)
699                 goto bus_devices_fail;
700
701         kobject_set_name(&bus->drivers.kobj, "drivers");
702         bus->drivers.subsys = &bus->subsys;
703         bus->drivers.ktype = &ktype_driver;
704         retval = kset_register(&bus->drivers);
705         if (retval)
706                 goto bus_drivers_fail;
707
708         klist_init(&bus->klist_devices, klist_devices_get, klist_devices_put);
709         klist_init(&bus->klist_drivers, klist_drivers_get, klist_drivers_put);
710         bus_add_attrs(bus);
711
712         pr_debug("bus type '%s' registered\n", bus->name);
713         return 0;
714
715 bus_drivers_fail:
716         kset_unregister(&bus->devices);
717 bus_devices_fail:
718         subsystem_unregister(&bus->subsys);
719 out:
720         return retval;
721 }
722
723
724 /**
725  *      bus_unregister - remove a bus from the system
726  *      @bus:   bus.
727  *
728  *      Unregister the child subsystems and the bus itself.
729  *      Finally, we call put_bus() to release the refcount
730  */
731 void bus_unregister(struct bus_type * bus)
732 {
733         pr_debug("bus %s: unregistering\n", bus->name);
734         bus_remove_attrs(bus);
735         kset_unregister(&bus->drivers);
736         kset_unregister(&bus->devices);
737         subsystem_unregister(&bus->subsys);
738 }
739
740 int __init buses_init(void)
741 {
742         return subsystem_register(&bus_subsys);
743 }
744
745
746 EXPORT_SYMBOL_GPL(bus_for_each_dev);
747 EXPORT_SYMBOL_GPL(bus_find_device);
748 EXPORT_SYMBOL_GPL(bus_for_each_drv);
749
750 EXPORT_SYMBOL_GPL(bus_register);
751 EXPORT_SYMBOL_GPL(bus_unregister);
752 EXPORT_SYMBOL_GPL(bus_rescan_devices);
753
754 EXPORT_SYMBOL_GPL(bus_create_file);
755 EXPORT_SYMBOL_GPL(bus_remove_file);