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