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 .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 */ 41 int 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 = 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