1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192 |
- // SPDX-License-Identifier: GPL-2.0-or-later
- /*
- * Common library for ADIS16XXX devices
- *
- * Copyright 2012 Analog Devices Inc.
- * Author: Lars-Peter Clausen <lars@metafoo.de>
- */
- #include <linux/interrupt.h>
- #include <linux/kernel.h>
- #include <linux/spi/spi.h>
- #include <linux/export.h>
- #include <linux/iio/iio.h>
- #include <linux/iio/trigger.h>
- #include <linux/iio/imu/adis.h>
- static int adis_data_rdy_trigger_set_state(struct iio_trigger *trig,
- bool state)
- {
- struct adis *adis = iio_trigger_get_drvdata(trig);
- return adis_enable_irq(adis, state);
- }
- static const struct iio_trigger_ops adis_trigger_ops = {
- .set_trigger_state = &adis_data_rdy_trigger_set_state,
- };
- static void adis_trigger_setup(struct adis *adis)
- {
- adis->trig->dev.parent = &adis->spi->dev;
- adis->trig->ops = &adis_trigger_ops;
- iio_trigger_set_drvdata(adis->trig, adis);
- }
- static int adis_validate_irq_flag(struct adis *adis)
- {
- /*
- * Typically this devices have data ready either on the rising edge or
- * on the falling edge of the data ready pin. This checks enforces that
- * one of those is set in the drivers... It defaults to
- * IRQF_TRIGGER_RISING for backward compatibility wiht devices that
- * don't support changing the pin polarity.
- */
- if (!adis->irq_flag) {
- adis->irq_flag = IRQF_TRIGGER_RISING;
- return 0;
- } else if (adis->irq_flag != IRQF_TRIGGER_RISING &&
- adis->irq_flag != IRQF_TRIGGER_FALLING) {
- dev_err(&adis->spi->dev, "Invalid IRQ mask: %08lx\n",
- adis->irq_flag);
- return -EINVAL;
- }
- return 0;
- }
- /**
- * devm_adis_probe_trigger() - Sets up trigger for a managed adis device
- * @adis: The adis device
- * @indio_dev: The IIO device
- *
- * Returns 0 on success or a negative error code
- */
- int devm_adis_probe_trigger(struct adis *adis, struct iio_dev *indio_dev)
- {
- int ret;
- adis->trig = devm_iio_trigger_alloc(&adis->spi->dev, "%s-dev%d",
- indio_dev->name, indio_dev->id);
- if (!adis->trig)
- return -ENOMEM;
- adis_trigger_setup(adis);
- ret = adis_validate_irq_flag(adis);
- if (ret)
- return ret;
- ret = devm_request_irq(&adis->spi->dev, adis->spi->irq,
- &iio_trigger_generic_data_rdy_poll,
- adis->irq_flag,
- indio_dev->name,
- adis->trig);
- if (ret)
- return ret;
- return devm_iio_trigger_register(&adis->spi->dev, adis->trig);
- }
- EXPORT_SYMBOL_GPL(devm_adis_probe_trigger);
|