blob: b84ca8f13f9e1361d51b82a90f29cc525fb9c33e [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * attribute_container.c - implementation of a simple container for classes
3 *
4 * Copyright (c) 2005 - James Bottomley <James.Bottomley@steeleye.com>
5 *
6 * This file is licensed under GPLv2
7 *
8 * The basic idea here is to enable a device to be attached to an
9 * aritrary numer of classes without having to allocate storage for them.
10 * Instead, the contained classes select the devices they need to attach
11 * to via a matching function.
12 */
13
14#include <linux/attribute_container.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/device.h>
16#include <linux/kernel.h>
17#include <linux/slab.h>
18#include <linux/list.h>
19#include <linux/module.h>
Michael S. Tsirkinf8916c12007-06-10 22:39:12 +030020#include <linux/mutex.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021
Ben Dooksa1bdc7a2005-10-13 17:54:41 +010022#include "base.h"
23
Linus Torvalds1da177e2005-04-16 15:20:36 -070024/* This is a private structure used to tie the classdev and the
25 * container .. it should never be visible outside this file */
26struct internal_container {
James Bottomley53c165e2005-08-22 10:06:19 -050027 struct klist_node node;
Linus Torvalds1da177e2005-04-16 15:20:36 -070028 struct attribute_container *cont;
Tony Jonesee959b02008-02-22 00:13:36 +010029 struct device classdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -070030};
31
Linus Torvaldscaf39e82005-09-07 18:44:33 -070032static void internal_container_klist_get(struct klist_node *n)
33{
34 struct internal_container *ic =
35 container_of(n, struct internal_container, node);
Tony Jonesee959b02008-02-22 00:13:36 +010036 get_device(&ic->classdev);
Linus Torvaldscaf39e82005-09-07 18:44:33 -070037}
38
39static void internal_container_klist_put(struct klist_node *n)
40{
41 struct internal_container *ic =
42 container_of(n, struct internal_container, node);
Tony Jonesee959b02008-02-22 00:13:36 +010043 put_device(&ic->classdev);
Linus Torvaldscaf39e82005-09-07 18:44:33 -070044}
45
46
Linus Torvalds1da177e2005-04-16 15:20:36 -070047/**
48 * attribute_container_classdev_to_container - given a classdev, return the container
49 *
50 * @classdev: the class device created by attribute_container_add_device.
51 *
52 * Returns the container associated with this classdev.
53 */
54struct attribute_container *
Tony Jonesee959b02008-02-22 00:13:36 +010055attribute_container_classdev_to_container(struct device *classdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -070056{
57 struct internal_container *ic =
58 container_of(classdev, struct internal_container, classdev);
59 return ic->cont;
60}
61EXPORT_SYMBOL_GPL(attribute_container_classdev_to_container);
62
Denis Chengdb1118a2007-12-06 02:24:40 +080063static LIST_HEAD(attribute_container_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -070064
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -070065static DEFINE_MUTEX(attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
67/**
68 * attribute_container_register - register an attribute container
69 *
70 * @cont: The container to register. This must be allocated by the
71 * callee and should also be zeroed by it.
72 */
73int
74attribute_container_register(struct attribute_container *cont)
75{
76 INIT_LIST_HEAD(&cont->node);
Linus Torvaldscaf39e82005-09-07 18:44:33 -070077 klist_init(&cont->containers,internal_container_klist_get,
78 internal_container_klist_put);
Linus Torvalds1da177e2005-04-16 15:20:36 -070079
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -070080 mutex_lock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070081 list_add_tail(&cont->node, &attribute_container_list);
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -070082 mutex_unlock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070083
84 return 0;
85}
86EXPORT_SYMBOL_GPL(attribute_container_register);
87
88/**
89 * attribute_container_unregister - remove a container registration
90 *
91 * @cont: previously registered container to remove
92 */
93int
94attribute_container_unregister(struct attribute_container *cont)
95{
96 int retval = -EBUSY;
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -070097 mutex_lock(&attribute_container_mutex);
James Bottomley53c165e2005-08-22 10:06:19 -050098 spin_lock(&cont->containers.k_lock);
99 if (!list_empty(&cont->containers.k_list))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100 goto out;
101 retval = 0;
102 list_del(&cont->node);
103 out:
James Bottomley53c165e2005-08-22 10:06:19 -0500104 spin_unlock(&cont->containers.k_lock);
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700105 mutex_unlock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106 return retval;
107
108}
109EXPORT_SYMBOL_GPL(attribute_container_unregister);
110
111/* private function used as class release */
Tony Jonesee959b02008-02-22 00:13:36 +0100112static void attribute_container_release(struct device *classdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113{
114 struct internal_container *ic
115 = container_of(classdev, struct internal_container, classdev);
Tony Jonesee959b02008-02-22 00:13:36 +0100116 struct device *dev = classdev->parent;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117
118 kfree(ic);
119 put_device(dev);
120}
121
122/**
123 * attribute_container_add_device - see if any container is interested in dev
124 *
125 * @dev: device to add attributes to
126 * @fn: function to trigger addition of class device.
127 *
128 * This function allocates storage for the class device(s) to be
129 * attached to dev (one for each matching attribute_container). If no
130 * fn is provided, the code will simply register the class device via
Tony Jonesee959b02008-02-22 00:13:36 +0100131 * device_add. If a function is provided, it is expected to add
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132 * the class device at the appropriate time. One of the things that
133 * might be necessary is to allocate and initialise the classdev and
134 * then add it a later time. To do this, call this routine for
135 * allocation and initialisation and then use
Tony Jonesee959b02008-02-22 00:13:36 +0100136 * attribute_container_device_trigger() to call device_add() on
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 * it. Note: after this, the class device contains a reference to dev
138 * which is not relinquished until the release of the classdev.
139 */
140void
141attribute_container_add_device(struct device *dev,
142 int (*fn)(struct attribute_container *,
143 struct device *,
Tony Jonesee959b02008-02-22 00:13:36 +0100144 struct device *))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145{
146 struct attribute_container *cont;
147
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700148 mutex_lock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 list_for_each_entry(cont, &attribute_container_list, node) {
150 struct internal_container *ic;
151
152 if (attribute_container_no_classdevs(cont))
153 continue;
154
155 if (!cont->match(cont, dev))
156 continue;
Jiri Slaby4aed0642005-09-13 01:25:01 -0700157
158 ic = kzalloc(sizeof(*ic), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 if (!ic) {
Joe Perchesa369a7e2012-10-28 01:05:41 -0700160 dev_err(dev, "failed to allocate class container\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161 continue;
162 }
Jiri Slaby4aed0642005-09-13 01:25:01 -0700163
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164 ic->cont = cont;
Tony Jonesee959b02008-02-22 00:13:36 +0100165 device_initialize(&ic->classdev);
166 ic->classdev.parent = get_device(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167 ic->classdev.class = cont->class;
Tony Jonesee959b02008-02-22 00:13:36 +0100168 cont->class->dev_release = attribute_container_release;
Kees Cook02aa2a32013-07-03 15:04:56 -0700169 dev_set_name(&ic->classdev, "%s", dev_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 if (fn)
171 fn(cont, dev, &ic->classdev);
172 else
173 attribute_container_add_class_device(&ic->classdev);
James Bottomley53c165e2005-08-22 10:06:19 -0500174 klist_add_tail(&ic->node, &cont->containers);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175 }
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700176 mutex_unlock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177}
178
James Bottomley53c165e2005-08-22 10:06:19 -0500179/* FIXME: can't break out of this unless klist_iter_exit is also
180 * called before doing the break
181 */
182#define klist_for_each_entry(pos, head, member, iter) \
183 for (klist_iter_init(head, iter); (pos = ({ \
184 struct klist_node *n = klist_next(iter); \
Linus Torvaldscaf39e82005-09-07 18:44:33 -0700185 n ? container_of(n, typeof(*pos), member) : \
186 ({ klist_iter_exit(iter) ; NULL; }); \
James Bottomley53c165e2005-08-22 10:06:19 -0500187 }) ) != NULL; )
188
189
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190/**
191 * attribute_container_remove_device - make device eligible for removal.
192 *
193 * @dev: The generic device
194 * @fn: A function to call to remove the device
195 *
196 * This routine triggers device removal. If fn is NULL, then it is
Tony Jonesee959b02008-02-22 00:13:36 +0100197 * simply done via device_unregister (note that if something
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 * still has a reference to the classdev, then the memory occupied
199 * will not be freed until the classdev is released). If you want a
200 * two phase release: remove from visibility and then delete the
201 * device, then you should use this routine with a fn that calls
Tony Jonesee959b02008-02-22 00:13:36 +0100202 * device_del() and then use attribute_container_device_trigger()
203 * to do the final put on the classdev.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204 */
205void
206attribute_container_remove_device(struct device *dev,
207 void (*fn)(struct attribute_container *,
208 struct device *,
Tony Jonesee959b02008-02-22 00:13:36 +0100209 struct device *))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210{
211 struct attribute_container *cont;
212
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700213 mutex_lock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214 list_for_each_entry(cont, &attribute_container_list, node) {
James Bottomley53c165e2005-08-22 10:06:19 -0500215 struct internal_container *ic;
216 struct klist_iter iter;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217
218 if (attribute_container_no_classdevs(cont))
219 continue;
220
221 if (!cont->match(cont, dev))
222 continue;
James Bottomley53c165e2005-08-22 10:06:19 -0500223
224 klist_for_each_entry(ic, &cont->containers, node, &iter) {
Tony Jonesee959b02008-02-22 00:13:36 +0100225 if (dev != ic->classdev.parent)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226 continue;
Linus Torvaldscaf39e82005-09-07 18:44:33 -0700227 klist_del(&ic->node);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 if (fn)
229 fn(cont, dev, &ic->classdev);
230 else {
231 attribute_container_remove_attrs(&ic->classdev);
Tony Jonesee959b02008-02-22 00:13:36 +0100232 device_unregister(&ic->classdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700233 }
234 }
235 }
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700236 mutex_unlock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238
239/**
240 * attribute_container_device_trigger - execute a trigger for each matching classdev
241 *
242 * @dev: The generic device to run the trigger for
243 * @fn the function to execute for each classdev.
244 *
245 * This funcion is for executing a trigger when you need to know both
246 * the container and the classdev. If you only care about the
247 * container, then use attribute_container_trigger() instead.
248 */
249void
250attribute_container_device_trigger(struct device *dev,
251 int (*fn)(struct attribute_container *,
252 struct device *,
Tony Jonesee959b02008-02-22 00:13:36 +0100253 struct device *))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254{
255 struct attribute_container *cont;
256
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700257 mutex_lock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700258 list_for_each_entry(cont, &attribute_container_list, node) {
James Bottomley53c165e2005-08-22 10:06:19 -0500259 struct internal_container *ic;
260 struct klist_iter iter;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261
262 if (!cont->match(cont, dev))
263 continue;
264
James Bottomleyebd8bb72005-08-15 16:13:19 -0500265 if (attribute_container_no_classdevs(cont)) {
266 fn(cont, dev, NULL);
267 continue;
268 }
269
James Bottomley53c165e2005-08-22 10:06:19 -0500270 klist_for_each_entry(ic, &cont->containers, node, &iter) {
Tony Jonesee959b02008-02-22 00:13:36 +0100271 if (dev == ic->classdev.parent)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 fn(cont, dev, &ic->classdev);
273 }
274 }
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700275 mutex_unlock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277
278/**
279 * attribute_container_trigger - trigger a function for each matching container
280 *
281 * @dev: The generic device to activate the trigger for
282 * @fn: the function to trigger
283 *
284 * This routine triggers a function that only needs to know the
285 * matching containers (not the classdev) associated with a device.
286 * It is more lightweight than attribute_container_device_trigger, so
287 * should be used in preference unless the triggering function
288 * actually needs to know the classdev.
289 */
290void
291attribute_container_trigger(struct device *dev,
292 int (*fn)(struct attribute_container *,
293 struct device *))
294{
295 struct attribute_container *cont;
296
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700297 mutex_lock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 list_for_each_entry(cont, &attribute_container_list, node) {
299 if (cont->match(cont, dev))
300 fn(cont, dev);
301 }
Matthias Kaehlcke61a2f592007-04-26 00:12:09 -0700302 mutex_unlock(&attribute_container_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304
305/**
306 * attribute_container_add_attrs - add attributes
307 *
308 * @classdev: The class device
309 *
310 * This simply creates all the class device sysfs files from the
311 * attributes listed in the container
312 */
313int
Tony Jonesee959b02008-02-22 00:13:36 +0100314attribute_container_add_attrs(struct device *classdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315{
316 struct attribute_container *cont =
317 attribute_container_classdev_to_container(classdev);
Tony Jonesee959b02008-02-22 00:13:36 +0100318 struct device_attribute **attrs = cont->attrs;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319 int i, error;
320
James Bottomleyfd110972008-01-02 18:48:47 -0600321 BUG_ON(attrs && cont->grp);
322
323 if (!attrs && !cont->grp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 return 0;
325
James Bottomleyfd110972008-01-02 18:48:47 -0600326 if (cont->grp)
327 return sysfs_create_group(&classdev->kobj, cont->grp);
328
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 for (i = 0; attrs[i]; i++) {
James Bottomleyebd09ec2010-03-20 12:44:12 -0500330 sysfs_attr_init(&attrs[i]->attr);
Tony Jonesee959b02008-02-22 00:13:36 +0100331 error = device_create_file(classdev, attrs[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700332 if (error)
333 return error;
334 }
335
336 return 0;
337}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700338
339/**
Tony Jonesee959b02008-02-22 00:13:36 +0100340 * attribute_container_add_class_device - same function as device_add
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341 *
342 * @classdev: the class device to add
343 *
Tony Jonesee959b02008-02-22 00:13:36 +0100344 * This performs essentially the same function as device_add except for
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 * attribute containers, namely add the classdev to the system and then
346 * create the attribute files
347 */
348int
Tony Jonesee959b02008-02-22 00:13:36 +0100349attribute_container_add_class_device(struct device *classdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700350{
Tony Jonesee959b02008-02-22 00:13:36 +0100351 int error = device_add(classdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352 if (error)
353 return error;
354 return attribute_container_add_attrs(classdev);
355}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356
357/**
358 * attribute_container_add_class_device_adapter - simple adapter for triggers
359 *
360 * This function is identical to attribute_container_add_class_device except
361 * that it is designed to be called from the triggers
362 */
363int
364attribute_container_add_class_device_adapter(struct attribute_container *cont,
365 struct device *dev,
Tony Jonesee959b02008-02-22 00:13:36 +0100366 struct device *classdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367{
368 return attribute_container_add_class_device(classdev);
369}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370
371/**
372 * attribute_container_remove_attrs - remove any attribute files
373 *
374 * @classdev: The class device to remove the files from
375 *
376 */
377void
Tony Jonesee959b02008-02-22 00:13:36 +0100378attribute_container_remove_attrs(struct device *classdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379{
380 struct attribute_container *cont =
381 attribute_container_classdev_to_container(classdev);
Tony Jonesee959b02008-02-22 00:13:36 +0100382 struct device_attribute **attrs = cont->attrs;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383 int i;
384
James Bottomleyfd110972008-01-02 18:48:47 -0600385 if (!attrs && !cont->grp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386 return;
387
James Bottomleyfd110972008-01-02 18:48:47 -0600388 if (cont->grp) {
389 sysfs_remove_group(&classdev->kobj, cont->grp);
390 return ;
391 }
392
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393 for (i = 0; attrs[i]; i++)
Tony Jonesee959b02008-02-22 00:13:36 +0100394 device_remove_file(classdev, attrs[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
397/**
398 * attribute_container_class_device_del - equivalent of class_device_del
399 *
400 * @classdev: the class device
401 *
402 * This function simply removes all the attribute files and then calls
Tony Jonesee959b02008-02-22 00:13:36 +0100403 * device_del.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 */
405void
Tony Jonesee959b02008-02-22 00:13:36 +0100406attribute_container_class_device_del(struct device *classdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407{
408 attribute_container_remove_attrs(classdev);
Tony Jonesee959b02008-02-22 00:13:36 +0100409 device_del(classdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411
James Bottomleyd0a7e572005-08-14 17:09:01 -0500412/**
413 * attribute_container_find_class_device - find the corresponding class_device
414 *
415 * @cont: the container
416 * @dev: the generic device
417 *
418 * Looks up the device in the container's list of class devices and returns
419 * the corresponding class_device.
420 */
Tony Jonesee959b02008-02-22 00:13:36 +0100421struct device *
James Bottomleyd0a7e572005-08-14 17:09:01 -0500422attribute_container_find_class_device(struct attribute_container *cont,
423 struct device *dev)
424{
Tony Jonesee959b02008-02-22 00:13:36 +0100425 struct device *cdev = NULL;
James Bottomleyd0a7e572005-08-14 17:09:01 -0500426 struct internal_container *ic;
James Bottomley53c165e2005-08-22 10:06:19 -0500427 struct klist_iter iter;
James Bottomleyd0a7e572005-08-14 17:09:01 -0500428
James Bottomley53c165e2005-08-22 10:06:19 -0500429 klist_for_each_entry(ic, &cont->containers, node, &iter) {
Tony Jonesee959b02008-02-22 00:13:36 +0100430 if (ic->classdev.parent == dev) {
James Bottomleyd0a7e572005-08-14 17:09:01 -0500431 cdev = &ic->classdev;
James Bottomley53c165e2005-08-22 10:06:19 -0500432 /* FIXME: must exit iterator then break */
433 klist_iter_exit(&iter);
James Bottomleyd0a7e572005-08-14 17:09:01 -0500434 break;
435 }
436 }
James Bottomleyd0a7e572005-08-14 17:09:01 -0500437
438 return cdev;
439}
440EXPORT_SYMBOL_GPL(attribute_container_find_class_device);