3337c9ff17
Print a proper error message if we're missing the trigger IRQ. Signed-off-by: Linus Walleij <linus.walleij@linaro.org> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
80 lines
2 KiB
C
80 lines
2 KiB
C
/*
|
|
* 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) {
|
|
dev_err(&indio_dev->dev, "failed to request trigger IRQ.\n");
|
|
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");
|