mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
92 lines
2.3 KiB
92 lines
2.3 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
* Common library for ADIS16XXX devices |
|
* |
|
* Copyright 2012 Analog Devices Inc. |
|
* Author: Lars-Peter Clausen <[email protected]> |
|
*/ |
|
|
|
#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); |
|
|
|
|