Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / iio / common / st_sensors / st_sensors_trigger.c

diff --git a/kernel/drivers/iio/common/st_sensors/st_sensors_trigger.c b/kernel/drivers/iio/common/st_sensors/st_sensors_trigger.c
new file mode 100644 (file)
index 0000000..8d8ca6f
--- /dev/null
+++ b/kernel/drivers/iio/common/st_sensors/st_sensors_trigger.c
@@ -0,0 +1,77 @@
+/*
+ * STMicroelectronics sensors trigger library driver
+ *
+ * Copyright 2012-2013 STMicroelectronics Inc.
+ *
+ * Denis Ciocca <denis.ciocca@st.com>
+ *
+ * Licensed under the GPL-2.
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/iio/iio.h>
+#include <linux/iio/trigger.h>
+#include <linux/interrupt.h>
+
+#include <linux/iio/common/st_sensors.h>
+
+
+int st_sensors_allocate_trigger(struct iio_dev *indio_dev,
+                               const struct iio_trigger_ops *trigger_ops)
+{
+       int err;
+       struct st_sensor_data *sdata = iio_priv(indio_dev);
+
+       sdata->trig = iio_trigger_alloc("%s-trigger", indio_dev->name);
+       if (sdata->trig == NULL) {
+               err = -ENOMEM;
+               dev_err(&indio_dev->dev, "failed to allocate iio trigger.\n");
+               goto iio_trigger_alloc_error;
+       }
+
+       err = request_threaded_irq(sdata->get_irq_data_ready(indio_dev),
+                       iio_trigger_generic_data_rdy_poll,
+                       NULL,
+                       IRQF_TRIGGER_RISING,
+                       sdata->trig->name,
+                       sdata->trig);
+       if (err)
+               goto request_irq_error;
+
+       iio_trigger_set_drvdata(sdata->trig, indio_dev);
+       sdata->trig->ops = trigger_ops;
+       sdata->trig->dev.parent = sdata->dev;
+
+       err = iio_trigger_register(sdata->trig);
+       if (err < 0) {
+               dev_err(&indio_dev->dev, "failed to register iio trigger.\n");
+               goto iio_trigger_register_error;
+       }
+       indio_dev->trig = iio_trigger_get(sdata->trig);
+
+       return 0;
+
+iio_trigger_register_error:
+       free_irq(sdata->get_irq_data_ready(indio_dev), sdata->trig);
+request_irq_error:
+       iio_trigger_free(sdata->trig);
+iio_trigger_alloc_error:
+       return err;
+}
+EXPORT_SYMBOL(st_sensors_allocate_trigger);
+
+void st_sensors_deallocate_trigger(struct iio_dev *indio_dev)
+{
+       struct st_sensor_data *sdata = iio_priv(indio_dev);
+
+       iio_trigger_unregister(sdata->trig);
+       free_irq(sdata->get_irq_data_ready(indio_dev), sdata->trig);
+       iio_trigger_free(sdata->trig);
+}
+EXPORT_SYMBOL(st_sensors_deallocate_trigger);
+
+MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
+MODULE_DESCRIPTION("STMicroelectronics ST-sensors trigger");
+MODULE_LICENSE("GPL v2");