1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/device.h>
14#include <linux/module.h>
15#include <linux/errno.h>
16#include <linux/slab.h>
17#include <linux/string.h>
18#include "base.h"
19
20static struct device *next_device(struct klist_iter *i)
21{
22 struct klist_node *n = klist_next(i);
23 struct device *dev = NULL;
24 struct device_private *dev_prv;
25
26 if (n) {
27 dev_prv = to_device_private_driver(n);
28 dev = dev_prv->device;
29 }
30 return dev;
31}
32
33
34
35
36
37
38
39
40
41
42int driver_for_each_device(struct device_driver *drv, struct device *start,
43 void *data, int (*fn)(struct device *, void *))
44{
45 struct klist_iter i;
46 struct device *dev;
47 int error = 0;
48
49 if (!drv)
50 return -EINVAL;
51
52 klist_iter_init_node(&drv->p->klist_devices, &i,
53 start ? &start->p->knode_driver : NULL);
54 while ((dev = next_device(&i)) && !error)
55 error = fn(dev, data);
56 klist_iter_exit(&i);
57 return error;
58}
59EXPORT_SYMBOL_GPL(driver_for_each_device);
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76struct device *driver_find_device(struct device_driver *drv,
77 struct device *start, void *data,
78 int (*match)(struct device *dev, void *data))
79{
80 struct klist_iter i;
81 struct device *dev;
82
83 if (!drv || !drv->p)
84 return NULL;
85
86 klist_iter_init_node(&drv->p->klist_devices, &i,
87 (start ? &start->p->knode_driver : NULL));
88 while ((dev = next_device(&i)))
89 if (match(dev, data) && get_device(dev))
90 break;
91 klist_iter_exit(&i);
92 return dev;
93}
94EXPORT_SYMBOL_GPL(driver_find_device);
95
96
97
98
99
100
101int driver_create_file(struct device_driver *drv,
102 const struct driver_attribute *attr)
103{
104 int error;
105 if (drv)
106 error = sysfs_create_file(&drv->p->kobj, &attr->attr);
107 else
108 error = -EINVAL;
109 return error;
110}
111EXPORT_SYMBOL_GPL(driver_create_file);
112
113
114
115
116
117
118void driver_remove_file(struct device_driver *drv,
119 const struct driver_attribute *attr)
120{
121 if (drv)
122 sysfs_remove_file(&drv->p->kobj, &attr->attr);
123}
124EXPORT_SYMBOL_GPL(driver_remove_file);
125
126int driver_add_groups(struct device_driver *drv,
127 const struct attribute_group **groups)
128{
129 return sysfs_create_groups(&drv->p->kobj, groups);
130}
131
132void driver_remove_groups(struct device_driver *drv,
133 const struct attribute_group **groups)
134{
135 sysfs_remove_groups(&drv->p->kobj, groups);
136}
137
138
139
140
141
142
143
144
145
146int driver_register(struct device_driver *drv)
147{
148 int ret;
149 struct device_driver *other;
150
151 BUG_ON(!drv->bus->p);
152
153 if ((drv->bus->probe && drv->probe) ||
154 (drv->bus->remove && drv->remove) ||
155 (drv->bus->shutdown && drv->shutdown))
156 printk(KERN_WARNING "Driver '%s' needs updating - please use "
157 "bus_type methods\n", drv->name);
158
159 other = driver_find(drv->name, drv->bus);
160 if (other) {
161 printk(KERN_ERR "Error: Driver '%s' is already registered, "
162 "aborting...\n", drv->name);
163 return -EBUSY;
164 }
165
166 ret = bus_add_driver(drv);
167 if (ret)
168 return ret;
169 ret = driver_add_groups(drv, drv->groups);
170 if (ret) {
171 bus_remove_driver(drv);
172 return ret;
173 }
174 kobject_uevent(&drv->p->kobj, KOBJ_ADD);
175
176 return ret;
177}
178EXPORT_SYMBOL_GPL(driver_register);
179
180
181
182
183
184
185
186void driver_unregister(struct device_driver *drv)
187{
188 if (!drv || !drv->p) {
189 WARN(1, "Unexpected driver unregister!\n");
190 return;
191 }
192 driver_remove_groups(drv, drv->groups);
193 bus_remove_driver(drv);
194}
195EXPORT_SYMBOL_GPL(driver_unregister);
196
197
198
199
200
201
202
203
204
205
206
207
208
209struct device_driver *driver_find(const char *name, struct bus_type *bus)
210{
211 struct kobject *k = kset_find_obj(bus->p->drivers_kset, name);
212 struct driver_private *priv;
213
214 if (k) {
215
216 kobject_put(k);
217 priv = to_driver(k);
218 return priv->driver;
219 }
220 return NULL;
221}
222EXPORT_SYMBOL_GPL(driver_find);
223