[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20251014-bma220_events-v1-5-153424d7ea08@subdimension.ro>
Date: Tue, 14 Oct 2025 19:43:01 +0300
From: Petre Rodan <petre.rodan@...dimension.ro>
To: Jonathan Cameron <jic23@...nel.org>,
David Lechner <dlechner@...libre.com>,
Nuno Sá <nuno.sa@...log.com>,
Andy Shevchenko <andy@...nel.org>
Cc: linux-iio@...r.kernel.org, linux-kernel@...r.kernel.org
Subject: [PATCH 5/6] iio: accel: bma220: add high-g event detection
Add support for high-g detection.
Signed-off-by: Petre Rodan <petre.rodan@...dimension.ro>
---
drivers/iio/accel/bma220_core.c | 132 ++++++++++++++++++++++++++++++++++++++++
1 file changed, 132 insertions(+)
diff --git a/drivers/iio/accel/bma220_core.c b/drivers/iio/accel/bma220_core.c
index daff22ec1f2d..f1d4646b495d 100644
--- a/drivers/iio/accel/bma220_core.c
+++ b/drivers/iio/accel/bma220_core.c
@@ -127,6 +127,14 @@ static const struct iio_event_spec bma220_events[] = {
BIT(IIO_EV_INFO_PERIOD) |
BIT(IIO_EV_INFO_HYSTERESIS),
},
+ {
+ .type = IIO_EV_TYPE_THRESH,
+ .dir = IIO_EV_DIR_RISING,
+ .mask_separate = BIT(IIO_EV_INFO_ENABLE),
+ .mask_shared_by_type = BIT(IIO_EV_INFO_VALUE) |
+ BIT(IIO_EV_INFO_PERIOD) |
+ BIT(IIO_EV_INFO_HYSTERESIS),
+ },
};
#define BMA220_ACCEL_CHANNEL(index, reg, axis) { \
@@ -464,6 +472,34 @@ static int bma220_is_tap_en(struct bma220_data *data,
return 0;
}
+static int bma220_is_high_en(struct bma220_data *data,
+ enum iio_modifier axis,
+ bool *en)
+{
+ unsigned int reg_val;
+ int ret;
+
+ ret = regmap_read(data->regmap, BMA220_REG_IE1, ®_val);
+ if (ret)
+ return ret;
+
+ switch (axis) {
+ case IIO_MOD_X:
+ *en = FIELD_GET(BMA220_INT_EN_HIGH_X_MSK, reg_val);
+ break;
+ case IIO_MOD_Y:
+ *en = FIELD_GET(BMA220_INT_EN_HIGH_Y_MSK, reg_val);
+ break;
+ case IIO_MOD_Z:
+ *en = FIELD_GET(BMA220_INT_EN_HIGH_Z_MSK, reg_val);
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
static int bma220_set_tap_en(struct bma220_data *data,
enum iio_modifier axis,
int type,
@@ -509,6 +545,35 @@ static int bma220_set_tap_en(struct bma220_data *data,
return 0;
}
+static int bma220_set_high_en(struct bma220_data *data,
+ enum iio_modifier axis,
+ bool en)
+{
+ int ret;
+
+ switch (axis) {
+ case IIO_MOD_X:
+ ret = regmap_update_bits(data->regmap, BMA220_REG_IE1,
+ BMA220_INT_EN_HIGH_X_MSK,
+ FIELD_PREP(BMA220_INT_EN_HIGH_X_MSK, en));
+ break;
+ case IIO_MOD_Y:
+ ret = regmap_update_bits(data->regmap, BMA220_REG_IE1,
+ BMA220_INT_EN_HIGH_Y_MSK,
+ FIELD_PREP(BMA220_INT_EN_HIGH_Y_MSK, en));
+ break;
+ case IIO_MOD_Z:
+ ret = regmap_update_bits(data->regmap, BMA220_REG_IE1,
+ BMA220_INT_EN_HIGH_Z_MSK,
+ FIELD_PREP(BMA220_INT_EN_HIGH_Z_MSK, en));
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return ret;
+}
+
static int bma220_read_event_config(struct iio_dev *indio_dev,
const struct iio_chan_spec *chan,
enum iio_event_type type,
@@ -548,6 +613,11 @@ static int bma220_read_event_config(struct iio_dev *indio_dev,
return ret;
val = FIELD_GET(BMA220_INT_EN_LOW_MSK, reg_val);
return val;
+ case IIO_EV_DIR_RISING:
+ ret = bma220_is_high_en(data, chan->channel2, &int_en);
+ if (ret)
+ return ret;
+ return int_en;
default:
return -EINVAL;
}
@@ -589,6 +659,9 @@ static int bma220_write_event_config(struct iio_dev *indio_dev,
BMA220_INT_EN_LOW_MSK,
FIELD_PREP(BMA220_INT_EN_LOW_MSK, state));
break;
+ case IIO_EV_DIR_RISING:
+ ret = bma220_set_high_en(data, chan->channel2, state);
+ break;
default:
return -EINVAL;
}
@@ -662,6 +735,32 @@ static int bma220_read_event_value(struct iio_dev *indio_dev,
default:
return -EINVAL;
}
+ case IIO_EV_DIR_RISING:
+ switch (info) {
+ case IIO_EV_INFO_VALUE:
+ ret = regmap_read(data->regmap, BMA220_REG_CONF1,
+ ®_val);
+ if (ret)
+ return ret;
+ *val = FIELD_GET(BMA220_HIGH_TH_MSK, reg_val);
+ return IIO_VAL_INT;
+ case IIO_EV_INFO_PERIOD:
+ ret = regmap_read(data->regmap, BMA220_REG_CONF0,
+ ®_val);
+ if (ret)
+ return ret;
+ *val = FIELD_GET(BMA220_HIGH_DUR_MSK, reg_val);
+ return IIO_VAL_INT;
+ case IIO_EV_INFO_HYSTERESIS:
+ ret = regmap_read(data->regmap, BMA220_REG_CONF0,
+ ®_val);
+ if (ret)
+ return ret;
+ *val = FIELD_GET(BMA220_HIGH_HY_MSK, reg_val);
+ return IIO_VAL_INT;
+ default:
+ return -EINVAL;
+ }
default:
return -EINVAL;
}
@@ -727,6 +826,32 @@ static int bma220_write_event_value(struct iio_dev *indio_dev,
default:
return -EINVAL;
}
+ case IIO_EV_DIR_RISING:
+ switch (info) {
+ case IIO_EV_INFO_VALUE:
+ if (!FIELD_FIT(BMA220_HIGH_TH_MSK, val))
+ return -EINVAL;
+ return regmap_update_bits(data->regmap,
+ BMA220_REG_CONF1,
+ BMA220_HIGH_TH_MSK,
+ FIELD_PREP(BMA220_HIGH_TH_MSK, val));
+ case IIO_EV_INFO_PERIOD:
+ if (!FIELD_FIT(BMA220_HIGH_DUR_MSK, val))
+ return -EINVAL;
+ return regmap_update_bits(data->regmap,
+ BMA220_REG_CONF0,
+ BMA220_HIGH_DUR_MSK,
+ FIELD_PREP(BMA220_HIGH_DUR_MSK, val));
+ case IIO_EV_INFO_HYSTERESIS:
+ if (!FIELD_FIT(BMA220_HIGH_HY_MSK, val))
+ return -EINVAL;
+ return regmap_update_bits(data->regmap,
+ BMA220_REG_CONF0,
+ BMA220_HIGH_HY_MSK,
+ FIELD_PREP(BMA220_HIGH_HY_MSK, val));
+ default:
+ return -EINVAL;
+ }
default:
return -EINVAL;
}
@@ -891,6 +1016,13 @@ static irqreturn_t bma220_irq_handler(int irq, void *private)
IIO_EV_TYPE_THRESH,
IIO_EV_DIR_FALLING),
timestamp);
+ if (FIELD_GET(BMA220_IF_HIGH, bma220_reg_if1))
+ iio_push_event(indio_dev,
+ IIO_MOD_EVENT_CODE(IIO_ACCEL, 0,
+ IIO_MOD_X_OR_Y_OR_Z,
+ IIO_EV_TYPE_THRESH,
+ IIO_EV_DIR_RISING),
+ timestamp);
if (FIELD_GET(BMA220_IF_TT, bma220_reg_if1)) {
if (data->tap_type == BMA220_TAP_TYPE_SINGLE)
--
2.49.1
Powered by blists - more mailing lists