| Message ID | 20210831135638.173276-1-sean@geanix.com (mailing list archive) |
|---|---|
| State | Changes Requested |
| Headers | show |
| Series | [v4,1/2] iio: accel: fxls8962af: add threshold event handling | expand |
On Tue, 31 Aug 2021 15:56:37 +0200 Sean Nyekjaer <sean@geanix.com> wrote: > Add event channels that control the creation of motion events. > > Signed-off-by: Sean Nyekjaer <sean@geanix.com> > --- > Changes since v1/v2: > - Fixed comments fron Andy (Thanks) > - Corrected sign mess > > Changes since v3: > - Switched to absolute comparison mode(We could add ROC in the future > if needed.) > - Added separate falling and rising events and one enable pr. axis'. > - Fixed standby in fxls8962af_write_event_config() > - Added read of X_OT_POL and signal a falling or rising event. > > I'm currently not using pm_runtime resume/suspend for event handling, > maybe we should. How would you do so? I'd assume standby disables the events.. Some follow up comments inline. Thanks, Jonathan > > drivers/iio/accel/fxls8962af-core.c | 305 +++++++++++++++++++++++++++- > 1 file changed, 302 insertions(+), 3 deletions(-) > > diff --git a/drivers/iio/accel/fxls8962af-core.c b/drivers/iio/accel/fxls8962af-core.c > index f41db9e0249a..857940529e7d 100644 > --- a/drivers/iio/accel/fxls8962af-core.c > +++ b/drivers/iio/accel/fxls8962af-core.c > @@ -22,6 +22,7 @@ > #include <linux/regmap.h> > > #include <linux/iio/buffer.h> > +#include <linux/iio/events.h> > #include <linux/iio/iio.h> > #include <linux/iio/kfifo_buf.h> > #include <linux/iio/sysfs.h> > @@ -30,6 +31,7 @@ > > #define FXLS8962AF_INT_STATUS 0x00 > #define FXLS8962AF_INT_STATUS_SRC_BOOT BIT(0) > +#define FXLS8962AF_INT_STATUS_SRC_SDCD_OT BIT(4) > #define FXLS8962AF_INT_STATUS_SRC_BUF BIT(5) > #define FXLS8962AF_INT_STATUS_SRC_DRDY BIT(7) > #define FXLS8962AF_TEMP_OUT 0x01 > @@ -73,6 +75,7 @@ > #define FXLS8962AF_ASLP_COUNT_LSB 0x1e > > #define FXLS8962AF_INT_EN 0x20 > +#define FXLS8962AF_INT_EN_SDCD_OT_EN BIT(5) > #define FXLS8962AF_INT_EN_BUF_EN BIT(6) > #define FXLS8962AF_INT_PIN_SEL 0x21 > #define FXLS8962AF_INT_PIN_SEL_MASK GENMASK(7, 0) > @@ -96,9 +99,21 @@ > #define FXLS8962AF_ORIENT_THS_REG 0x2c > > #define FXLS8962AF_SDCD_INT_SRC1 0x2d > +#define FXLS8962AF_SDCD_INT_SRC1_X_OT BIT(5) > +#define FXLS8962AF_SDCD_INT_SRC1_X_POL BIT(4) > +#define FXLS8962AF_SDCD_INT_SRC1_Y_OT BIT(3) > +#define FXLS8962AF_SDCD_INT_SRC1_Y_POL BIT(2) > +#define FXLS8962AF_SDCD_INT_SRC1_Z_OT BIT(1) > +#define FXLS8962AF_SDCD_INT_SRC1_Z_POL BIT(0) > #define FXLS8962AF_SDCD_INT_SRC2 0x2e > #define FXLS8962AF_SDCD_CONFIG1 0x2f > +#define FXLS8962AF_SDCD_CONFIG1_Z_OT_EN BIT(3) > +#define FXLS8962AF_SDCD_CONFIG1_Y_OT_EN BIT(4) > +#define FXLS8962AF_SDCD_CONFIG1_X_OT_EN BIT(5) > +#define FXLS8962AF_SDCD_CONFIG1_OT_ELE BIT(7) > #define FXLS8962AF_SDCD_CONFIG2 0x30 > +#define FXLS8962AF_SDCD_CONFIG2_SDCD_EN BIT(7) > +#define FXLS8962AF_SC2_REF_UPDM_AC GENMASK(6, 5) > #define FXLS8962AF_SDCD_OT_DBCNT 0x31 > #define FXLS8962AF_SDCD_WT_DBCNT 0x32 > #define FXLS8962AF_SDCD_LTHS_LSB 0x33 > @@ -152,6 +167,9 @@ struct fxls8962af_data { > int64_t timestamp, old_timestamp; /* Only used in hw fifo mode. */ > struct iio_mount_matrix orientation; > u8 watermark; > + u8 enable_event; > + u16 lower_thres; > + u16 upper_thres; > }; > > const struct regmap_config fxls8962af_regmap_conf = { > @@ -238,7 +256,7 @@ static int fxls8962af_get_out(struct fxls8962af_data *data, > } > > ret = regmap_bulk_read(data->regmap, chan->address, > - &raw_val, (chan->scan_type.storagebits / 8)); > + &raw_val, sizeof(data->lower_thres)); > > if (!is_active) > fxls8962af_power_off(data); > @@ -451,6 +469,15 @@ static int fxls8962af_write_raw(struct iio_dev *indio_dev, > } > } > > +static int fxls8962af_event_setup(struct fxls8962af_data *data, int state) > +{ > + /* Enable wakeup interrupt */ > + int mask = FXLS8962AF_INT_EN_SDCD_OT_EN; > + int value = state ? mask : 0; > + > + return regmap_update_bits(data->regmap, FXLS8962AF_INT_EN, mask, value); > +} > + > static int fxls8962af_set_watermark(struct iio_dev *indio_dev, unsigned val) > { > struct fxls8962af_data *data = iio_priv(indio_dev); > @@ -463,6 +490,221 @@ static int fxls8962af_set_watermark(struct iio_dev *indio_dev, unsigned val) > return 0; > } > > +static int __fxls8962af_set_thresholds(struct fxls8962af_data *data, > + const struct iio_chan_spec *chan, > + enum iio_event_direction dir, > + int val) > +{ > + switch (dir) { > + case IIO_EV_DIR_FALLING: > + data->lower_thres = val; > + return regmap_bulk_write(data->regmap, FXLS8962AF_SDCD_LTHS_LSB, > + &data->lower_thres, sizeof(data->lower_thres)); > + case IIO_EV_DIR_RISING: > + data->upper_thres = val; > + return regmap_bulk_write(data->regmap, FXLS8962AF_SDCD_UTHS_LSB, > + &data->upper_thres, sizeof(data->upper_thres)); > + default: > + return -EINVAL; > + } > +} > + > +static int fxls8962af_read_event(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) > +{ > + struct fxls8962af_data *data = iio_priv(indio_dev); > + int ret; > + > + if (type != IIO_EV_TYPE_THRESH) > + return -EINVAL; > + > + switch (dir) { > + case IIO_EV_DIR_FALLING: > + ret = regmap_bulk_read(data->regmap, FXLS8962AF_SDCD_LTHS_LSB, > + &data->lower_thres, sizeof(data->lower_thres)); > + if (ret) > + return ret; > + > + *val = sign_extend32(data->lower_thres, chan->scan_type.realbits - 1); > + break; > + case IIO_EV_DIR_RISING: > + ret = regmap_bulk_read(data->regmap, FXLS8962AF_SDCD_UTHS_LSB, > + &data->upper_thres, sizeof(data->upper_thres)); > + if (ret) > + return ret; > + > + *val = sign_extend32(data->upper_thres, chan->scan_type.realbits - 1); > + break; > + default: > + return -EINVAL; > + } > + One bl plenty here. > + > + return IIO_VAL_INT; Move this into the switch statement then you can drop the two breaks. > +} > + > +static int fxls8962af_write_event(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) > +{ > + struct fxls8962af_data *data = iio_priv(indio_dev); > + int ret, val_masked; > + > + if (type != IIO_EV_TYPE_THRESH) > + return -EINVAL; > + > + if (val < -2048 || val > 2047) > + return -EINVAL; > + > + if (data->enable_event) > + return -EBUSY; > + > + val_masked = val & GENMASK(11, 0); > + if (fxls8962af_is_active(data)) { > + ret = fxls8962af_standby(data); > + if (ret) > + return ret; > + > + ret = __fxls8962af_set_thresholds(data, chan, dir, val_masked); > + if (ret) > + return ret; > + > + ret = fxls8962af_active(data); return fxls8... and drop the return ret below. > + } else { > + return __fxls8962af_set_thresholds(data, chan, dir, val_masked); > + } > + > + return ret; > +} > + > +static int > +fxls8962af_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 fxls8962af_data *data = iio_priv(indio_dev); > + > + if (type != IIO_EV_TYPE_THRESH) > + return -EINVAL; > + > + switch (chan->channel2) { > + case IIO_MOD_X: > + return !!(FXLS8962AF_SDCD_CONFIG1_X_OT_EN & data->enable_event); > + case IIO_MOD_Y: > + return !!(FXLS8962AF_SDCD_CONFIG1_Y_OT_EN & data->enable_event); > + case IIO_MOD_Z: > + return !!(FXLS8962AF_SDCD_CONFIG1_Z_OT_EN & data->enable_event); > + default: > + return -EINVAL; > + } > +} > + > +static int > +fxls8962af_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 fxls8962af_data *data = iio_priv(indio_dev); > + u8 enable_event, enable_bits; > + int ret, value; > + > + if (type != IIO_EV_TYPE_THRESH) > + return -EINVAL; > + > + switch (chan->channel2) { > + case IIO_MOD_X: > + enable_bits = FXLS8962AF_SDCD_CONFIG1_X_OT_EN; > + break; > + case IIO_MOD_Y: > + enable_bits = FXLS8962AF_SDCD_CONFIG1_Y_OT_EN; > + break; > + case IIO_MOD_Z: > + enable_bits = FXLS8962AF_SDCD_CONFIG1_Z_OT_EN; > + break; > + default: > + return -EINVAL; > + } > + > + if (state) > + enable_event = data->enable_event | enable_bits; > + else > + enable_event = data->enable_event & ~enable_bits; > + > + if (data->enable_event == enable_event) > + return 0; > + > + fxls8962af_standby(data); > + > + /* Enable events */ > + value = enable_event | FXLS8962AF_SDCD_CONFIG1_OT_ELE; > + ret = regmap_write(data->regmap, FXLS8962AF_SDCD_CONFIG1, value); > + if (ret) I hate error paths, but technically we should try to put things back as much as we possibly can do so.. In this particular case that means undoing standby if appropriate. If that doesn't make sense, then please add a comment to that effect in at least the first such error path. > + return ret; > + > + /* > + * Enable update of SDCD_REF_X/Y/Z values with the current decimated and > + * trimmed X/Y/Z acceleration input data. This allows for acceleration > + * slope detection with Data(n) to Data(n–1) always used as the input > + * to the window comparator. > + */ > + value = enable_event ? > + FXLS8962AF_SDCD_CONFIG2_SDCD_EN | FXLS8962AF_SC2_REF_UPDM_AC : > + 0x00; > + > + ret = regmap_write(data->regmap, FXLS8962AF_SDCD_CONFIG2, value); > + if (ret) > + return ret; > + > + ret = fxls8962af_event_setup(data, state); > + if (ret) > + return ret; > + > + data->enable_event = enable_event; > + > + if (data->enable_event) { > + fxls8962af_active(data); > + ret = fxls8962af_power_on(data); > + } else { > + ret = iio_device_claim_direct_mode(indio_dev); > + if (ret) > + return ret; > + If we get in here, we are protected against races with buffer enable / disable but we also know it's not currently enabled... We are also protected against racing with other calls of this function (that might need additional protection btw because we are messing with some state - I haven't looked closerly.). https://elixir.bootlin.com/linux/latest/source/drivers/iio/industrialio-core.c#L2004 So the following only acts as additional documentation. Use a comment instead. /* Not in buffered mode so disable power */ > + if (!iio_buffer_enabled(indio_dev)) > + ret = fxls8962af_power_off(data); > + > + iio_device_release_direct_mode(indio_dev); > + } > + > + return ret; > +} > + > +static const struct iio_event_spec fxls8962af_event[] = { > + { > + .type = IIO_EV_TYPE_THRESH, > + .dir = IIO_EV_DIR_EITHER, > + .mask_separate = BIT(IIO_EV_INFO_ENABLE), > + }, > + { > + .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_RISING, > + .mask_separate = BIT(IIO_EV_INFO_VALUE), > + }, > +}; > + > #define FXLS8962AF_CHANNEL(axis, reg, idx) { \ > .type = IIO_ACCEL, \ > .address = reg, \ > @@ -481,6 +723,8 @@ static int fxls8962af_set_watermark(struct iio_dev *indio_dev, unsigned val) > .shift = 4, \ > .endianness = IIO_BE, \ > }, \ > + .event_spec = fxls8962af_event, \ > + .num_event_specs = ARRAY_SIZE(fxls8962af_event), \ Odd looking double space. > } > > #define FXLS8962AF_TEMP_CHANNEL { \ > @@ -522,6 +766,10 @@ static const struct iio_info fxls8962af_info = { > .read_raw = &fxls8962af_read_raw, > .write_raw = &fxls8962af_write_raw, > .write_raw_get_fmt = fxls8962af_write_raw_get_fmt, > + .read_event_value = fxls8962af_read_event, > + .write_event_value = fxls8962af_write_event, > + .read_event_config = fxls8962af_read_event_config, > + .write_event_config = fxls8962af_write_event_config, > .read_avail = fxls8962af_read_avail, > .hwfifo_set_watermark = fxls8962af_set_watermark, > }; > @@ -605,7 +853,8 @@ static int fxls8962af_buffer_predisable(struct iio_dev *indio_dev) > > ret = __fxls8962af_fifo_set_mode(data, false); > > - fxls8962af_active(data); > + if (data->enable_event) > + fxls8962af_active(data); > > return ret; > } > @@ -614,7 +863,10 @@ static int fxls8962af_buffer_postdisable(struct iio_dev *indio_dev) > { > struct fxls8962af_data *data = iio_priv(indio_dev); > > - return fxls8962af_power_off(data); > + if (!data->enable_event) > + fxls8962af_power_off(data); > + > + return 0; > } > > static const struct iio_buffer_setup_ops fxls8962af_buffer_ops = { > @@ -725,6 +977,45 @@ static int fxls8962af_fifo_flush(struct iio_dev *indio_dev) > return count; > } > > +static int fxls8962af_event_interrupt(struct iio_dev *indio_dev) > +{ > + struct fxls8962af_data *data = iio_priv(indio_dev); > + s64 ts = iio_get_time_ns(indio_dev); > + unsigned int reg; > + u64 ev_code; > + int ret; > + > + ret = regmap_read(data->regmap, FXLS8962AF_SDCD_INT_SRC1, ®); > + if (ret) > + return ret; > + > + if (reg & FXLS8962AF_SDCD_INT_SRC1_X_OT) { > + ev_code = reg & FXLS8962AF_SDCD_INT_SRC1_X_POL ? > + IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING; > + iio_push_event(indio_dev, > + IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X, > + IIO_EV_TYPE_THRESH, ev_code), ts); > + } > + > + if (reg & FXLS8962AF_SDCD_INT_SRC1_Y_OT) { > + ev_code = reg & FXLS8962AF_SDCD_INT_SRC1_Y_POL ? > + IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING; > + iio_push_event(indio_dev, > + IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X, > + IIO_EV_TYPE_THRESH, ev_code), ts); > + } > + > + if (reg & FXLS8962AF_SDCD_INT_SRC1_Z_OT) { > + ev_code = reg & FXLS8962AF_SDCD_INT_SRC1_Z_POL ? > + IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING; > + iio_push_event(indio_dev, > + IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X, > + IIO_EV_TYPE_THRESH, ev_code), ts); > + } > + > + return 0; > +} > + > static irqreturn_t fxls8962af_interrupt(int irq, void *p) > { > struct iio_dev *indio_dev = p; > @@ -744,6 +1035,14 @@ static irqreturn_t fxls8962af_interrupt(int irq, void *p) > return IRQ_HANDLED; > } > > + if (reg & FXLS8962AF_INT_STATUS_SRC_SDCD_OT) { > + ret = fxls8962af_event_interrupt(indio_dev); > + if (ret < 0) > + return IRQ_NONE; Ah the fun of what to do if you get an error in an interrupt handler. I'd normally just scream loudly and return IRQ_HANDLED anyway. However, I'm not aware of any firm rules on what to do so this is fine as well. > + > + return IRQ_HANDLED; > + } > + > return IRQ_NONE; > } >
diff --git a/drivers/iio/accel/fxls8962af-core.c b/drivers/iio/accel/fxls8962af-core.c index f41db9e0249a..857940529e7d 100644 --- a/drivers/iio/accel/fxls8962af-core.c +++ b/drivers/iio/accel/fxls8962af-core.c @@ -22,6 +22,7 @@ #include <linux/regmap.h> #include <linux/iio/buffer.h> +#include <linux/iio/events.h> #include <linux/iio/iio.h> #include <linux/iio/kfifo_buf.h> #include <linux/iio/sysfs.h> @@ -30,6 +31,7 @@ #define FXLS8962AF_INT_STATUS 0x00 #define FXLS8962AF_INT_STATUS_SRC_BOOT BIT(0) +#define FXLS8962AF_INT_STATUS_SRC_SDCD_OT BIT(4) #define FXLS8962AF_INT_STATUS_SRC_BUF BIT(5) #define FXLS8962AF_INT_STATUS_SRC_DRDY BIT(7) #define FXLS8962AF_TEMP_OUT 0x01 @@ -73,6 +75,7 @@ #define FXLS8962AF_ASLP_COUNT_LSB 0x1e #define FXLS8962AF_INT_EN 0x20 +#define FXLS8962AF_INT_EN_SDCD_OT_EN BIT(5) #define FXLS8962AF_INT_EN_BUF_EN BIT(6) #define FXLS8962AF_INT_PIN_SEL 0x21 #define FXLS8962AF_INT_PIN_SEL_MASK GENMASK(7, 0) @@ -96,9 +99,21 @@ #define FXLS8962AF_ORIENT_THS_REG 0x2c #define FXLS8962AF_SDCD_INT_SRC1 0x2d +#define FXLS8962AF_SDCD_INT_SRC1_X_OT BIT(5) +#define FXLS8962AF_SDCD_INT_SRC1_X_POL BIT(4) +#define FXLS8962AF_SDCD_INT_SRC1_Y_OT BIT(3) +#define FXLS8962AF_SDCD_INT_SRC1_Y_POL BIT(2) +#define FXLS8962AF_SDCD_INT_SRC1_Z_OT BIT(1) +#define FXLS8962AF_SDCD_INT_SRC1_Z_POL BIT(0) #define FXLS8962AF_SDCD_INT_SRC2 0x2e #define FXLS8962AF_SDCD_CONFIG1 0x2f +#define FXLS8962AF_SDCD_CONFIG1_Z_OT_EN BIT(3) +#define FXLS8962AF_SDCD_CONFIG1_Y_OT_EN BIT(4) +#define FXLS8962AF_SDCD_CONFIG1_X_OT_EN BIT(5) +#define FXLS8962AF_SDCD_CONFIG1_OT_ELE BIT(7) #define FXLS8962AF_SDCD_CONFIG2 0x30 +#define FXLS8962AF_SDCD_CONFIG2_SDCD_EN BIT(7) +#define FXLS8962AF_SC2_REF_UPDM_AC GENMASK(6, 5) #define FXLS8962AF_SDCD_OT_DBCNT 0x31 #define FXLS8962AF_SDCD_WT_DBCNT 0x32 #define FXLS8962AF_SDCD_LTHS_LSB 0x33 @@ -152,6 +167,9 @@ struct fxls8962af_data { int64_t timestamp, old_timestamp; /* Only used in hw fifo mode. */ struct iio_mount_matrix orientation; u8 watermark; + u8 enable_event; + u16 lower_thres; + u16 upper_thres; }; const struct regmap_config fxls8962af_regmap_conf = { @@ -238,7 +256,7 @@ static int fxls8962af_get_out(struct fxls8962af_data *data, } ret = regmap_bulk_read(data->regmap, chan->address, - &raw_val, (chan->scan_type.storagebits / 8)); + &raw_val, sizeof(data->lower_thres)); if (!is_active) fxls8962af_power_off(data); @@ -451,6 +469,15 @@ static int fxls8962af_write_raw(struct iio_dev *indio_dev, } } +static int fxls8962af_event_setup(struct fxls8962af_data *data, int state) +{ + /* Enable wakeup interrupt */ + int mask = FXLS8962AF_INT_EN_SDCD_OT_EN; + int value = state ? mask : 0; + + return regmap_update_bits(data->regmap, FXLS8962AF_INT_EN, mask, value); +} + static int fxls8962af_set_watermark(struct iio_dev *indio_dev, unsigned val) { struct fxls8962af_data *data = iio_priv(indio_dev); @@ -463,6 +490,221 @@ static int fxls8962af_set_watermark(struct iio_dev *indio_dev, unsigned val) return 0; } +static int __fxls8962af_set_thresholds(struct fxls8962af_data *data, + const struct iio_chan_spec *chan, + enum iio_event_direction dir, + int val) +{ + switch (dir) { + case IIO_EV_DIR_FALLING: + data->lower_thres = val; + return regmap_bulk_write(data->regmap, FXLS8962AF_SDCD_LTHS_LSB, + &data->lower_thres, sizeof(data->lower_thres)); + case IIO_EV_DIR_RISING: + data->upper_thres = val; + return regmap_bulk_write(data->regmap, FXLS8962AF_SDCD_UTHS_LSB, + &data->upper_thres, sizeof(data->upper_thres)); + default: + return -EINVAL; + } +} + +static int fxls8962af_read_event(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) +{ + struct fxls8962af_data *data = iio_priv(indio_dev); + int ret; + + if (type != IIO_EV_TYPE_THRESH) + return -EINVAL; + + switch (dir) { + case IIO_EV_DIR_FALLING: + ret = regmap_bulk_read(data->regmap, FXLS8962AF_SDCD_LTHS_LSB, + &data->lower_thres, sizeof(data->lower_thres)); + if (ret) + return ret; + + *val = sign_extend32(data->lower_thres, chan->scan_type.realbits - 1); + break; + case IIO_EV_DIR_RISING: + ret = regmap_bulk_read(data->regmap, FXLS8962AF_SDCD_UTHS_LSB, + &data->upper_thres, sizeof(data->upper_thres)); + if (ret) + return ret; + + *val = sign_extend32(data->upper_thres, chan->scan_type.realbits - 1); + break; + default: + return -EINVAL; + } + + + return IIO_VAL_INT; +} + +static int fxls8962af_write_event(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) +{ + struct fxls8962af_data *data = iio_priv(indio_dev); + int ret, val_masked; + + if (type != IIO_EV_TYPE_THRESH) + return -EINVAL; + + if (val < -2048 || val > 2047) + return -EINVAL; + + if (data->enable_event) + return -EBUSY; + + val_masked = val & GENMASK(11, 0); + if (fxls8962af_is_active(data)) { + ret = fxls8962af_standby(data); + if (ret) + return ret; + + ret = __fxls8962af_set_thresholds(data, chan, dir, val_masked); + if (ret) + return ret; + + ret = fxls8962af_active(data); + } else { + return __fxls8962af_set_thresholds(data, chan, dir, val_masked); + } + + return ret; +} + +static int +fxls8962af_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 fxls8962af_data *data = iio_priv(indio_dev); + + if (type != IIO_EV_TYPE_THRESH) + return -EINVAL; + + switch (chan->channel2) { + case IIO_MOD_X: + return !!(FXLS8962AF_SDCD_CONFIG1_X_OT_EN & data->enable_event); + case IIO_MOD_Y: + return !!(FXLS8962AF_SDCD_CONFIG1_Y_OT_EN & data->enable_event); + case IIO_MOD_Z: + return !!(FXLS8962AF_SDCD_CONFIG1_Z_OT_EN & data->enable_event); + default: + return -EINVAL; + } +} + +static int +fxls8962af_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 fxls8962af_data *data = iio_priv(indio_dev); + u8 enable_event, enable_bits; + int ret, value; + + if (type != IIO_EV_TYPE_THRESH) + return -EINVAL; + + switch (chan->channel2) { + case IIO_MOD_X: + enable_bits = FXLS8962AF_SDCD_CONFIG1_X_OT_EN; + break; + case IIO_MOD_Y: + enable_bits = FXLS8962AF_SDCD_CONFIG1_Y_OT_EN; + break; + case IIO_MOD_Z: + enable_bits = FXLS8962AF_SDCD_CONFIG1_Z_OT_EN; + break; + default: + return -EINVAL; + } + + if (state) + enable_event = data->enable_event | enable_bits; + else + enable_event = data->enable_event & ~enable_bits; + + if (data->enable_event == enable_event) + return 0; + + fxls8962af_standby(data); + + /* Enable events */ + value = enable_event | FXLS8962AF_SDCD_CONFIG1_OT_ELE; + ret = regmap_write(data->regmap, FXLS8962AF_SDCD_CONFIG1, value); + if (ret) + return ret; + + /* + * Enable update of SDCD_REF_X/Y/Z values with the current decimated and + * trimmed X/Y/Z acceleration input data. This allows for acceleration + * slope detection with Data(n) to Data(n–1) always used as the input + * to the window comparator. + */ + value = enable_event ? + FXLS8962AF_SDCD_CONFIG2_SDCD_EN | FXLS8962AF_SC2_REF_UPDM_AC : + 0x00; + + ret = regmap_write(data->regmap, FXLS8962AF_SDCD_CONFIG2, value); + if (ret) + return ret; + + ret = fxls8962af_event_setup(data, state); + if (ret) + return ret; + + data->enable_event = enable_event; + + if (data->enable_event) { + fxls8962af_active(data); + ret = fxls8962af_power_on(data); + } else { + ret = iio_device_claim_direct_mode(indio_dev); + if (ret) + return ret; + + if (!iio_buffer_enabled(indio_dev)) + ret = fxls8962af_power_off(data); + + iio_device_release_direct_mode(indio_dev); + } + + return ret; +} + +static const struct iio_event_spec fxls8962af_event[] = { + { + .type = IIO_EV_TYPE_THRESH, + .dir = IIO_EV_DIR_EITHER, + .mask_separate = BIT(IIO_EV_INFO_ENABLE), + }, + { + .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_RISING, + .mask_separate = BIT(IIO_EV_INFO_VALUE), + }, +}; + #define FXLS8962AF_CHANNEL(axis, reg, idx) { \ .type = IIO_ACCEL, \ .address = reg, \ @@ -481,6 +723,8 @@ static int fxls8962af_set_watermark(struct iio_dev *indio_dev, unsigned val) .shift = 4, \ .endianness = IIO_BE, \ }, \ + .event_spec = fxls8962af_event, \ + .num_event_specs = ARRAY_SIZE(fxls8962af_event), \ } #define FXLS8962AF_TEMP_CHANNEL { \ @@ -522,6 +766,10 @@ static const struct iio_info fxls8962af_info = { .read_raw = &fxls8962af_read_raw, .write_raw = &fxls8962af_write_raw, .write_raw_get_fmt = fxls8962af_write_raw_get_fmt, + .read_event_value = fxls8962af_read_event, + .write_event_value = fxls8962af_write_event, + .read_event_config = fxls8962af_read_event_config, + .write_event_config = fxls8962af_write_event_config, .read_avail = fxls8962af_read_avail, .hwfifo_set_watermark = fxls8962af_set_watermark, }; @@ -605,7 +853,8 @@ static int fxls8962af_buffer_predisable(struct iio_dev *indio_dev) ret = __fxls8962af_fifo_set_mode(data, false); - fxls8962af_active(data); + if (data->enable_event) + fxls8962af_active(data); return ret; } @@ -614,7 +863,10 @@ static int fxls8962af_buffer_postdisable(struct iio_dev *indio_dev) { struct fxls8962af_data *data = iio_priv(indio_dev); - return fxls8962af_power_off(data); + if (!data->enable_event) + fxls8962af_power_off(data); + + return 0; } static const struct iio_buffer_setup_ops fxls8962af_buffer_ops = { @@ -725,6 +977,45 @@ static int fxls8962af_fifo_flush(struct iio_dev *indio_dev) return count; } +static int fxls8962af_event_interrupt(struct iio_dev *indio_dev) +{ + struct fxls8962af_data *data = iio_priv(indio_dev); + s64 ts = iio_get_time_ns(indio_dev); + unsigned int reg; + u64 ev_code; + int ret; + + ret = regmap_read(data->regmap, FXLS8962AF_SDCD_INT_SRC1, ®); + if (ret) + return ret; + + if (reg & FXLS8962AF_SDCD_INT_SRC1_X_OT) { + ev_code = reg & FXLS8962AF_SDCD_INT_SRC1_X_POL ? + IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING; + iio_push_event(indio_dev, + IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X, + IIO_EV_TYPE_THRESH, ev_code), ts); + } + + if (reg & FXLS8962AF_SDCD_INT_SRC1_Y_OT) { + ev_code = reg & FXLS8962AF_SDCD_INT_SRC1_Y_POL ? + IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING; + iio_push_event(indio_dev, + IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X, + IIO_EV_TYPE_THRESH, ev_code), ts); + } + + if (reg & FXLS8962AF_SDCD_INT_SRC1_Z_OT) { + ev_code = reg & FXLS8962AF_SDCD_INT_SRC1_Z_POL ? + IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING; + iio_push_event(indio_dev, + IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X, + IIO_EV_TYPE_THRESH, ev_code), ts); + } + + return 0; +} + static irqreturn_t fxls8962af_interrupt(int irq, void *p) { struct iio_dev *indio_dev = p; @@ -744,6 +1035,14 @@ static irqreturn_t fxls8962af_interrupt(int irq, void *p) return IRQ_HANDLED; } + if (reg & FXLS8962AF_INT_STATUS_SRC_SDCD_OT) { + ret = fxls8962af_event_interrupt(indio_dev); + if (ret < 0) + return IRQ_NONE; + + return IRQ_HANDLED; + } + return IRQ_NONE; }
Add event channels that control the creation of motion events. Signed-off-by: Sean Nyekjaer <sean@geanix.com> --- Changes since v1/v2: - Fixed comments fron Andy (Thanks) - Corrected sign mess Changes since v3: - Switched to absolute comparison mode(We could add ROC in the future if needed.) - Added separate falling and rising events and one enable pr. axis'. - Fixed standby in fxls8962af_write_event_config() - Added read of X_OT_POL and signal a falling or rising event. I'm currently not using pm_runtime resume/suspend for event handling, maybe we should. drivers/iio/accel/fxls8962af-core.c | 305 +++++++++++++++++++++++++++- 1 file changed, 302 insertions(+), 3 deletions(-)