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 subsys_private *cp = to_subsys_private(kobj);
31 ssize_t ret = -EIO;
32
33 if (class_attr->show)
34 ret = class_attr->show(cp->class, class_attr, 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 subsys_private *cp = to_subsys_private(kobj);
43 ssize_t ret = -EIO;
44
45 if (class_attr->store)
46 ret = class_attr->store(cp->class, class_attr, buf, count);
47 return ret;
48}
49
50static void class_release(struct kobject *kobj)
51{
52 struct subsys_private *cp = to_subsys_private(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 kfree(cp);
64}
65
66static const struct kobj_ns_type_operations *class_child_ns_type(struct kobject *kobj)
67{
68 struct subsys_private *cp = to_subsys_private(kobj);
69 struct class *class = cp->class;
70
71 return class->ns_type;
72}
73
74static const struct sysfs_ops class_sysfs_ops = {
75 .show = class_attr_show,
76 .store = class_attr_store,
77};
78
79static struct kobj_type class_ktype = {
80 .sysfs_ops = &class_sysfs_ops,
81 .release = class_release,
82 .child_ns_type = class_child_ns_type,
83};
84
85
86static struct kset *class_kset;
87
88
89int class_create_file_ns(struct class *cls, const struct class_attribute *attr,
90 const void *ns)
91{
92 int error;
93 if (cls)
94 error = sysfs_create_file_ns(&cls->p->subsys.kobj,
95 &attr->attr, ns);
96 else
97 error = -EINVAL;
98 return error;
99}
100
101void class_remove_file_ns(struct class *cls, const struct class_attribute *attr,
102 const void *ns)
103{
104 if (cls)
105 sysfs_remove_file_ns(&cls->p->subsys.kobj, &attr->attr, ns);
106}
107
108static struct class *class_get(struct class *cls)
109{
110 if (cls)
111 kset_get(&cls->p->subsys);
112 return cls;
113}
114
115static void class_put(struct class *cls)
116{
117 if (cls)
118 kset_put(&cls->p->subsys);
119}
120
121static int add_class_attrs(struct class *cls)
122{
123 int i;
124 int error = 0;
125
126 if (cls->class_attrs) {
127 for (i = 0; cls->class_attrs[i].attr.name; i++) {
128 error = class_create_file(cls, &cls->class_attrs[i]);
129 if (error)
130 goto error;
131 }
132 }
133done:
134 return error;
135error:
136 while (--i >= 0)
137 class_remove_file(cls, &cls->class_attrs[i]);
138 goto done;
139}
140
141static void remove_class_attrs(struct class *cls)
142{
143 int i;
144
145 if (cls->class_attrs) {
146 for (i = 0; cls->class_attrs[i].attr.name; i++)
147 class_remove_file(cls, &cls->class_attrs[i]);
148 }
149}
150
151static void klist_class_dev_get(struct klist_node *n)
152{
153 struct device *dev = container_of(n, struct device, knode_class);
154
155 get_device(dev);
156}
157
158static void klist_class_dev_put(struct klist_node *n)
159{
160 struct device *dev = container_of(n, struct device, knode_class);
161
162 put_device(dev);
163}
164
165int __class_register(struct class *cls, struct lock_class_key *key)
166{
167 struct subsys_private *cp;
168 int error;
169
170 pr_debug("device class '%s': registering\n", cls->name);
171
172 cp = kzalloc(sizeof(*cp), GFP_KERNEL);
173 if (!cp)
174 return -ENOMEM;
175 klist_init(&cp->klist_devices, klist_class_dev_get, klist_class_dev_put);
176 INIT_LIST_HEAD(&cp->interfaces);
177 kset_init(&cp->glue_dirs);
178 __mutex_init(&cp->mutex, "subsys mutex", key);
179 error = kobject_set_name(&cp->subsys.kobj, "%s", cls->name);
180 if (error) {
181 kfree(cp);
182 return error;
183 }
184
185
186 if (!cls->dev_kobj)
187 cls->dev_kobj = sysfs_dev_char_kobj;
188
189#if defined(CONFIG_BLOCK)
190
191 if (!sysfs_deprecated || cls != &block_class)
192 cp->subsys.kobj.kset = class_kset;
193#else
194 cp->subsys.kobj.kset = class_kset;
195#endif
196 cp->subsys.kobj.ktype = &class_ktype;
197 cp->class = cls;
198 cls->p = cp;
199
200 error = kset_register(&cp->subsys);
201 if (error) {
202 kfree(cp);
203 return error;
204 }
205 error = add_class_attrs(class_get(cls));
206 class_put(cls);
207 return error;
208}
209EXPORT_SYMBOL_GPL(__class_register);
210
211void class_unregister(struct class *cls)
212{
213 pr_debug("device class '%s': unregistering\n", cls->name);
214 remove_class_attrs(cls);
215 kset_unregister(&cls->p->subsys);
216}
217
218static void class_create_release(struct class *cls)
219{
220 pr_debug("%s called for %s\n", __func__, cls->name);
221 kfree(cls);
222}
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238struct class *__class_create(struct module *owner, const char *name,
239 struct lock_class_key *key)
240{
241 struct class *cls;
242 int retval;
243
244 cls = kzalloc(sizeof(*cls), GFP_KERNEL);
245 if (!cls) {
246 retval = -ENOMEM;
247 goto error;
248 }
249
250 cls->name = name;
251 cls->owner = owner;
252 cls->class_release = class_create_release;
253
254 retval = __class_register(cls, key);
255 if (retval)
256 goto error;
257
258 return cls;
259
260error:
261 kfree(cls);
262 return ERR_PTR(retval);
263}
264EXPORT_SYMBOL_GPL(__class_create);
265
266
267
268
269
270
271
272
273void class_destroy(struct class *cls)
274{
275 if ((cls == NULL) || (IS_ERR(cls)))
276 return;
277
278 class_unregister(cls);
279}
280
281
282
283
284
285
286
287
288
289
290
291
292
293void class_dev_iter_init(struct class_dev_iter *iter, struct class *class,
294 struct device *start, const struct device_type *type)
295{
296 struct klist_node *start_knode = NULL;
297
298 if (start)
299 start_knode = &start->knode_class;
300 klist_iter_init_node(&class->p->klist_devices, &iter->ki, start_knode);
301 iter->type = type;
302}
303EXPORT_SYMBOL_GPL(class_dev_iter_init);
304
305
306
307
308
309
310
311
312
313
314
315
316
317struct device *class_dev_iter_next(struct class_dev_iter *iter)
318{
319 struct klist_node *knode;
320 struct device *dev;
321
322 while (1) {
323 knode = klist_next(&iter->ki);
324 if (!knode)
325 return NULL;
326 dev = container_of(knode, struct device, knode_class);
327 if (!iter->type || iter->type == dev->type)
328 return dev;
329 }
330}
331EXPORT_SYMBOL_GPL(class_dev_iter_next);
332
333
334
335
336
337
338
339
340void class_dev_iter_exit(struct class_dev_iter *iter)
341{
342 klist_iter_exit(&iter->ki);
343}
344EXPORT_SYMBOL_GPL(class_dev_iter_exit);
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364int class_for_each_device(struct class *class, struct device *start,
365 void *data, int (*fn)(struct device *, void *))
366{
367 struct class_dev_iter iter;
368 struct device *dev;
369 int error = 0;
370
371 if (!class)
372 return -EINVAL;
373 if (!class->p) {
374 WARN(1, "%s called for class '%s' before it was initialized",
375 __func__, class->name);
376 return -EINVAL;
377 }
378
379 class_dev_iter_init(&iter, class, start, NULL);
380 while ((dev = class_dev_iter_next(&iter))) {
381 error = fn(dev, data);
382 if (error)
383 break;
384 }
385 class_dev_iter_exit(&iter);
386
387 return error;
388}
389EXPORT_SYMBOL_GPL(class_for_each_device);
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411struct device *class_find_device(struct class *class, struct device *start,
412 const void *data,
413 int (*match)(struct device *, const void *))
414{
415 struct class_dev_iter iter;
416 struct device *dev;
417
418 if (!class)
419 return NULL;
420 if (!class->p) {
421 WARN(1, "%s called for class '%s' before it was initialized",
422 __func__, class->name);
423 return NULL;
424 }
425
426 class_dev_iter_init(&iter, class, start, NULL);
427 while ((dev = class_dev_iter_next(&iter))) {
428 if (match(dev, data)) {
429 get_device(dev);
430 break;
431 }
432 }
433 class_dev_iter_exit(&iter);
434
435 return dev;
436}
437EXPORT_SYMBOL_GPL(class_find_device);
438
439int class_interface_register(struct class_interface *class_intf)
440{
441 struct class *parent;
442 struct class_dev_iter iter;
443 struct device *dev;
444
445 if (!class_intf || !class_intf->class)
446 return -ENODEV;
447
448 parent = class_get(class_intf->class);
449 if (!parent)
450 return -EINVAL;
451
452 mutex_lock(&parent->p->mutex);
453 list_add_tail(&class_intf->node, &parent->p->interfaces);
454 if (class_intf->add_dev) {
455 class_dev_iter_init(&iter, parent, NULL, NULL);
456 while ((dev = class_dev_iter_next(&iter)))
457 class_intf->add_dev(dev, class_intf);
458 class_dev_iter_exit(&iter);
459 }
460 mutex_unlock(&parent->p->mutex);
461
462 return 0;
463}
464
465void class_interface_unregister(struct class_interface *class_intf)
466{
467 struct class *parent = class_intf->class;
468 struct class_dev_iter iter;
469 struct device *dev;
470
471 if (!parent)
472 return;
473
474 mutex_lock(&parent->p->mutex);
475 list_del_init(&class_intf->node);
476 if (class_intf->remove_dev) {
477 class_dev_iter_init(&iter, parent, NULL, NULL);
478 while ((dev = class_dev_iter_next(&iter)))
479 class_intf->remove_dev(dev, class_intf);
480 class_dev_iter_exit(&iter);
481 }
482 mutex_unlock(&parent->p->mutex);
483
484 class_put(parent);
485}
486
487ssize_t show_class_attr_string(struct class *class,
488 struct class_attribute *attr, char *buf)
489{
490 struct class_attribute_string *cs;
491 cs = container_of(attr, struct class_attribute_string, attr);
492 return snprintf(buf, PAGE_SIZE, "%s\n", cs->str);
493}
494
495EXPORT_SYMBOL_GPL(show_class_attr_string);
496
497struct class_compat {
498 struct kobject *kobj;
499};
500
501
502
503
504
505
506
507
508struct class_compat *class_compat_register(const char *name)
509{
510 struct class_compat *cls;
511
512 cls = kmalloc(sizeof(struct class_compat), GFP_KERNEL);
513 if (!cls)
514 return NULL;
515 cls->kobj = kobject_create_and_add(name, &class_kset->kobj);
516 if (!cls->kobj) {
517 kfree(cls);
518 return NULL;
519 }
520 return cls;
521}
522EXPORT_SYMBOL_GPL(class_compat_register);
523
524
525
526
527
528void class_compat_unregister(struct class_compat *cls)
529{
530 kobject_put(cls->kobj);
531 kfree(cls);
532}
533EXPORT_SYMBOL_GPL(class_compat_unregister);
534
535
536
537
538
539
540
541
542int class_compat_create_link(struct class_compat *cls, struct device *dev,
543 struct device *device_link)
544{
545 int error;
546
547 error = sysfs_create_link(cls->kobj, &dev->kobj, dev_name(dev));
548 if (error)
549 return error;
550
551
552
553
554
555
556 if (device_link) {
557 error = sysfs_create_link(&dev->kobj, &device_link->kobj,
558 "device");
559 if (error)
560 sysfs_remove_link(cls->kobj, dev_name(dev));
561 }
562
563 return error;
564}
565EXPORT_SYMBOL_GPL(class_compat_create_link);
566
567
568
569
570
571
572
573
574
575void class_compat_remove_link(struct class_compat *cls, struct device *dev,
576 struct device *device_link)
577{
578 if (device_link)
579 sysfs_remove_link(&dev->kobj, "device");
580 sysfs_remove_link(cls->kobj, dev_name(dev));
581}
582EXPORT_SYMBOL_GPL(class_compat_remove_link);
583
584int __init classes_init(void)
585{
586 class_kset = kset_create_and_add("class", NULL, NULL);
587 if (!class_kset)
588 return -ENOMEM;
589 return 0;
590}
591
592EXPORT_SYMBOL_GPL(class_create_file_ns);
593EXPORT_SYMBOL_GPL(class_remove_file_ns);
594EXPORT_SYMBOL_GPL(class_unregister);
595EXPORT_SYMBOL_GPL(class_destroy);
596
597EXPORT_SYMBOL_GPL(class_interface_register);
598EXPORT_SYMBOL_GPL(class_interface_unregister);
599