1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/attribute_container.h>
15#include <linux/init.h>
16#include <linux/device.h>
17#include <linux/kernel.h>
18#include <linux/slab.h>
19#include <linux/list.h>
20#include <linux/module.h>
21
22
23
24struct internal_container {
25 struct list_head node;
26 struct attribute_container *cont;
27 struct class_device classdev;
28};
29
30
31
32
33
34
35
36
37struct attribute_container *
38attribute_container_classdev_to_container(struct class_device *classdev)
39{
40 struct internal_container *ic =
41 container_of(classdev, struct internal_container, classdev);
42 return ic->cont;
43}
44EXPORT_SYMBOL_GPL(attribute_container_classdev_to_container);
45
46static struct list_head attribute_container_list;
47
48static DECLARE_MUTEX(attribute_container_mutex);
49
50
51
52
53
54
55
56int
57attribute_container_register(struct attribute_container *cont)
58{
59 INIT_LIST_HEAD(&cont->node);
60 INIT_LIST_HEAD(&cont->containers);
61
62 down(&attribute_container_mutex);
63 list_add_tail(&cont->node, &attribute_container_list);
64 up(&attribute_container_mutex);
65
66 return 0;
67}
68EXPORT_SYMBOL_GPL(attribute_container_register);
69
70
71
72
73
74
75int
76attribute_container_unregister(struct attribute_container *cont)
77{
78 int retval = -EBUSY;
79 down(&attribute_container_mutex);
80 if (!list_empty(&cont->containers))
81 goto out;
82 retval = 0;
83 list_del(&cont->node);
84 out:
85 up(&attribute_container_mutex);
86 return retval;
87
88}
89EXPORT_SYMBOL_GPL(attribute_container_unregister);
90
91
92static void attribute_container_release(struct class_device *classdev)
93{
94 struct internal_container *ic
95 = container_of(classdev, struct internal_container, classdev);
96 struct device *dev = classdev->dev;
97
98 kfree(ic);
99 put_device(dev);
100}
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120void
121attribute_container_add_device(struct device *dev,
122 int (*fn)(struct attribute_container *,
123 struct device *,
124 struct class_device *))
125{
126 struct attribute_container *cont;
127
128 down(&attribute_container_mutex);
129 list_for_each_entry(cont, &attribute_container_list, node) {
130 struct internal_container *ic;
131
132 if (attribute_container_no_classdevs(cont))
133 continue;
134
135 if (!cont->match(cont, dev))
136 continue;
137 ic = kmalloc(sizeof(struct internal_container), GFP_KERNEL);
138 if (!ic) {
139 dev_printk(KERN_ERR, dev, "failed to allocate class container\n");
140 continue;
141 }
142 memset(ic, 0, sizeof(struct internal_container));
143 INIT_LIST_HEAD(&ic->node);
144 ic->cont = cont;
145 class_device_initialize(&ic->classdev);
146 ic->classdev.dev = get_device(dev);
147 ic->classdev.class = cont->class;
148 cont->class->release = attribute_container_release;
149 strcpy(ic->classdev.class_id, dev->bus_id);
150 if (fn)
151 fn(cont, dev, &ic->classdev);
152 else
153 attribute_container_add_class_device(&ic->classdev);
154 list_add_tail(&ic->node, &cont->containers);
155 }
156 up(&attribute_container_mutex);
157}
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175void
176attribute_container_remove_device(struct device *dev,
177 void (*fn)(struct attribute_container *,
178 struct device *,
179 struct class_device *))
180{
181 struct attribute_container *cont;
182
183 down(&attribute_container_mutex);
184 list_for_each_entry(cont, &attribute_container_list, node) {
185 struct internal_container *ic, *tmp;
186
187 if (attribute_container_no_classdevs(cont))
188 continue;
189
190 if (!cont->match(cont, dev))
191 continue;
192 list_for_each_entry_safe(ic, tmp, &cont->containers, node) {
193 if (dev != ic->classdev.dev)
194 continue;
195 list_del(&ic->node);
196 if (fn)
197 fn(cont, dev, &ic->classdev);
198 else {
199 attribute_container_remove_attrs(&ic->classdev);
200 class_device_unregister(&ic->classdev);
201 }
202 }
203 }
204 up(&attribute_container_mutex);
205}
206EXPORT_SYMBOL_GPL(attribute_container_remove_device);
207
208
209
210
211
212
213
214
215
216
217
218void
219attribute_container_device_trigger(struct device *dev,
220 int (*fn)(struct attribute_container *,
221 struct device *,
222 struct class_device *))
223{
224 struct attribute_container *cont;
225
226 down(&attribute_container_mutex);
227 list_for_each_entry(cont, &attribute_container_list, node) {
228 struct internal_container *ic, *tmp;
229
230 if (!cont->match(cont, dev))
231 continue;
232
233 list_for_each_entry_safe(ic, tmp, &cont->containers, node) {
234 if (dev == ic->classdev.dev)
235 fn(cont, dev, &ic->classdev);
236 }
237 }
238 up(&attribute_container_mutex);
239}
240EXPORT_SYMBOL_GPL(attribute_container_device_trigger);
241
242
243
244
245
246
247
248
249
250
251
252
253
254void
255attribute_container_trigger(struct device *dev,
256 int (*fn)(struct attribute_container *,
257 struct device *))
258{
259 struct attribute_container *cont;
260
261 down(&attribute_container_mutex);
262 list_for_each_entry(cont, &attribute_container_list, node) {
263 if (cont->match(cont, dev))
264 fn(cont, dev);
265 }
266 up(&attribute_container_mutex);
267}
268EXPORT_SYMBOL_GPL(attribute_container_trigger);
269
270
271
272
273
274
275
276
277
278int
279attribute_container_add_attrs(struct class_device *classdev)
280{
281 struct attribute_container *cont =
282 attribute_container_classdev_to_container(classdev);
283 struct class_device_attribute **attrs = cont->attrs;
284 int i, error;
285
286 if (!attrs)
287 return 0;
288
289 for (i = 0; attrs[i]; i++) {
290 error = class_device_create_file(classdev, attrs[i]);
291 if (error)
292 return error;
293 }
294
295 return 0;
296}
297EXPORT_SYMBOL_GPL(attribute_container_add_attrs);
298
299
300
301
302
303
304
305
306
307
308int
309attribute_container_add_class_device(struct class_device *classdev)
310{
311 int error = class_device_add(classdev);
312 if (error)
313 return error;
314 return attribute_container_add_attrs(classdev);
315}
316EXPORT_SYMBOL_GPL(attribute_container_add_class_device);
317
318
319
320
321
322
323
324int
325attribute_container_add_class_device_adapter(struct attribute_container *cont,
326 struct device *dev,
327 struct class_device *classdev)
328{
329 return attribute_container_add_class_device(classdev);
330}
331EXPORT_SYMBOL_GPL(attribute_container_add_class_device_adapter);
332
333
334
335
336
337
338
339void
340attribute_container_remove_attrs(struct class_device *classdev)
341{
342 struct attribute_container *cont =
343 attribute_container_classdev_to_container(classdev);
344 struct class_device_attribute **attrs = cont->attrs;
345 int i;
346
347 if (!attrs)
348 return;
349
350 for (i = 0; attrs[i]; i++)
351 class_device_remove_file(classdev, attrs[i]);
352}
353EXPORT_SYMBOL_GPL(attribute_container_remove_attrs);
354
355
356
357
358
359
360
361
362
363void
364attribute_container_class_device_del(struct class_device *classdev)
365{
366 attribute_container_remove_attrs(classdev);
367 class_device_del(classdev);
368}
369EXPORT_SYMBOL_GPL(attribute_container_class_device_del);
370
371int __init
372attribute_container_init(void)
373{
374 INIT_LIST_HEAD(&attribute_container_list);
375 return 0;
376}
377