1
2
3
4
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
18struct iio_sysfs_trig {
19 struct iio_trigger *trig;
20 struct irq_work work;
21 int id;
22 struct list_head l;
23};
24
25static LIST_HEAD(iio_sysfs_trig_list);
26static DEFINE_MUTEX(iio_sysfs_trig_list_mut);
27
28static int iio_sysfs_trigger_probe(int id);
29static 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 = kstrtoul(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}
45static DEVICE_ATTR(add_trigger, S_IWUSR, NULL, &iio_sysfs_trig_add);
46
47static int iio_sysfs_trigger_remove(int id);
48static 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 = kstrtoul(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
65static DEVICE_ATTR(remove_trigger, S_IWUSR, NULL, &iio_sysfs_trig_remove);
66
67static struct attribute *iio_sysfs_trig_attrs[] = {
68 &dev_attr_add_trigger.attr,
69 &dev_attr_remove_trigger.attr,
70 NULL,
71};
72
73static const struct attribute_group iio_sysfs_trig_group = {
74 .attrs = iio_sysfs_trig_attrs,
75};
76
77static const struct attribute_group *iio_sysfs_trig_groups[] = {
78 &iio_sysfs_trig_group,
79 NULL
80};
81
82
83
84static void iio_trigger_sysfs_release(struct device *dev)
85{
86}
87
88static 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
94static 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);
100}
101
102static 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 = iio_trigger_get_drvdata(trig);
107
108 irq_work_queue(&sysfs_trig->work);
109
110 return count;
111}
112
113static DEVICE_ATTR(trigger_now, S_IWUSR, NULL, iio_sysfs_trigger_poll);
114
115static struct attribute *iio_sysfs_trigger_attrs[] = {
116 &dev_attr_trigger_now.attr,
117 NULL,
118};
119
120static const struct attribute_group iio_sysfs_trigger_attr_group = {
121 .attrs = iio_sysfs_trigger_attrs,
122};
123
124static const struct attribute_group *iio_sysfs_trigger_attr_groups[] = {
125 &iio_sysfs_trigger_attr_group,
126 NULL
127};
128
129static const struct iio_trigger_ops iio_sysfs_trigger_ops = {
130 .owner = THIS_MODULE,
131};
132
133static int iio_sysfs_trigger_probe(int id)
134{
135 struct iio_sysfs_trig *t;
136 int ret;
137 bool foundit = false;
138
139 mutex_lock(&iio_sysfs_trig_list_mut);
140 list_for_each_entry(t, &iio_sysfs_trig_list, l)
141 if (id == t->id) {
142 foundit = true;
143 break;
144 }
145 if (foundit) {
146 ret = -EINVAL;
147 goto out1;
148 }
149 t = kmalloc(sizeof(*t), GFP_KERNEL);
150 if (t == NULL) {
151 ret = -ENOMEM;
152 goto out1;
153 }
154 t->id = id;
155 t->trig = iio_trigger_alloc("sysfstrig%d", id);
156 if (!t->trig) {
157 ret = -ENOMEM;
158 goto free_t;
159 }
160
161 t->trig->dev.groups = iio_sysfs_trigger_attr_groups;
162 t->trig->ops = &iio_sysfs_trigger_ops;
163 t->trig->dev.parent = &iio_sysfs_trig_dev;
164 iio_trigger_set_drvdata(t->trig, t);
165
166 init_irq_work(&t->work, iio_sysfs_trigger_work);
167
168 ret = iio_trigger_register(t->trig);
169 if (ret)
170 goto out2;
171 list_add(&t->l, &iio_sysfs_trig_list);
172 __module_get(THIS_MODULE);
173 mutex_unlock(&iio_sysfs_trig_list_mut);
174 return 0;
175
176out2:
177 iio_trigger_put(t->trig);
178free_t:
179 kfree(t);
180out1:
181 mutex_unlock(&iio_sysfs_trig_list_mut);
182 return ret;
183}
184
185static int iio_sysfs_trigger_remove(int id)
186{
187 bool foundit = false;
188 struct iio_sysfs_trig *t;
189
190 mutex_lock(&iio_sysfs_trig_list_mut);
191 list_for_each_entry(t, &iio_sysfs_trig_list, l)
192 if (id == t->id) {
193 foundit = true;
194 break;
195 }
196 if (!foundit) {
197 mutex_unlock(&iio_sysfs_trig_list_mut);
198 return -EINVAL;
199 }
200
201 iio_trigger_unregister(t->trig);
202 iio_trigger_free(t->trig);
203
204 list_del(&t->l);
205 kfree(t);
206 module_put(THIS_MODULE);
207 mutex_unlock(&iio_sysfs_trig_list_mut);
208 return 0;
209}
210
211
212static int __init iio_sysfs_trig_init(void)
213{
214 device_initialize(&iio_sysfs_trig_dev);
215 dev_set_name(&iio_sysfs_trig_dev, "iio_sysfs_trigger");
216 return device_add(&iio_sysfs_trig_dev);
217}
218module_init(iio_sysfs_trig_init);
219
220static void __exit iio_sysfs_trig_exit(void)
221{
222 device_unregister(&iio_sysfs_trig_dev);
223}
224module_exit(iio_sysfs_trig_exit);
225
226MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
227MODULE_DESCRIPTION("Sysfs based trigger for the iio subsystem");
228MODULE_LICENSE("GPL v2");
229MODULE_ALIAS("platform:iio-trig-sysfs");
230
