1 #include <linux/interrupt.h>
3 #include <linux/mutex.h>
4 #include <linux/device.h>
5 #include <linux/kernel.h>
6 #include <linux/sysfs.h>
7 #include <linux/list.h>
8 #include <linux/spi/spi.h>
12 #include "../trigger.h"
13 #include "adis16300.h"
16 * adis16300_data_rdy_trig_poll() the event handler for the data rdy trig
18 static int adis16300_data_rdy_trig_poll(struct iio_dev *dev_info,
23 struct adis16300_state *st = iio_dev_get_devdata(dev_info);
24 struct iio_trigger *trig = st->trig;
26 trig->timestamp = timestamp;
27 iio_trigger_poll(trig);
32 IIO_EVENT_SH(data_rdy_trig, &adis16300_data_rdy_trig_poll);
34 static DEVICE_ATTR(name, S_IRUGO, iio_trigger_read_name, NULL);
36 static struct attribute *adis16300_trigger_attrs[] = {
41 static const struct attribute_group adis16300_trigger_attr_group = {
42 .attrs = adis16300_trigger_attrs,
46 * adis16300_data_rdy_trigger_set_state() set datardy interrupt state
48 static int adis16300_data_rdy_trigger_set_state(struct iio_trigger *trig,
51 struct adis16300_state *st = trig->private_data;
52 struct iio_dev *indio_dev = st->indio_dev;
55 dev_dbg(&indio_dev->dev, "%s (%d)\n", __func__, state);
56 ret = adis16300_set_irq(&st->indio_dev->dev, state);
58 iio_remove_event_from_list(&iio_event_data_rdy_trig,
59 &indio_dev->interrupts[0]
61 /* possible quirk with handler currently worked around
62 by ensuring the work queue is empty */
63 flush_scheduled_work();
65 iio_add_event_to_list(&iio_event_data_rdy_trig,
66 &indio_dev->interrupts[0]->ev_list);
72 * adis16300_trig_try_reen() try renabling irq for data rdy trigger
73 * @trig: the datardy trigger
75 static int adis16300_trig_try_reen(struct iio_trigger *trig)
77 struct adis16300_state *st = trig->private_data;
78 enable_irq(st->us->irq);
79 /* irq reenabled so success! */
83 int adis16300_probe_trigger(struct iio_dev *indio_dev)
86 struct adis16300_state *st = indio_dev->dev_data;
88 st->trig = iio_allocate_trigger();
89 st->trig->name = kmalloc(IIO_TRIGGER_NAME_LENGTH, GFP_KERNEL);
90 if (!st->trig->name) {
94 snprintf((char *)st->trig->name,
95 IIO_TRIGGER_NAME_LENGTH,
96 "adis16300-dev%d", indio_dev->id);
97 st->trig->dev.parent = &st->us->dev;
98 st->trig->owner = THIS_MODULE;
99 st->trig->private_data = st;
100 st->trig->set_trigger_state = &adis16300_data_rdy_trigger_set_state;
101 st->trig->try_reenable = &adis16300_trig_try_reen;
102 st->trig->control_attrs = &adis16300_trigger_attr_group;
103 ret = iio_trigger_register(st->trig);
105 /* select default trigger */
106 indio_dev->trig = st->trig;
108 goto error_free_trig_name;
112 error_free_trig_name:
113 kfree(st->trig->name);
115 iio_free_trigger(st->trig);
120 void adis16300_remove_trigger(struct iio_dev *indio_dev)
122 struct adis16300_state *state = indio_dev->dev_data;
124 iio_trigger_unregister(state->trig);
125 kfree(state->trig->name);
126 iio_free_trigger(state->trig);