Linux 3.9-rc5
[deliverable/linux.git] / drivers / staging / iio / trigger / iio-trig-sysfs.c
1 /*
2 * Copyright 2011 Analog Devices Inc.
3 *
4 * Licensed under the GPL-2.
5 *
6 */
7
8 #include <linux/kernel.h>
9 #include <linux/module.h>
10 #include <linux/platform_device.h>
11 #include <linux/slab.h>
12 #include <linux/list.h>
13 #include <linux/irq_work.h>
14
15 #include <linux/iio/iio.h>
16 #include <linux/iio/trigger.h>
17
18 struct iio_sysfs_trig {
19 struct iio_trigger *trig;
20 struct irq_work work;
21 int id;
22 struct list_head l;
23 };
24
25 static LIST_HEAD(iio_sysfs_trig_list);
26 static DEFINE_MUTEX(iio_syfs_trig_list_mut);
27
28 static int iio_sysfs_trigger_probe(int id);
29 static ssize_t iio_sysfs_trig_add(struct device *dev,
30 struct device_attribute *attr,
31 const char *buf,
32 size_t len)
33 {
34 int ret;
35 unsigned long input;
36
37 ret = strict_strtoul(buf, 10, &input);
38 if (ret)
39 return ret;
40 ret = iio_sysfs_trigger_probe(input);
41 if (ret)
42 return ret;
43 return len;
44 }
45 static DEVICE_ATTR(add_trigger, S_IWUSR, NULL, &iio_sysfs_trig_add);
46
47 static int iio_sysfs_trigger_remove(int id);
48 static ssize_t iio_sysfs_trig_remove(struct device *dev,
49 struct device_attribute *attr,
50 const char *buf,
51 size_t len)
52 {
53 int ret;
54 unsigned long input;
55
56 ret = strict_strtoul(buf, 10, &input);
57 if (ret)
58 return ret;
59 ret = iio_sysfs_trigger_remove(input);
60 if (ret)
61 return ret;
62 return len;
63 }
64
65 static DEVICE_ATTR(remove_trigger, S_IWUSR, NULL, &iio_sysfs_trig_remove);
66
67 static struct attribute *iio_sysfs_trig_attrs[] = {
68 &dev_attr_add_trigger.attr,
69 &dev_attr_remove_trigger.attr,
70 NULL,
71 };
72
73 static const struct attribute_group iio_sysfs_trig_group = {
74 .attrs = iio_sysfs_trig_attrs,
75 };
76
77 static const struct attribute_group *iio_sysfs_trig_groups[] = {
78 &iio_sysfs_trig_group,
79 NULL
80 };
81
82
83 /* Nothing to actually do upon release */
84 static void iio_trigger_sysfs_release(struct device *dev)
85 {
86 }
87
88 static struct device iio_sysfs_trig_dev = {
89 .bus = &iio_bus_type,
90 .groups = iio_sysfs_trig_groups,
91 .release = &iio_trigger_sysfs_release,
92 };
93
94 static void iio_sysfs_trigger_work(struct irq_work *work)
95 {
96 struct iio_sysfs_trig *trig = container_of(work, struct iio_sysfs_trig,
97 work);
98
99 iio_trigger_poll(trig->trig, 0);
100 }
101
102 static ssize_t iio_sysfs_trigger_poll(struct device *dev,
103 struct device_attribute *attr, const char *buf, size_t count)
104 {
105 struct iio_trigger *trig = to_iio_trigger(dev);
106 struct iio_sysfs_trig *sysfs_trig = trig->private_data;
107
108 irq_work_queue(&sysfs_trig->work);
109
110 return count;
111 }
112
113 static DEVICE_ATTR(trigger_now, S_IWUSR, NULL, iio_sysfs_trigger_poll);
114
115 static struct attribute *iio_sysfs_trigger_attrs[] = {
116 &dev_attr_trigger_now.attr,
117 NULL,
118 };
119
120 static const struct attribute_group iio_sysfs_trigger_attr_group = {
121 .attrs = iio_sysfs_trigger_attrs,
122 };
123
124 static const struct attribute_group *iio_sysfs_trigger_attr_groups[] = {
125 &iio_sysfs_trigger_attr_group,
126 NULL
127 };
128
129 static const struct iio_trigger_ops iio_sysfs_trigger_ops = {
130 .owner = THIS_MODULE,
131 };
132
133 static int iio_sysfs_trigger_probe(int id)
134 {
135 struct iio_sysfs_trig *t;
136 int ret;
137 bool foundit = false;
138 mutex_lock(&iio_syfs_trig_list_mut);
139 list_for_each_entry(t, &iio_sysfs_trig_list, l)
140 if (id == t->id) {
141 foundit = true;
142 break;
143 }
144 if (foundit) {
145 ret = -EINVAL;
146 goto out1;
147 }
148 t = kmalloc(sizeof(*t), GFP_KERNEL);
149 if (t == NULL) {
150 ret = -ENOMEM;
151 goto out1;
152 }
153 t->id = id;
154 t->trig = iio_trigger_alloc("sysfstrig%d", id);
155 if (!t->trig) {
156 ret = -ENOMEM;
157 goto free_t;
158 }
159
160 t->trig->dev.groups = iio_sysfs_trigger_attr_groups;
161 t->trig->ops = &iio_sysfs_trigger_ops;
162 t->trig->dev.parent = &iio_sysfs_trig_dev;
163 t->trig->private_data = t;
164
165 init_irq_work(&t->work, iio_sysfs_trigger_work);
166
167 ret = iio_trigger_register(t->trig);
168 if (ret)
169 goto out2;
170 list_add(&t->l, &iio_sysfs_trig_list);
171 __module_get(THIS_MODULE);
172 mutex_unlock(&iio_syfs_trig_list_mut);
173 return 0;
174
175 out2:
176 iio_trigger_put(t->trig);
177 free_t:
178 kfree(t);
179 out1:
180 mutex_unlock(&iio_syfs_trig_list_mut);
181 return ret;
182 }
183
184 static int iio_sysfs_trigger_remove(int id)
185 {
186 bool foundit = false;
187 struct iio_sysfs_trig *t;
188 mutex_lock(&iio_syfs_trig_list_mut);
189 list_for_each_entry(t, &iio_sysfs_trig_list, l)
190 if (id == t->id) {
191 foundit = true;
192 break;
193 }
194 if (!foundit) {
195 mutex_unlock(&iio_syfs_trig_list_mut);
196 return -EINVAL;
197 }
198
199 iio_trigger_unregister(t->trig);
200 iio_trigger_free(t->trig);
201
202 list_del(&t->l);
203 kfree(t);
204 module_put(THIS_MODULE);
205 mutex_unlock(&iio_syfs_trig_list_mut);
206 return 0;
207 }
208
209
210 static int __init iio_sysfs_trig_init(void)
211 {
212 device_initialize(&iio_sysfs_trig_dev);
213 dev_set_name(&iio_sysfs_trig_dev, "iio_sysfs_trigger");
214 return device_add(&iio_sysfs_trig_dev);
215 }
216 module_init(iio_sysfs_trig_init);
217
218 static void __exit iio_sysfs_trig_exit(void)
219 {
220 device_unregister(&iio_sysfs_trig_dev);
221 }
222 module_exit(iio_sysfs_trig_exit);
223
224 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
225 MODULE_DESCRIPTION("Sysfs based trigger for the iio subsystem");
226 MODULE_LICENSE("GPL v2");
227 MODULE_ALIAS("platform:iio-trig-sysfs");
This page took 0.06766 seconds and 5 git commands to generate.