Added support for threshold events for both the ALS and UVI channels.
The events are reported when the threshold interrupt is triggered. Both
rising and falling threshold types are supported.
Signed-off-by: Abhash Jha <abhashkumarjha123@gmail.com>
---
drivers/iio/light/ltr390.c | 222 ++++++++++++++++++++++++++++++++++++-
1 file changed, 220 insertions(+), 2 deletions(-)
diff --git a/drivers/iio/light/ltr390.c b/drivers/iio/light/ltr390.c
index c4ff26d68..8a8a118ca 100644
--- a/drivers/iio/light/ltr390.c
+++ b/drivers/iio/light/ltr390.c
@@ -24,8 +24,11 @@
#include <linux/mutex.h>
#include <linux/regmap.h>
#include <linux/bitfield.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
#include <linux/iio/iio.h>
+#include <linux/iio/events.h>
#include <asm/unaligned.h>
@@ -33,9 +36,12 @@
#define LTR390_ALS_UVS_MEAS_RATE 0x04
#define LTR390_ALS_UVS_GAIN 0x05
#define LTR390_PART_ID 0x06
+#define LTR390_MAIN_STATUS 0x07
#define LTR390_ALS_DATA 0x0D
#define LTR390_UVS_DATA 0x10
#define LTR390_INT_CFG 0x19
+#define LTR390_THRESH_UP 0x21
+#define LTR390_THRESH_LOW 0x24
#define LTR390_PART_NUMBER_ID 0xb
#define LTR390_ALS_UVS_GAIN_MASK 0x07
@@ -46,6 +52,8 @@
#define LTR390_SW_RESET BIT(4)
#define LTR390_UVS_MODE BIT(3)
#define LTR390_SENSOR_ENABLE BIT(1)
+#define LTR390_LS_INT_EN BIT(2)
+#define LTR390_LS_INT_SEL_UVS BIT(5)
#define LTR390_FRACTIONAL_PRECISION 100
@@ -230,6 +238,22 @@ static const int ltr390_int_time_map_us[] = { 400000, 200000, 100000, 50000, 250
static const int ltr390_gain_map[] = { 1, 3, 6, 9, 18 };
static const int ltr390_freq_map[] = { 40000, 20000, 10000, 5000, 2000, 1000, 500, 500 };
+static const struct iio_event_spec ltr390_event_spec[] = {
+ {
+ .type = IIO_EV_TYPE_THRESH,
+ .dir = IIO_EV_DIR_RISING,
+ .mask_separate = BIT(IIO_EV_INFO_VALUE),
+ }, {
+ .type = IIO_EV_TYPE_THRESH,
+ .dir = IIO_EV_DIR_FALLING,
+ .mask_separate = BIT(IIO_EV_INFO_VALUE),
+ }, {
+ .type = IIO_EV_TYPE_THRESH,
+ .dir = IIO_EV_DIR_EITHER,
+ .mask_separate = BIT(IIO_EV_INFO_ENABLE),
+ }
+};
+
static const struct iio_chan_spec ltr390_channels[] = {
/* UV sensor */
{
@@ -238,7 +262,9 @@ static const struct iio_chan_spec ltr390_channels[] = {
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
.info_mask_shared_by_all = BIT(IIO_CHAN_INFO_INT_TIME) | BIT(IIO_CHAN_INFO_SAMP_FREQ),
.info_mask_shared_by_all_available = BIT(IIO_CHAN_INFO_INT_TIME) | BIT(IIO_CHAN_INFO_SCALE)
- | BIT(IIO_CHAN_INFO_SAMP_FREQ)
+ | BIT(IIO_CHAN_INFO_SAMP_FREQ),
+ .event_spec = ltr390_event_spec,
+ .num_event_specs = ARRAY_SIZE(ltr390_event_spec),
},
/* ALS sensor */
{
@@ -247,7 +273,9 @@ static const struct iio_chan_spec ltr390_channels[] = {
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
.info_mask_shared_by_all = BIT(IIO_CHAN_INFO_INT_TIME) | BIT(IIO_CHAN_INFO_SAMP_FREQ),
.info_mask_shared_by_all_available = BIT(IIO_CHAN_INFO_INT_TIME) | BIT(IIO_CHAN_INFO_SCALE)
- | BIT(IIO_CHAN_INFO_SAMP_FREQ)
+ | BIT(IIO_CHAN_INFO_SAMP_FREQ),
+ .event_spec = ltr390_event_spec,
+ .num_event_specs = ARRAY_SIZE(ltr390_event_spec),
},
};
@@ -370,12 +398,186 @@ static int ltr390_write_raw(struct iio_dev *indio_dev, struct iio_chan_spec cons
}
}
+static int ltr390_read_threshold(const struct iio_dev *indio_dev,
+ enum iio_event_direction dir,
+ int *val, int *val2)
+{
+ struct ltr390_data *data = iio_priv(indio_dev);
+ int ret;
+
+ switch (dir) {
+ case IIO_EV_DIR_RISING:
+ ret = ltr390_register_read(data, LTR390_THRESH_UP);
+ if (ret < 0)
+ return ret;
+ *val = ret;
+ return IIO_VAL_INT;
+
+ case IIO_EV_DIR_FALLING:
+ ret = ltr390_register_read(data, LTR390_THRESH_LOW);
+ if (ret < 0)
+ return ret;
+ *val = ret;
+ return IIO_VAL_INT;
+ default:
+ return -EINVAL;
+ }
+}
+
+static int ltr390_write_threshold(struct iio_dev *indio_dev,
+ enum iio_event_direction dir,
+ int val, int val2)
+{
+ struct ltr390_data *data = iio_priv(indio_dev);
+ int ret;
+
+ guard(mutex)(&data->lock);
+ switch (dir) {
+ case IIO_EV_DIR_RISING:
+ ret = regmap_bulk_write(data->regmap,
+ LTR390_THRESH_UP,
+ &val, 3);
+ return ret;
+ case IIO_EV_DIR_FALLING:
+ ret = regmap_bulk_write(data->regmap,
+ LTR390_THRESH_LOW,
+ &val, 3);
+ return ret;
+ default:
+ return -EINVAL;
+ }
+}
+
+static int ltr390_read_event_value(struct iio_dev *indio_dev,
+ const struct iio_chan_spec *chan,
+ enum iio_event_type type,
+ enum iio_event_direction dir,
+ enum iio_event_info info,
+ int *val, int *val2)
+{
+ switch (info) {
+ case IIO_EV_INFO_VALUE:
+ return ltr390_read_threshold(indio_dev, dir, val, val2);
+ default:
+ return -EINVAL;
+ }
+}
+
+static int ltr390_write_event_value(struct iio_dev *indio_dev,
+ const struct iio_chan_spec *chan,
+ enum iio_event_type type,
+ enum iio_event_direction dir,
+ enum iio_event_info info,
+ int val, int val2)
+{
+ switch (info) {
+ case IIO_EV_INFO_VALUE:
+ if (val2 != 0)
+ return -EINVAL;
+
+ return ltr390_write_threshold(indio_dev, dir, val, val2);
+ default:
+ return -EINVAL;
+ }
+}
+
+static int ltr390_read_event_config(struct iio_dev *indio_dev,
+ const struct iio_chan_spec *chan,
+ enum iio_event_type type,
+ enum iio_event_direction dir)
+{
+ struct ltr390_data *data = iio_priv(indio_dev);
+ int ret, status;
+
+ ret = regmap_read(data->regmap, LTR390_INT_CFG, &status);
+ if (ret < 0)
+ return ret;
+
+ return status & LTR390_LS_INT_EN;
+}
+
+static int ltr390_write_event_config(struct iio_dev *indio_dev,
+ const struct iio_chan_spec *chan,
+ enum iio_event_type type,
+ enum iio_event_direction dir,
+ int state)
+{
+ struct ltr390_data *data = iio_priv(indio_dev);
+ int ret;
+
+ if (state != 1 && state != 0)
+ return -EINVAL;
+
+ if (state == 0)
+ return regmap_clear_bits(data->regmap, LTR390_INT_CFG, LTR390_LS_INT_EN);
+
+ guard(mutex)(&data->lock);
+ ret = regmap_set_bits(data->regmap, LTR390_INT_CFG, LTR390_LS_INT_EN);
+ if (ret < 0)
+ return ret;
+
+ switch (chan->type) {
+ case IIO_LIGHT:
+ ret = ltr390_set_mode(data, LTR390_SET_ALS_MODE);
+ if (ret < 0)
+ return ret;
+
+ return regmap_clear_bits(data->regmap, LTR390_INT_CFG, LTR390_LS_INT_SEL_UVS);
+
+ case IIO_UVINDEX:
+ ret = ltr390_set_mode(data, LTR390_SET_UVS_MODE);
+ if (ret < 0)
+ return ret;
+
+ return regmap_set_bits(data->regmap, LTR390_INT_CFG, LTR390_LS_INT_SEL_UVS);
+
+ default:
+ return -EINVAL;
+ }
+}
+
static const struct iio_info ltr390_info = {
.read_raw = ltr390_read_raw,
.write_raw = ltr390_write_raw,
.read_avail = ltr390_read_avail,
+ .read_event_value = ltr390_read_event_value,
+ .read_event_config = ltr390_read_event_config,
+ .write_event_value = ltr390_write_event_value,
+ .write_event_config = ltr390_write_event_config,
};
+static irqreturn_t ltr390_interrupt_handler(int irq, void *private)
+{
+ struct iio_dev *indio_dev = private;
+ struct ltr390_data *data = iio_priv(indio_dev);
+ int ret, status;
+
+ /* Reading the status register to clear the interrupt flag, Datasheet pg: 17*/
+ ret = regmap_read(data->regmap, LTR390_MAIN_STATUS, &status);
+ if (ret < 0)
+ return ret;
+
+ switch (data->mode) {
+ case LTR390_SET_ALS_MODE:
+ iio_push_event(indio_dev,
+ IIO_UNMOD_EVENT_CODE(IIO_LIGHT, 0,
+ IIO_EV_TYPE_THRESH,
+ IIO_EV_DIR_EITHER),
+ iio_get_time_ns(indio_dev));
+ break;
+
+ case LTR390_SET_UVS_MODE:
+ iio_push_event(indio_dev,
+ IIO_UNMOD_EVENT_CODE(IIO_UVINDEX, 0,
+ IIO_EV_TYPE_THRESH,
+ IIO_EV_DIR_EITHER),
+ iio_get_time_ns(indio_dev));
+ break;
+ }
+
+ return IRQ_HANDLED;
+}
+
static int ltr390_probe(struct i2c_client *client)
{
struct ltr390_data *data;
@@ -429,6 +631,22 @@ static int ltr390_probe(struct i2c_client *client)
if (ret)
return dev_err_probe(dev, ret, "failed to enable the sensor\n");
+ if (client->irq) {
+ int irq_flags = irq_get_trigger_type(client->irq);
+
+ if (!irq_flags)
+ irq_flags = IRQF_TRIGGER_FALLING;
+
+ ret = devm_request_threaded_irq(&client->dev, client->irq,
+ NULL, ltr390_interrupt_handler,
+ irq_flags | IRQF_ONESHOT,
+ "ltr390_thresh_event", indio_dev);
+ if (ret) {
+ dev_err(&client->dev, "request irq (%d) failed\n", client->irq);
+ return ret;
+ }
+ }
+
return devm_iio_device_register(dev, indio_dev);
}
--
2.43.0
On Tue, 10 Sep 2024 10:20:28 +0530 Abhash Jha <abhashkumarjha123@gmail.com> wrote: > Added support for threshold events for both the ALS and UVI channels. > The events are reported when the threshold interrupt is triggered. Both > rising and falling threshold types are supported. > > Signed-off-by: Abhash Jha <abhashkumarjha123@gmail.com> Hi Abhash, A few comments inline. Thanks, Jonathan > --- > drivers/iio/light/ltr390.c | 222 ++++++++++++++++++++++++++++++++++++- > 1 file changed, 220 insertions(+), 2 deletions(-) > > diff --git a/drivers/iio/light/ltr390.c b/drivers/iio/light/ltr390.c > index c4ff26d68..8a8a118ca 100644 > --- a/drivers/iio/light/ltr390.c > +++ b/drivers/iio/light/ltr390.c > @@ -24,8 +24,11 @@ > > @@ -370,12 +398,186 @@ static int ltr390_write_raw(struct iio_dev *indio_dev, struct iio_chan_spec cons > } > } > > +static int ltr390_read_threshold(const struct iio_dev *indio_dev, > + enum iio_event_direction dir, Alignment doesn't look quite right. Is it off one space? That is, e should be below c. Hard to tell this in a diff so I maybe wrong about it being off. > + int *val, int *val2) > +{ > + struct ltr390_data *data = iio_priv(indio_dev); > + int ret; > + > + switch (dir) { > + case IIO_EV_DIR_RISING: > + ret = ltr390_register_read(data, LTR390_THRESH_UP); > + if (ret < 0) > + return ret; > + *val = ret; > + return IIO_VAL_INT; > + > + case IIO_EV_DIR_FALLING: > + ret = ltr390_register_read(data, LTR390_THRESH_LOW); > + if (ret < 0) > + return ret; > + *val = ret; > + return IIO_VAL_INT; > + default: > + return -EINVAL; > + } > +} > + > +static int ltr390_write_threshold(struct iio_dev *indio_dev, > + enum iio_event_direction dir, > + int val, int val2) > +{ > + struct ltr390_data *data = iio_priv(indio_dev); > + int ret; > + > + guard(mutex)(&data->lock); > + switch (dir) { > + case IIO_EV_DIR_RISING: > + ret = regmap_bulk_write(data->regmap, > + LTR390_THRESH_UP, Wrap this bit less to get nearer 80 chars. > + &val, 3); > + return ret; > + case IIO_EV_DIR_FALLING: > + ret = regmap_bulk_write(data->regmap, > + LTR390_THRESH_LOW, > + &val, 3); > + return ret; > + default: > + return -EINVAL; > + } > +} ... > +static int ltr390_read_event_config(struct iio_dev *indio_dev, > + const struct iio_chan_spec *chan, > + enum iio_event_type type, > + enum iio_event_direction dir) > +{ > + struct ltr390_data *data = iio_priv(indio_dev); > + int ret, status; > + > + ret = regmap_read(data->regmap, LTR390_INT_CFG, &status); > + if (ret < 0) > + return ret; > + > + return status & LTR390_LS_INT_EN; Slight preference for FIELD_GET() here which will make this 0 or 1 rather than 0 or 4 (I think?) > +} > + > +static irqreturn_t ltr390_interrupt_handler(int irq, void *private) > +{ > + struct iio_dev *indio_dev = private; > + struct ltr390_data *data = iio_priv(indio_dev); > + int ret, status; > + > + /* Reading the status register to clear the interrupt flag, Datasheet pg: 17*/ > + ret = regmap_read(data->regmap, LTR390_MAIN_STATUS, &status); > + if (ret < 0) > + return ret; > + > + switch (data->mode) { > + case LTR390_SET_ALS_MODE: > + iio_push_event(indio_dev, > + IIO_UNMOD_EVENT_CODE(IIO_LIGHT, 0, > + IIO_EV_TYPE_THRESH, Align after ( > + IIO_EV_DIR_EITHER), > + iio_get_time_ns(indio_dev)); > + break; > + > + case LTR390_SET_UVS_MODE: > + iio_push_event(indio_dev, > + IIO_UNMOD_EVENT_CODE(IIO_UVINDEX, 0, Same on alignment as this is hard to read. > + IIO_EV_TYPE_THRESH, > + IIO_EV_DIR_EITHER), > + iio_get_time_ns(indio_dev)); > + break; > + } > + > + return IRQ_HANDLED; > +} > + > static int ltr390_probe(struct i2c_client *client) > { > struct ltr390_data *data; > @@ -429,6 +631,22 @@ static int ltr390_probe(struct i2c_client *client) > if (ret) > return dev_err_probe(dev, ret, "failed to enable the sensor\n"); > > + if (client->irq) { > + int irq_flags = irq_get_trigger_type(client->irq); > + > + if (!irq_flags) > + irq_flags = IRQF_TRIGGER_FALLING; Don't override the firmware description. It should be correct for new drives as probably no legacy out there. The only time we play this sort of game is when we have to carry on supporting a wrong configuration that 'works' because the driver was setting more than it should in the past. > + > + ret = devm_request_threaded_irq(&client->dev, client->irq, > + NULL, ltr390_interrupt_handler, > + irq_flags | IRQF_ONESHOT, Drop irq_flags use here. > + "ltr390_thresh_event", indio_dev); > + if (ret) { > + dev_err(&client->dev, "request irq (%d) failed\n", client->irq); > + return ret; > + } > + } > + > return devm_iio_device_register(dev, indio_dev); > } >
© 2016 - 2024 Red Hat, Inc.