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 19 static 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 27 static const struct iio_trigger_ops adis_trigger_ops = { 28 .set_trigger_state = &adis_data_rdy_trigger_set_state, 29 }; 30 31 /** 32 * adis_probe_trigger() - Sets up trigger for a adis device 33 * @adis: The adis device 34 * @indio_dev: The IIO device 35 * 36 * Returns 0 on success or a negative error code 37 * 38 * adis_remove_trigger() should be used to free the trigger. 39 */ 40 int adis_probe_trigger(struct adis *adis, struct iio_dev *indio_dev) 41 { 42 int ret; 43 44 adis->trig = iio_trigger_alloc("%s-dev%d", indio_dev->name, 45 indio_dev->id); 46 if (adis->trig == NULL) 47 return -ENOMEM; 48 49 adis->trig->dev.parent = &adis->spi->dev; 50 adis->trig->ops = &adis_trigger_ops; 51 iio_trigger_set_drvdata(adis->trig, adis); 52 53 ret = request_irq(adis->spi->irq, 54 &iio_trigger_generic_data_rdy_poll, 55 IRQF_TRIGGER_RISING, 56 indio_dev->name, 57 adis->trig); 58 if (ret) 59 goto error_free_trig; 60 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 69 error_free_irq: 70 free_irq(adis->spi->irq, adis->trig); 71 error_free_trig: 72 iio_trigger_free(adis->trig); 73 return ret; 74 } 75 EXPORT_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 */ 83 void 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 } 89 EXPORT_SYMBOL_GPL(adis_remove_trigger); 90