1/* 2 * Common library for ADIS16XXX devices 3 * 4 * Copyright 2012 Analog Devices Inc. 5 * Author: Lars-Peter Clausen <lars@metafoo.de> 6 * 7 * Licensed under the GPL-2 or later. 8 */ 9 10#include <linux/interrupt.h> 11#include <linux/kernel.h> 12#include <linux/spi/spi.h> 13#include <linux/export.h> 14 15#include <linux/iio/iio.h> 16#include <linux/iio/trigger.h> 17#include <linux/iio/imu/adis.h> 18 19static int adis_data_rdy_trigger_set_state(struct iio_trigger *trig, 20 bool state) 21{ 22 struct adis *adis = iio_trigger_get_drvdata(trig); 23 24 return adis_enable_irq(adis, state); 25} 26 27static const struct iio_trigger_ops adis_trigger_ops = { 28 .owner = THIS_MODULE, 29 .set_trigger_state = &adis_data_rdy_trigger_set_state, 30}; 31 32/** 33 * adis_probe_trigger() - Sets up trigger for a adis device 34 * @adis: The adis device 35 * @indio_dev: The IIO device 36 * 37 * Returns 0 on success or a negative error code 38 * 39 * adis_remove_trigger() should be used to free the trigger. 40 */ 41int adis_probe_trigger(struct adis *adis, struct iio_dev *indio_dev) 42{ 43 int ret; 44 45 adis->trig = iio_trigger_alloc("%s-dev%d", indio_dev->name, 46 indio_dev->id); 47 if (adis->trig == NULL) 48 return -ENOMEM; 49 50 ret = request_irq(adis->spi->irq, 51 &iio_trigger_generic_data_rdy_poll, 52 IRQF_TRIGGER_RISING, 53 indio_dev->name, 54 adis->trig); 55 if (ret) 56 goto error_free_trig; 57 58 adis->trig->dev.parent = &adis->spi->dev; 59 adis->trig->ops = &adis_trigger_ops; 60 iio_trigger_set_drvdata(adis->trig, adis); 61 ret = iio_trigger_register(adis->trig); 62 63 indio_dev->trig = iio_trigger_get(adis->trig); 64 if (ret) 65 goto error_free_irq; 66 67 return 0; 68 69error_free_irq: 70 free_irq(adis->spi->irq, adis->trig); 71error_free_trig: 72 iio_trigger_free(adis->trig); 73 return ret; 74} 75EXPORT_SYMBOL_GPL(adis_probe_trigger); 76 77/** 78 * adis_remove_trigger() - Remove trigger for a adis devices 79 * @adis: The adis device 80 * 81 * Removes the trigger previously registered with adis_probe_trigger(). 82 */ 83void adis_remove_trigger(struct adis *adis) 84{ 85 iio_trigger_unregister(adis->trig); 86 free_irq(adis->spi->irq, adis->trig); 87 iio_trigger_free(adis->trig); 88} 89EXPORT_SYMBOL_GPL(adis_remove_trigger); 90