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/init.h>
16#include <linux/string.h>
17#include <linux/kdev_t.h>
18#include <linux/err.h>
19#include <linux/slab.h>
20#include <linux/genhd.h>
21#include <linux/mutex.h>
22#include "base.h"
23
24#define to_class_attr(_attr) container_of(_attr, struct class_attribute, attr)
25
26static ssize_t class_attr_show(struct kobject *kobj, struct attribute *attr,
27 char *buf)
28{
29 struct class_attribute *class_attr = to_class_attr(attr);
30 struct class_private *cp = to_class(kobj);
31 ssize_t ret = -EIO;
32
33 if (class_attr->show)
34 ret = class_attr->show(cp->class, buf);
35 return ret;
36}
37
38static ssize_t class_attr_store(struct kobject *kobj, struct attribute *attr,
39 const char *buf, size_t count)
40{
41 struct class_attribute *class_attr = to_class_attr(attr);
42 struct class_private *cp = to_class(kobj);
43 ssize_t ret = -EIO;
44
45 if (class_attr->store)
46 ret = class_attr->store(cp->class, buf, count);
47 return ret;
48}
49
50static void class_release(struct kobject *kobj)
51{
52 struct class_private *cp = to_class(kobj);
53 struct class *class = cp->class;
54
55 pr_debug("class '%s': release.\n", class->name);
56
57 if (class->class_release)
58 class->class_release(class);
59 else
60 pr_debug("class '%s' does not have a release() function, "
61 "be careful\n", class->name);
62}
63
64static struct sysfs_ops class_sysfs_ops = {
65 .show = class_attr_show,
66 .store = class_attr_store,
67};
68
69static struct kobj_type class_ktype = {
70 .sysfs_ops = &class_sysfs_ops,
71 .release = class_release,
72};
73
74
75static struct kset *class_kset;
76
77
78int class_create_file(struct class *cls, const struct class_attribute *attr)
79{
80 int error;
81 if (cls)
82 error = sysfs_create_file(&cls->p->class_subsys.kobj,
83 &attr->attr);
84 else
85 error = -EINVAL;
86 return error;
87}
88
89void class_remove_file(struct class *cls, const struct class_attribute *attr)
90{
91 if (cls)
92 sysfs_remove_file(&cls->p->class_subsys.kobj, &attr->attr);
93}
94
95static struct class *class_get(struct class *cls)
96{
97 if (cls)
98 kset_get(&cls->p->class_subsys);
99 return cls;
100}
101
102static void class_put(struct class *cls)
103{
104 if (cls)
105 kset_put(&cls->p->class_subsys);
106}
107
108static int add_class_attrs(struct class *cls)
109{
110 int i;
111 int error = 0;
112
113 if (cls->class_attrs) {
114 for (i = 0; attr_name(cls->class_attrs[i]); i++) {
115 error = class_create_file(cls, &cls->class_attrs[i]);
116 if (error)
117 goto error;
118 }
119 }
120done:
121 return error;
122error:
123 while (--i >= 0)
124 class_remove_file(cls, &cls->class_attrs[i]);
125 goto done;
126}
127
128static void remove_class_attrs(struct class *cls)
129{
130 int i;
131
132 if (cls->class_attrs) {
133 for (i = 0; attr_name(cls->class_attrs[i]); i++)
134 class_remove_file(cls, &cls->class_attrs[i]);
135 }
136}
137
138static void klist_class_dev_get(struct klist_node *n)
139{
140 struct device *dev = container_of(n, struct device, knode_class);
141
142 get_device(dev);
143}
144
145static void klist_class_dev_put(struct klist_node *n)
146{
147 struct device *dev = container_of(n, struct device, knode_class);
148
149 put_device(dev);
150}
151
152int __class_register(struct class *cls, struct lock_class_key *key)
153{
154 struct class_private *cp;
155 int error;
156
157 pr_debug("device class '%s': registering\n", cls->name);
158
159 cp = kzalloc(sizeof(*cp), GFP_KERNEL);
160 if (!cp)
161 return -ENOMEM;
162 klist_init(&cp->class_devices, klist_class_dev_get, klist_class_dev_put);
163 INIT_LIST_HEAD(&cp->class_interfaces);
164 kset_init(&cp->class_dirs);
165 __mutex_init(&cp->class_mutex, "struct class mutex", key);
166 error = kobject_set_name(&cp->class_subsys.kobj, "%s", cls->name);
167 if (error) {
168 kfree(cp);
169 return error;
170 }
171
172
173 if (!cls->dev_kobj)
174 cls->dev_kobj = sysfs_dev_char_kobj;
175
176#if defined(CONFIG_SYSFS_DEPRECATED) && defined(CONFIG_BLOCK)
177
178 if (cls != &block_class)
179 cp->class_subsys.kobj.kset = class_kset;
180#else
181 cp->class_subsys.kobj.kset = class_kset;
182#endif
183 cp->class_subsys.kobj.ktype = &class_ktype;
184 cp->class = cls;
185 cls->p = cp;
186
187 error = kset_register(&cp->class_subsys);
188 if (error) {
189 kfree(cp);
190 return error;
191 }
192 error = add_class_attrs(class_get(cls));
193 class_put(cls);
194 return error;
195}
196EXPORT_SYMBOL_GPL(__class_register);
197
198void class_unregister(struct class *cls)
199{
200 pr_debug("device class '%s': unregistering\n", cls->name);
201 remove_class_attrs(cls);
202 kset_unregister(&cls->p->class_subsys);
203}
204
205static void class_create_release(struct class *cls)
206{
207 pr_debug("%s called for %s\n", __func__, cls->name);
208 kfree(cls);
209}
210
211
212
213
214
215
216
217
218
219
220
221
222
223struct class *__class_create(struct module *owner, const char *name,
224 struct lock_class_key *key)
225{
226 struct class *cls;
227 int retval;
228
229 cls = kzalloc(sizeof(*cls), GFP_KERNEL);
230 if (!cls) {
231 retval = -ENOMEM;
232 goto error;
233 }
234
235 cls->name = name;
236 cls->owner = owner;
237 cls->class_release = class_create_release;
238
239 retval = __class_register(cls, key);
240 if (retval)
241 goto error;
242
243 return cls;
244
245error:
246 kfree(cls);
247 return ERR_PTR(retval);
248}
249EXPORT_SYMBOL_GPL(__class_create);
250
251
252
253
254
255
256
257
258void class_destroy(struct class *cls)
259{
260 if ((cls == NULL) || (IS_ERR(cls)))
261 return;
262
263 class_unregister(cls);
264}
265
266#ifdef CONFIG_SYSFS_DEPRECATED
267char *make_class_name(const char *name, struct kobject *kobj)
268{
269 char *class_name;
270 int size;
271
272 size = strlen(name) + strlen(kobject_name(kobj)) + 2;
273
274 class_name = kmalloc(size, GFP_KERNEL);
275 if (!class_name)
276 return NULL;
277
278 strcpy(class_name, name);
279 strcat(class_name, ":");
280 strcat(class_name, kobject_name(kobj));
281 return class_name;
282}
283#endif
284
285
286
287
288
289
290
291
292
293
294
295
296
297void class_dev_iter_init(struct class_dev_iter *iter, struct class *class,
298 struct device *start, const struct device_type *type)
299{
300 struct klist_node *start_knode = NULL;
301
302 if (start)
303 start_knode = &start->knode_class;
304 klist_iter_init_node(&class->p->class_devices, &iter->ki, start_knode);
305 iter->type = type;
306}
307EXPORT_SYMBOL_GPL(class_dev_iter_init);
308
309
310
311
312
313
314
315
316
317
318
319
320
321struct device *class_dev_iter_next(struct class_dev_iter *iter)
322{
323 struct klist_node *knode;
324 struct device *dev;
325
326 while (1) {
327 knode = klist_next(&iter->ki);
328 if (!knode)
329 return NULL;
330 dev = container_of(knode, struct device, knode_class);
331 if (!iter->type || iter->type == dev->type)
332 return dev;
333 }
334}
335EXPORT_SYMBOL_GPL(class_dev_iter_next);
336
337
338
339
340
341
342
343
344void class_dev_iter_exit(struct class_dev_iter *iter)
345{
346 klist_iter_exit(&iter->ki);
347}
348EXPORT_SYMBOL_GPL(class_dev_iter_exit);
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368int class_for_each_device(struct class *class, struct device *start,
369 void *data, int (*fn)(struct device *, void *))
370{
371 struct class_dev_iter iter;
372 struct device *dev;
373 int error = 0;
374
375 if (!class)
376 return -EINVAL;
377 if (!class->p) {
378 WARN(1, "%s called for class '%s' before it was initialized",
379 __func__, class->name);
380 return -EINVAL;
381 }
382
383 class_dev_iter_init(&iter, class, start, NULL);
384 while ((dev = class_dev_iter_next(&iter))) {
385 error = fn(dev, data);
386 if (error)
387 break;
388 }
389 class_dev_iter_exit(&iter);
390
391 return error;
392}
393EXPORT_SYMBOL_GPL(class_for_each_device);
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415struct device *class_find_device(struct class *class, struct device *start,
416 void *data,
417 int (*match)(struct device *, void *))
418{
419 struct class_dev_iter iter;
420 struct device *dev;
421
422 if (!class)
423 return NULL;
424 if (!class->p) {
425 WARN(1, "%s called for class '%s' before it was initialized",
426 __func__, class->name);
427 return NULL;
428 }
429
430 class_dev_iter_init(&iter, class, start, NULL);
431 while ((dev = class_dev_iter_next(&iter))) {
432 if (match(dev, data)) {
433 get_device(dev);
434 break;
435 }
436 }
437 class_dev_iter_exit(&iter);
438
439 return dev;
440}
441EXPORT_SYMBOL_GPL(class_find_device);
442
443int class_interface_register(struct class_interface *class_intf)
444{
445 struct class *parent;
446 struct class_dev_iter iter;
447 struct device *dev;
448
449 if (!class_intf || !class_intf->class)
450 return -ENODEV;
451
452 parent = class_get(class_intf->class);
453 if (!parent)
454 return -EINVAL;
455
456 mutex_lock(&parent->p->class_mutex);
457 list_add_tail(&class_intf->node, &parent->p->class_interfaces);
458 if (class_intf->add_dev) {
459 class_dev_iter_init(&iter, parent, NULL, NULL);
460 while ((dev = class_dev_iter_next(&iter)))
461 class_intf->add_dev(dev, class_intf);
462 class_dev_iter_exit(&iter);
463 }
464 mutex_unlock(&parent->p->class_mutex);
465
466 return 0;
467}
468
469void class_interface_unregister(struct class_interface *class_intf)
470{
471 struct class *parent = class_intf->class;
472 struct class_dev_iter iter;
473 struct device *dev;
474
475 if (!parent)
476 return;
477
478 mutex_lock(&parent->p->class_mutex);
479 list_del_init(&class_intf->node);
480 if (class_intf->remove_dev) {
481 class_dev_iter_init(&iter, parent, NULL, NULL);
482 while ((dev = class_dev_iter_next(&iter)))
483 class_intf->remove_dev(dev, class_intf);
484 class_dev_iter_exit(&iter);
485 }
486 mutex_unlock(&parent->p->class_mutex);
487
488 class_put(parent);
489}
490
491int __init classes_init(void)
492{
493 class_kset = kset_create_and_add("class", NULL, NULL);
494 if (!class_kset)
495 return -ENOMEM;
496 return 0;
497}
498
499EXPORT_SYMBOL_GPL(class_create_file);
500EXPORT_SYMBOL_GPL(class_remove_file);
501EXPORT_SYMBOL_GPL(class_unregister);
502EXPORT_SYMBOL_GPL(class_destroy);
503
504EXPORT_SYMBOL_GPL(class_interface_register);
505EXPORT_SYMBOL_GPL(class_interface_unregister);
506