admin/linux
1
0
Fork 0
mirror of https://github.com/torvalds/linux.git synced 2025-12-07 20:06:24 +00:00
Code Issues Packages Projects Releases Wiki Activity

iio: accel: bma220: add interrupt trigger

Browse Source 
Add interrupt trigger.

Signed-off-by: Petre Rodan <petre.rodan@subdimension.ro>
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
This commit is contained in:
Petre Rodan
2025-10-05 16:12:25 +03:00
committed by Jonathan Cameron
parent 3499375209
commit b7e17ca107
1 changed files with 58 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

58
drivers/iio/accel/bma220_core.c
View File

@@ -23,6 +23,7 @@
#include <linux/iio/buffer.h>
#include <linux/iio/iio.h>
#include <linux/iio/sysfs.h>
#include <linux/iio/trigger.h>
#include <linux/iio/trigger_consumer.h>
#include <linux/iio/triggered_buffer.h>
@@ -124,6 +125,7 @@ struct bma220_data {
struct regmap *regmap;
struct mutex lock;
u8 range_idx;
struct iio_trigger *trig;
struct {
s8 chans[3];
/* Ensure timestamp is naturally aligned. */
@@ -192,6 +194,22 @@ const struct regmap_config bma220_i2c_regmap_config = {
};
EXPORT_SYMBOL_NS_GPL(bma220_i2c_regmap_config, "IIO_BOSCH_BMA220");
static int bma220_data_rdy_trigger_set_state(struct iio_trigger *trig,
bool state)
{
struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
struct bma220_data *data = iio_priv(indio_dev);
return regmap_update_bits(data->regmap, BMA220_REG_IE0,
BMA220_INT_EN_DRDY_MSK,
FIELD_PREP(BMA220_INT_EN_DRDY_MSK, state));
}
static const struct iio_trigger_ops bma220_trigger_ops = {
.set_trigger_state = &bma220_data_rdy_trigger_set_state,
.validate_device = &iio_trigger_validate_own_device,
};
static irqreturn_t bma220_trigger_handler(int irq, void *p)
{
int ret;
@@ -414,6 +432,23 @@ static void bma220_deinit(void *data_ptr)
ERR_PTR(ret));
}
static irqreturn_t bma220_irq_handler(int irq, void *private)
{
struct iio_dev *indio_dev = private;
struct bma220_data *data = iio_priv(indio_dev);
int ret;
unsigned int bma220_reg_if1;
ret = regmap_read(data->regmap, BMA220_REG_IF1, &bma220_reg_if1);
if (ret)
return IRQ_NONE;
if (FIELD_GET(BMA220_IF_DRDY, bma220_reg_if1))
iio_trigger_poll_nested(data->trig);
return IRQ_HANDLED;
}
int bma220_common_probe(struct device *dev, struct regmap *regmap, int irq)
{
int ret;
@@ -442,6 +477,29 @@ int bma220_common_probe(struct device *dev, struct regmap *regmap, int irq)
indio_dev->num_channels = ARRAY_SIZE(bma220_channels);
indio_dev->available_scan_masks = bma220_accel_scan_masks;
if (irq > 0) {
data->trig = devm_iio_trigger_alloc(dev, "%s-dev%d",
indio_dev->name,
iio_device_id(indio_dev));
if (!data->trig)
return -ENOMEM;
data->trig->ops = &bma220_trigger_ops;
iio_trigger_set_drvdata(data->trig, indio_dev);
ret = devm_iio_trigger_register(dev, data->trig);
if (ret)
return dev_err_probe(dev, ret,
"iio trigger register fail\n");
indio_dev->trig = iio_trigger_get(data->trig);
ret = devm_request_threaded_irq(dev, irq, NULL,
&bma220_irq_handler, IRQF_ONESHOT,
indio_dev->name, indio_dev);
if (ret)
return dev_err_probe(dev, ret,
"request irq %d failed\n", irq);
}
ret = devm_add_action_or_reset(dev, bma220_deinit, data);
if (ret)
return ret;