Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * Common library for ADIS16XXX devices
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * Copyright 2012 Analog Devices Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  *   Author: Lars-Peter Clausen <lars@metafoo.de>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/spi/spi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/export.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/iio/iio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/iio/trigger.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/iio/imu/adis.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) static int adis_data_rdy_trigger_set_state(struct iio_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 						bool state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	struct adis *adis = iio_trigger_get_drvdata(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	return adis_enable_irq(adis, state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static const struct iio_trigger_ops adis_trigger_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	.set_trigger_state = &adis_data_rdy_trigger_set_state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) static void adis_trigger_setup(struct adis *adis)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	adis->trig->dev.parent = &adis->spi->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	adis->trig->ops = &adis_trigger_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	iio_trigger_set_drvdata(adis->trig, adis);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) static int adis_validate_irq_flag(struct adis *adis)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	 * Typically this devices have data ready either on the rising edge or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	 * on the falling edge of the data ready pin. This checks enforces that
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	 * one of those is set in the drivers... It defaults to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	 * IRQF_TRIGGER_RISING for backward compatibility wiht devices that
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	 * don't support changing the pin polarity.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	if (!adis->irq_flag) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 		adis->irq_flag = IRQF_TRIGGER_RISING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	} else if (adis->irq_flag != IRQF_TRIGGER_RISING &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 		   adis->irq_flag != IRQF_TRIGGER_FALLING) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 		dev_err(&adis->spi->dev, "Invalid IRQ mask: %08lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 			adis->irq_flag);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)  * devm_adis_probe_trigger() - Sets up trigger for a managed adis device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)  * @adis: The adis device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)  * @indio_dev: The IIO device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)  * Returns 0 on success or a negative error code
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) int devm_adis_probe_trigger(struct adis *adis, struct iio_dev *indio_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 	adis->trig = devm_iio_trigger_alloc(&adis->spi->dev, "%s-dev%d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 					    indio_dev->name, indio_dev->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	if (!adis->trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 	adis_trigger_setup(adis);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	ret = adis_validate_irq_flag(adis);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 	ret = devm_request_irq(&adis->spi->dev, adis->spi->irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 			       &iio_trigger_generic_data_rdy_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) 			       adis->irq_flag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 			       indio_dev->name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) 			       adis->trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) 	return devm_iio_trigger_register(&adis->spi->dev, adis->trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) EXPORT_SYMBOL_GPL(devm_adis_probe_trigger);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)