1 files changed, 74 insertions, 0 deletions

diff --git a/drivers/staging/iio/accel/adis16204_trigger.c b/drivers/staging/iio/accel/adis16204_trigger.c
new file mode 100644
index 00000000000..01f73b9b888
--- /dev/null
+++ b/drivers/staging/iio/accel/adis16204_trigger.c
@@ -0,0 +1,74 @@
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/mutex.h>
+#include <linux/device.h>
+#include <linux/kernel.h>
+#include <linux/sysfs.h>
+#include <linux/list.h>
+#include <linux/spi/spi.h>
+
+#include "../iio.h"
+#include "../sysfs.h"
+#include "../trigger.h"
+#include "adis16204.h"
+
+/**
+ * adis16204_data_rdy_trigger_set_state() set datardy interrupt state
+ **/
+static int adis16204_data_rdy_trigger_set_state(struct iio_trigger *trig,
+                                                bool state)
+{
+        struct iio_dev *indio_dev = trig->private_data;
+
+        dev_dbg(&indio_dev->dev, "%s (%d)\n", __func__, state);
+        return adis16204_set_irq(indio_dev, state);
+}
+
+int adis16204_probe_trigger(struct iio_dev *indio_dev)
+{
+        int ret;
+        struct adis16204_state *st = iio_priv(indio_dev);
+
+        st->trig = iio_allocate_trigger("adis16204-dev%d", indio_dev->id);
+        if (st->trig == NULL) {
+                ret = -ENOMEM;
+                goto error_ret;
+        }
+
+        ret = request_irq(st->us->irq,
+                          &iio_trigger_generic_data_rdy_poll,
+                          IRQF_TRIGGER_RISING,
+                          "adis16204",
+                          st->trig);
+        if (ret)
+                goto error_free_trig;
+
+        st->trig->dev.parent = &st->us->dev;
+        st->trig->owner = THIS_MODULE;
+        st->trig->private_data = indio_dev;
+        st->trig->set_trigger_state = &adis16204_data_rdy_trigger_set_state;
+        ret = iio_trigger_register(st->trig);
+
+        /* select default trigger */
+        indio_dev->trig = st->trig;
+        if (ret)
+                goto error_free_irq;
+
+        return 0;
+
+error_free_irq:
+        free_irq(st->us->irq, st->trig);
+error_free_trig:
+        iio_free_trigger(st->trig);
+error_ret:
+        return ret;
+}
+
+void adis16204_remove_trigger(struct iio_dev *indio_dev)
+{
+        struct adis16204_state *state = iio_priv(indio_dev);
+
+        iio_trigger_unregister(state->trig);
+        free_irq(state->us->irq, state->trig);
+        iio_free_trigger(state->trig);
+}