drivers/iio/imu/adis_trigger.c

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