kernel/drivers/iio/imu/adis_trigger.c

   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 = 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);