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