iio: imu: st_lsm6dsx: move interrupt thread to core
Subsystems (2)
PATCH v2 1/6 iio: imu: st_lsm6dsx: move interrupt thread to core
This prepares the interrupt to be used for other stuff than fifo reading + event readings.
---
Changes since v1:
* none
.../iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c | 78 +---------------- drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 87 +++++++++++++++++++ 2 files changed, 88 insertions(+), 77 deletions(-)
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c +1 -77
@@ -29,8 +29,6 @@* Denis Ciocca <[email protected]> */ #include <linux/module.h> -#include <linux/interrupt.h> -#include <linux/irq.h> #include <linux/iio/kfifo_buf.h> #include <linux/iio/iio.h> #include <linux/iio/buffer.h>
@@ -41,10 +39,6 @@#include "st_lsm6dsx.h" -#define ST_LSM6DSX_REG_HLACTIVE_ADDR 0x12 -#define ST_LSM6DSX_REG_HLACTIVE_MASK BIT(5) -#define ST_LSM6DSX_REG_PP_OD_ADDR 0x12 -#define ST_LSM6DSX_REG_PP_OD_MASK BIT(4)#define ST_LSM6DSX_REG_FIFO_MODE_ADDR 0x0a#define ST_LSM6DSX_FIFO_MODE_MASK GENMASK(2, 0)#define ST_LSM6DSX_FIFO_ODR_MASK GENMASK(6, 3)
@@ -654,25 +648,6 @@ static int st_lsm6dsx_update_fifo(struct iio_dev *iio_dev, bool enable)return err; } -static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) -{ -struct st_lsm6dsx_hw *hw = private; - -return hw->sip >0 ?IRQ_WAKE_THREAD :IRQ_NONE ; -} - -static irqreturn_t st_lsm6dsx_handler_thread (int irq,void *private) -{ -struct st_lsm6dsx_hw *hw = private; -int count; - -mutex_lock (&hw->fifo_lock); - count = hw->settings->fifo_ops.read_fifo (hw); -mutex_unlock (&hw->fifo_lock); - -return !count ?IRQ_NONE :IRQ_HANDLED ; -} -static int st_lsm6dsx_buffer_preenable (struct iio_dev *iio_dev) {return st_lsm6dsx_update_fifo (iio_dev, true);
@@ -690,59 +665,8 @@ static const struct iio_buffer_setup_ops st_lsm6dsx_buffer_ops = {int st_lsm6dsx_fifo_setup (struct st_lsm6dsx_hw *hw) { -struct device_node *np = hw->dev->of_node; -struct st_sensors_platform_data *pdata;struct iio_buffer *buffer; -unsigned long irq_type; -bool irq_active_low; -int i, err; - - irq_type =irqd_get_trigger_type (irq_get_irq_data (hw->irq)); - -switch (irq_type) { -case IRQF_TRIGGER_HIGH : -case IRQF_TRIGGER_RISING : - irq_active_low = false; -break ; -case IRQF_TRIGGER_LOW : -case IRQF_TRIGGER_FALLING : - irq_active_low = true; -break ; -default : -dev_info (hw->dev,"mode %lx unsupported\n" , irq_type); -return -EINVAL ; - } - - err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_HLACTIVE_ADDR , -ST_LSM6DSX_REG_HLACTIVE_MASK , -FIELD_PREP (ST_LSM6DSX_REG_HLACTIVE_MASK , - irq_active_low)); -if (err <0 ) -return err; - - pdata = (struct st_sensors_platform_data *)hw->dev->platform_data; -if ((np &&of_property_read_bool (np,"drive-open-drain" )) || - (pdata && pdata->open_drain)) { - err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_PP_OD_ADDR , -ST_LSM6DSX_REG_PP_OD_MASK , -FIELD_PREP (ST_LSM6DSX_REG_PP_OD_MASK , -1 )); -if (err <0 ) -return err; - - irq_type |=IRQF_SHARED ; - } - - err =devm_request_threaded_irq (hw->dev, hw->irq, - st_lsm6dsx_handler_irq, - st_lsm6dsx_handler_thread, - irq_type |IRQF_ONESHOT , -"lsm6dsx" , hw); -if (err) { -dev_err (hw->dev,"failed to request trigger irq %d\n" , - hw->irq); -return err; - } +int i;for (i =0 ; i <ST_LSM6DSX_ID_MAX ; i++) {if (!hw->iio_devs[i])
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +87 -0
111 lines not on this page · raw message
Signature · 1 line
2.22.0
PATCH v2 2/6 iio: imu: st_lsm6dsx: save drdy_pin in device struct
This prepares the use of the drdy_pin for selecting the correct event interrupt register.
---
Changes since v1:
* new commit
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h | 1 + drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 8 ++++---- 2 files changed, 5 insertions(+), 4 deletions(-)
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +1 -0
@@ -297,6 +297,7 @@ struct st_lsm6dsx_hw {u8 enable_mask;u8 ts_sip;u8 sip; +int drdy_pin;u8 *buff;
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +4 -4
@@ -871,17 +871,17 @@ static int st_lsm6dsx_of_get_drdy_pin(struct st_lsm6dsx_hw *hw, int *drdy_pin)static int st_lsm6dsx_get_drdy_reg (struct st_lsm6dsx_hw *hw,u8 *drdy_reg) { -int err =0 , drdy_pin; +int err =0 ; -if (st_lsm6dsx_of_get_drdy_pin (hw, &drdy_pin) <0 ) { +if (st_lsm6dsx_of_get_drdy_pin (hw, &hw->drdy_pin) <0 ) {struct st_sensors_platform_data *pdata;struct device *dev = hw->dev; pdata = (struct st_sensors_platform_data *)dev->platform_data; - drdy_pin = pdata ? pdata->drdy_int_pin :1 ; + hw->drdy_pin = pdata ? pdata->drdy_int_pin :1 ; } -switch (drdy_pin) { +switch (hw->drdy_pin) {case 1 : *drdy_reg =ST_LSM6DSX_REG_INT1_ADDR ;break ;
Signature · 1 line
2.22.0
PATCH v2 3/6 iio: imu: st_lsm6dsx: add motion events
In reply to Sean NyekjaerAdd event channels that controls the creation of motion events.
---
Changes since v1:
* added handling of LSM6
* added CHANNEL info with events for ACC
* removed st_lsm6dsx_set_event_threshold function
* added check of event type to event channels
Issues:
* This currently breaks buffered reads, as the interrupt stays high. This happens when MD1_CFG INT1_WU (wakeup event routes to INT1) is enabled.
The datasheet doesn't seem to decribe whats happening and I can't find a status register to read somehing useful.
Maybe it's impossible to share the buffered reads interrupt with the wakeup interrupt?
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h | 30 ++++ drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 164 +++++++++++++++++-- 2 files changed, 182 insertions(+), 12 deletions(-)
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +30 -0
@@ -12,6 +12,7 @@#define ST_LSM6DSX_H #include <linux/device.h> +#include <linux/iio/iio.h> #define ST_LSM6DS3_DEV_NAME "lsm6ds3"#define ST_LSM6DS3H_DEV_NAME "lsm6ds3h"
@@ -50,6 +51,26 @@ enum st_lsm6dsx_hw_id { * ST_LSM6DSX_TAGGED_SAMPLE_SIZE)#define ST_LSM6DSX_SHIFT_VAL (val, mask) (((val) << __ffs(mask)) & (mask)) +#define ST_LSM6DSX_CHANNEL_ACC (chan_type, addr, mod, scan_idx) \ +{ \ + .type = chan_type, \ + .address = addr, \ + .modified = 1, \ + .channel2 = mod, \ + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ + BIT(IIO_CHAN_INFO_SCALE), \ + .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \ + .scan_index = scan_idx, \ + .scan_type = { \ + .sign = 's', \ + .realbits = 16, \ + .storagebits = 16, \ + .endianness = IIO_LE, \ + }, \ + .event_spec = &st_lsm6dsx_event, \ + .num_event_specs = 1, \ +} +#define ST_LSM6DSX_CHANNEL (chan_type, addr, mod, scan_idx) \ { \ .type = chan_type, \
@@ -297,6 +318,8 @@ struct st_lsm6dsx_hw {u8 enable_mask;u8 ts_sip;u8 sip; +u8 event_threshold; +bool enable_event;int drdy_pin;u8 *buff;
@@ -306,6 +329,13 @@ struct st_lsm6dsx_hw {const struct st_lsm6dsx_settings *settings; }; +static const struct iio_event_spec st_lsm6dsx_event = { + .type =IIO_EV_TYPE_THRESH , + .dir =IIO_EV_DIR_EITHER , + .mask_separate =BIT (IIO_EV_INFO_VALUE ) | +BIT (IIO_EV_INFO_ENABLE ) +}; +static const unsigned long st_lsm6dsx_available_scan_masks[] = {0x7 ,0x0 };extern const struct dev_pm_ops st_lsm6dsx_pm_ops;
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +152 -12
212 lines not on this page · raw message
Signature · 1 line
2.22.0
Lorenzo Bianconi
maintainerRe: [PATCH v2 3/6] iio: imu: st_lsm6dsx: add motion events
Quoted 11 lines
Add event channels that controls the creation of motion events.
Signed-off-by Sean Nyekjaer <[email protected]>---
Changes since v1:
* added handling of LSM6
* added CHANNEL info with events for ACC
* removedst_lsm6dsx_set_event_thresholdfunction
* added check of event type to event channels
Quoted 8 lines
Issues:
* This currently breaks buffered reads, as the interrupt stays high. This happens whenMD1_CFGINT1_WU(wakeup event routes to INT1) is enabled.
The datasheet doesn't seem to decribe whats happening and I can't find a status register to read somehing useful.
Maybe it's impossible to share the buffered reads interrupt with the wakeup interrupt?
Could you explain this issue a bit more? adding st folks...
Quoted 30 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h | 30 ++++ drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 164 +++++++++++++++++-- 2 files changed, 182 insertions(+), 12 deletions(-)drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0@@ -12,6 +12,7 @@#define ST_LSM6DSX_H #include <linux/device.h> +#include <linux/iio/iio.h> #define ST_LSM6DS3_DEV_NAME "lsm6ds3"#define ST_LSM6DS3H_DEV_NAME "lsm6ds3h"@@ -50,6 +51,26 @@ enum st_lsm6dsx_hw_id { * ST_LSM6DSX_TAGGED_SAMPLE_SIZE)#define ST_LSM6DSX_SHIFT_VAL (val, mask) (((val) << __ffs(mask)) & (mask)) +#define ST_LSM6DSX_CHANNEL_ACC (chan_type, addr, mod, scan_idx) \ +{ \ + .type = chan_type, \ + .address = addr, \ + .modified = 1, \ + .channel2 = mod, \ + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ + BIT(IIO_CHAN_INFO_SCALE), \ + .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h enum st_lsm6dsx_hw_id { · line 72
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0+ .scan_index = scan_idx, \ + .scan_type = { \ + .sign = 's', \ + .realbits = 16, \ + .storagebits = 16, \ + .endianness = IIO_LE, \ + }, \ + .event_spec = &st_lsm6dsx_event, \ + .num_event_specs = 1, \ +}
I would prefer to extend existing macros
Quoted 32 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0+#define ST_LSM6DSX_CHANNEL (chan_type, addr, mod, scan_idx) \ { \ .type = chan_type, \@@ -297,6 +318,8 @@ struct st_lsm6dsx_hw {u8 enable_mask;u8 ts_sip;u8 sip; +u8 event_threshold; +bool enable_event;int drdy_pin;u8 *buff;@@ -306,6 +329,13 @@ struct st_lsm6dsx_hw {const struct st_lsm6dsx_settings *settings; }; +static const struct iio_event_spec st_lsm6dsx_event = { + .type =IIO_EV_TYPE_THRESH , + .dir =IIO_EV_DIR_EITHER , + .mask_separate =BIT (IIO_EV_INFO_VALUE ) | +BIT (IIO_EV_INFO_ENABLE ) +}; +static const unsigned long st_lsm6dsx_available_scan_masks[] = {0x7 ,0x0 };extern const struct dev_pm_ops st_lsm6dsx_pm_ops;drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +0
-0
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c line 80
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +2
-0@@ -76,6 +76,16 @@#define ST_LSM6DSX_REG_GYRO_OUT_Y_L_ADDR 0x24#define ST_LSM6DSX_REG_GYRO_OUT_Z_L_ADDR 0x26 +#define ST_LSM6DSX_REG_TAP_CFG_ADDR 0x58 +#define ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK BIT(7)
I am pretty sure this is not true at least for lsm6ds3/lsm6ds3h
Quoted 87 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +48
-12+ +#define ST_LSM6DSX_REG_WAKE_UP_ADDR 0x5B +#define ST_LSM6DSX_REG_WAKE_UP_THRES_MASK GENMASK(5, 0) + +#define ST_LSM6DSX_REG_MD1_CFG_ADDR 0x5E +#define ST_LSM6DSX_REG_MD2_CFG_ADDR 0x5F +#define ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK BIT(5) +static const struct st_lsm6dsx_odr_table_entry st_lsm6dsx_odr_table[] = { [ST_LSM6DSX_ID_ACC ] = { .reg = {@@ -470,12 +480,12 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { };static const struct iio_chan_spec st_lsm6dsx_acc_channels[] = { -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_X_L_ADDR , -IIO_MOD_X ,0 ), -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Y_L_ADDR , -IIO_MOD_Y ,1 ), -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Z_L_ADDR , -IIO_MOD_Z ,2 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_X_L_ADDR , +IIO_MOD_X ,0 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Y_L_ADDR , +IIO_MOD_Y ,1 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Z_L_ADDR , +IIO_MOD_Z ,2 ),IIO_CHAN_SOFT_TIMESTAMP (3 ), };@@ -679,18 +689,21 @@ static int st_lsm6dsx_read_oneshot(struct st_lsm6dsx_sensor *sensor,int err, delay;__le16 data; - err =st_lsm6dsx_sensor_set_enable (sensor, true); -if (err <0 ) -return err; +if (!hw->enable_event) { + err =st_lsm6dsx_sensor_set_enable (sensor, true); +if (err <0 ) +return err; - delay =1000000 / sensor->odr; -usleep_range (delay,2 * delay); + delay =1000000 / sensor->odr; +usleep_range (delay,2 * delay); + } err =st_lsm6dsx_read_locked (hw, addr, &data,sizeof (data));if (err <0 )return err; -st_lsm6dsx_sensor_set_enable (sensor, false); +if (!hw->enable_event) +st_lsm6dsx_sensor_set_enable (sensor, false); *val = (s16 )le16_to_cpu (data);@@ -763,6 +776,94 @@ static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev,return err; } +static int st_lsm6dsx_read_event (struct iio_dev *iio_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 st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + + *val2 =0 ; + *val = hw->event_threshold; + +return IIO_VAL_INT ; +} + +static int st_lsm6dsx_write_event (struct iio_dev *iio_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)
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev, · line 813
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; +int err; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + +if (!hw->enable_event) +return -EBUSY ;
I guess it is ok to configure the threshold first, no?
Quoted 39 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +39
-0+ +if (val <0 || val >31 ) +return -EINVAL ; + + err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_WAKE_UP_ADDR , +ST_LSM6DSX_REG_WAKE_UP_THRES_MASK , + val); +if (err) +return -EINVAL ; + + hw->event_threshold = val; + +return 0 ; +} + +static int st_lsm6dsx_read_event_config (struct iio_dev *iio_dev, +const struct iio_chan_spec *chan, +enum iio_event_type type, +enum iio_event_direction dir) +{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + +return hw->enable_event; +} + +static int st_lsm6dsx_write_event_config (struct iio_dev *iio_dev, +const struct iio_chan_spec *chan, +enum iio_event_type type, +enum iio_event_direction dir, +int state) +{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH )
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev, · line 862
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+return -EINVAL ; + +if (state && hw->enable_event) +return 0 ; + + hw->enable_event = state; +if (state) +st_lsm6dsx_sensor_set_enable (sensor, true); +else +st_lsm6dsx_sensor_set_enable (sensor, false);
st_lsm6dsx_sensor_set_enable can fails. Why not do
err = st_lsm6dsx_sensor_set_enable(sensor, state); if (err < 0) return err; hw->enable_event = state;; return 0;
Quoted 22 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +8
-0+ +return 0 ; +} +int st_lsm6dsx_set_watermark (struct iio_dev *iio_dev,unsigned int val) {struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev);@@ -839,6 +940,10 @@ static const struct iio_info st_lsm6dsx_acc_info = { .attrs = &st_lsm6dsx_acc_attribute_group, .read_raw = st_lsm6dsx_read_raw, .write_raw = st_lsm6dsx_write_raw, + .read_event_value = st_lsm6dsx_read_event, + .write_event_value = st_lsm6dsx_write_event, + .read_event_config = st_lsm6dsx_read_event_config, + .write_event_config = st_lsm6dsx_write_event_config, .hwfifo_set_watermark = st_lsm6dsx_set_watermark, };@@ -1076,6 +1181,38 @@ static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw,return iio_dev; }
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw, · line 1193
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+int st_lsm6dsx_event_setup (int id,struct st_lsm6dsx_hw *hw) +{ +int err; +unsigned int md_reg; + +if (id ==ST_ISM330DLC_ID ) { +/* Enable basic interrupts for ISM330 */ + err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_TAP_CFG_ADDR , +ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK , +ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK );
please put device differences in st_lsm6dsx_sensor_settings[]
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw, · line 1198
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +5
-0+if (err <0 ) +return err; + } + +switch (hw->drdy_pin) {
drdy_pin it is only used here right? If so we do not need it just enable this configuration by default. I would prefer to maintain the code simple
Quoted 21 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +17
-0+case 1 : + md_reg =ST_LSM6DSX_REG_MD1_CFG_ADDR ; +break ; +case 2 : + md_reg =ST_LSM6DSX_REG_MD2_CFG_ADDR ; +break ; +default : +return -EINVAL ; + } +/* Enable wakeup interrupt */ + err =regmap_update_bits (hw->regmap, md_reg, +ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK , +ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK ); + +return err; +} +static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) {struct st_lsm6dsx_hw *hw = private;
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, · line 1346
Quoted 3 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +0
-0@@ -1207,6 +1344,9 @@ int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, err =st_lsm6dsx_fifo_setup (hw);if (err <0 )return err;
newline here please
Quoted 9 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +3
-0+ err =st_lsm6dsx_event_setup (hw_id, hw); +if (err <0 ) +return err; }for (i =0 ; i <ST_LSM6DSX_ID_MAX ; i++) {Signature · 1 line
2.22.0
Jonathan Cameron
maintainerRe: [PATCH v2 3/6] iio: imu: st_lsm6dsx: add motion events
Quoted 20 lines · On Tue, 16 Jul 2019 10:29:27 +0200 Lorenzo Bianconi <[email protected]> wrote:
Quoted 11 lines
Add event channels that controls the creation of motion events.
Signed-off-by Sean Nyekjaer <[email protected]>---
Changes since v1:
* added handling of LSM6
* added CHANNEL info with events for ACC
* removedst_lsm6dsx_set_event_thresholdfunction
* added check of event type to event channelsQuoted 8 lines
Issues:
* This currently breaks buffered reads, as the interrupt stays high. This happens whenMD1_CFGINT1_WU(wakeup event routes to INT1) is enabled.
The datasheet doesn't seem to decribe whats happening and I can't find a status register to read somehing useful.
Maybe it's impossible to share the buffered reads interrupt with the wakeup interrupt?
Quoted 1 line
Could you explain this issue a bit more? adding st folks...
This isn't totally unheard of for other hardware. If it turns out to be a hardware restriction then the software approach is to return -EBUSY if anyone tries to enable an event whilst in buffered mode, and -EBUSY if anyone tries to enable buffered mode with an event enabled.
It's rather ugly though definitely good to see if there is a proper solution!
Thanks,
Jonathan
Quoted 323 lines
Quoted 31 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h | 30 ++++ drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 164 +++++++++++++++++-- 2 files changed, 182 insertions(+), 12 deletions(-)drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0@@ -12,6 +12,7 @@#define ST_LSM6DSX_H #include <linux/device.h> +#include <linux/iio/iio.h> #define ST_LSM6DS3_DEV_NAME "lsm6ds3"#define ST_LSM6DS3H_DEV_NAME "lsm6ds3h"@@ -50,6 +51,26 @@ enum st_lsm6dsx_hw_id { * ST_LSM6DSX_TAGGED_SAMPLE_SIZE)#define ST_LSM6DSX_SHIFT_VAL (val, mask) (((val) << __ffs(mask)) & (mask)) +#define ST_LSM6DSX_CHANNEL_ACC (chan_type, addr, mod, scan_idx) \ +{ \ + .type = chan_type, \ + .address = addr, \ + .modified = 1, \ + .channel2 = mod, \ + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ + BIT(IIO_CHAN_INFO_SCALE), \ + .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h enum st_lsm6dsx_hw_id { · line 72
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0+ .scan_index = scan_idx, \ + .scan_type = { \ + .sign = 's', \ + .realbits = 16, \ + .storagebits = 16, \ + .endianness = IIO_LE, \ + }, \ + .event_spec = &st_lsm6dsx_event, \ + .num_event_specs = 1, \ +}I would prefer to extend existing macros
Quoted 32 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0+#define ST_LSM6DSX_CHANNEL (chan_type, addr, mod, scan_idx) \ { \ .type = chan_type, \@@ -297,6 +318,8 @@ struct st_lsm6dsx_hw {u8 enable_mask;u8 ts_sip;u8 sip; +u8 event_threshold; +bool enable_event;int drdy_pin;u8 *buff;@@ -306,6 +329,13 @@ struct st_lsm6dsx_hw {const struct st_lsm6dsx_settings *settings; }; +static const struct iio_event_spec st_lsm6dsx_event = { + .type =IIO_EV_TYPE_THRESH , + .dir =IIO_EV_DIR_EITHER , + .mask_separate =BIT (IIO_EV_INFO_VALUE ) | +BIT (IIO_EV_INFO_ENABLE ) +}; +static const unsigned long st_lsm6dsx_available_scan_masks[] = {0x7 ,0x0 };extern const struct dev_pm_ops st_lsm6dsx_pm_ops;drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +0
-0drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c line 80
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +2
-0@@ -76,6 +76,16 @@#define ST_LSM6DSX_REG_GYRO_OUT_Y_L_ADDR 0x24#define ST_LSM6DSX_REG_GYRO_OUT_Z_L_ADDR 0x26 +#define ST_LSM6DSX_REG_TAP_CFG_ADDR 0x58 +#define ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK BIT(7)I am pretty sure this is not true at least for lsm6ds3/lsm6ds3h
Quoted 87 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +48
-12+ +#define ST_LSM6DSX_REG_WAKE_UP_ADDR 0x5B +#define ST_LSM6DSX_REG_WAKE_UP_THRES_MASK GENMASK(5, 0) + +#define ST_LSM6DSX_REG_MD1_CFG_ADDR 0x5E +#define ST_LSM6DSX_REG_MD2_CFG_ADDR 0x5F +#define ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK BIT(5) +static const struct st_lsm6dsx_odr_table_entry st_lsm6dsx_odr_table[] = { [ST_LSM6DSX_ID_ACC ] = { .reg = {@@ -470,12 +480,12 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { };static const struct iio_chan_spec st_lsm6dsx_acc_channels[] = { -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_X_L_ADDR , -IIO_MOD_X ,0 ), -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Y_L_ADDR , -IIO_MOD_Y ,1 ), -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Z_L_ADDR , -IIO_MOD_Z ,2 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_X_L_ADDR , +IIO_MOD_X ,0 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Y_L_ADDR , +IIO_MOD_Y ,1 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Z_L_ADDR , +IIO_MOD_Z ,2 ),IIO_CHAN_SOFT_TIMESTAMP (3 ), };@@ -679,18 +689,21 @@ static int st_lsm6dsx_read_oneshot(struct st_lsm6dsx_sensor *sensor,int err, delay;__le16 data; - err =st_lsm6dsx_sensor_set_enable (sensor, true); -if (err <0 ) -return err; +if (!hw->enable_event) { + err =st_lsm6dsx_sensor_set_enable (sensor, true); +if (err <0 ) +return err; - delay =1000000 / sensor->odr; -usleep_range (delay,2 * delay); + delay =1000000 / sensor->odr; +usleep_range (delay,2 * delay); + } err =st_lsm6dsx_read_locked (hw, addr, &data,sizeof (data));if (err <0 )return err; -st_lsm6dsx_sensor_set_enable (sensor, false); +if (!hw->enable_event) +st_lsm6dsx_sensor_set_enable (sensor, false); *val = (s16 )le16_to_cpu (data);@@ -763,6 +776,94 @@ static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev,return err; } +static int st_lsm6dsx_read_event (struct iio_dev *iio_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 st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + + *val2 =0 ; + *val = hw->event_threshold; + +return IIO_VAL_INT ; +} + +static int st_lsm6dsx_write_event (struct iio_dev *iio_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)drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev, · line 813
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; +int err; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + +if (!hw->enable_event) +return -EBUSY ;I guess it is ok to configure the threshold first, no?
Quoted 39 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +39
-0+ +if (val <0 || val >31 ) +return -EINVAL ; + + err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_WAKE_UP_ADDR , +ST_LSM6DSX_REG_WAKE_UP_THRES_MASK , + val); +if (err) +return -EINVAL ; + + hw->event_threshold = val; + +return 0 ; +} + +static int st_lsm6dsx_read_event_config (struct iio_dev *iio_dev, +const struct iio_chan_spec *chan, +enum iio_event_type type, +enum iio_event_direction dir) +{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + +return hw->enable_event; +} + +static int st_lsm6dsx_write_event_config (struct iio_dev *iio_dev, +const struct iio_chan_spec *chan, +enum iio_event_type type, +enum iio_event_direction dir, +int state) +{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH )drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev, · line 862
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+return -EINVAL ; + +if (state && hw->enable_event) +return 0 ; + + hw->enable_event = state; +if (state) +st_lsm6dsx_sensor_set_enable (sensor, true); +else +st_lsm6dsx_sensor_set_enable (sensor, false);
st_lsm6dsx_sensor_set_enablecan fails. Why not doerr = st_lsm6dsx_sensor_set_enable(sensor, state); if (err < 0) return err; hw->enable_event = state;; return 0;Quoted 22 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +8
-0+ +return 0 ; +} +int st_lsm6dsx_set_watermark (struct iio_dev *iio_dev,unsigned int val) {struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev);@@ -839,6 +940,10 @@ static const struct iio_info st_lsm6dsx_acc_info = { .attrs = &st_lsm6dsx_acc_attribute_group, .read_raw = st_lsm6dsx_read_raw, .write_raw = st_lsm6dsx_write_raw, + .read_event_value = st_lsm6dsx_read_event, + .write_event_value = st_lsm6dsx_write_event, + .read_event_config = st_lsm6dsx_read_event_config, + .write_event_config = st_lsm6dsx_write_event_config, .hwfifo_set_watermark = st_lsm6dsx_set_watermark, };@@ -1076,6 +1181,38 @@ static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw,return iio_dev; }drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw, · line 1193
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+int st_lsm6dsx_event_setup (int id,struct st_lsm6dsx_hw *hw) +{ +int err; +unsigned int md_reg; + +if (id ==ST_ISM330DLC_ID ) { +/* Enable basic interrupts for ISM330 */ + err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_TAP_CFG_ADDR , +ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK , +ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK );please put device differences in st_lsm6dsx_sensor_settings[]
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw, · line 1198
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +5
-0+if (err <0 ) +return err; + } + +switch (hw->drdy_pin) {
drdy_pinit is only used here right? If so we do not need it just enable this configuration by default. I would prefer to maintain the code simpleQuoted 21 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +17
-0+case 1 : + md_reg =ST_LSM6DSX_REG_MD1_CFG_ADDR ; +break ; +case 2 : + md_reg =ST_LSM6DSX_REG_MD2_CFG_ADDR ; +break ; +default : +return -EINVAL ; + } +/* Enable wakeup interrupt */ + err =regmap_update_bits (hw->regmap, md_reg, +ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK , +ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK ); + +return err; +} +static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) {struct st_lsm6dsx_hw *hw = private;drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, · line 1346
Quoted 3 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +0
-0@@ -1207,6 +1344,9 @@ int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, err =st_lsm6dsx_fifo_setup (hw);if (err <0 )return err;newline here please
Quoted 9 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +3
-0+ err =st_lsm6dsx_event_setup (hw_id, hw); +if (err <0 ) +return err; }for (i =0 ; i <ST_LSM6DSX_ID_MAX ; i++) {Signature · 1 line
2.22.0
Re: [PATCH v2 3/6] iio: imu: st_lsm6dsx: add motion events
In reply to Lorenzo BianconiBack from vacation :-)
Quoted 20 lines · Lorenzo Bianconi
Quoted 11 lines
Add event channels that controls the creation of motion events.
Signed-off-by Sean Nyekjaer <[email protected]>---
Changes since v1:
* added handling of LSM6
* added CHANNEL info with events for ACC
* removedst_lsm6dsx_set_event_thresholdfunction
* added check of event type to event channelsQuoted 8 lines
Issues:
* This currently breaks buffered reads, as the interrupt stays high. This happens whenMD1_CFGINT1_WU(wakeup event routes to INT1) is enabled.
The datasheet doesn't seem to decribe whats happening and I can't find a status register to read somehing useful.
Maybe it's impossible to share the buffered reads interrupt with the wakeup interrupt?
Quoted 2 lines
Could you explain this issue a bit more? adding st folks...
I can try, there is not much to it...
When buffered reads is enabled, and I enable wake-up at the same time, and then drop or shake the acc to create an event. The irq pin stays high, expected behavior would be it drops again when the buffer is read and the event is finished signaling.
Quoted 34 lines
Quoted 34 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h | 30 ++++ drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 164 +++++++++++++++++-- 2 files changed, 182 insertions(+), 12 deletions(-)drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +14
-0@@ -12,6 +12,7 @@#define ST_LSM6DSX_H #include <linux/device.h> +#include <linux/iio/iio.h> #define ST_LSM6DS3_DEV_NAME "lsm6ds3"#define ST_LSM6DS3H_DEV_NAME "lsm6ds3h"@@ -50,6 +51,26 @@ enum st_lsm6dsx_hw_id { * ST_LSM6DSX_TAGGED_SAMPLE_SIZE)#define ST_LSM6DSX_SHIFT_VAL (val, mask) (((val) << __ffs(mask)) & (mask)) +#define ST_LSM6DSX_CHANNEL_ACC (chan_type, addr, mod, scan_idx) \ +{ \ + .type = chan_type, \ + .address = addr, \ + .modified = 1, \ + .channel2 = mod, \ + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ + BIT(IIO_CHAN_INFO_SCALE), \ + .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \ + .scan_index = scan_idx, \ + .scan_type = { \ + .sign = 's', \ + .realbits = 16, \
Quoted 9 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h enum st_lsm6dsx_hw_id { · line 72
Quoted 6 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +6
-0+ .storagebits = 16, \ + .endianness = IIO_LE, \ + }, \ + .event_spec = &st_lsm6dsx_event, \ + .num_event_specs = 1, \ +}I would prefer to extend existing macros
Please explain how...
Quoted 35 lines
Quoted 35 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0+#define ST_LSM6DSX_CHANNEL (chan_type, addr, mod, scan_idx) \ { \ .type = chan_type, \@@ -297,6 +318,8 @@ struct st_lsm6dsx_hw {u8 enable_mask;u8 ts_sip;u8 sip; +u8 event_threshold; +bool enable_event;int drdy_pin;u8 *buff;@@ -306,6 +329,13 @@ struct st_lsm6dsx_hw {const struct st_lsm6dsx_settings *settings; }; +static const struct iio_event_spec st_lsm6dsx_event = { + .type =IIO_EV_TYPE_THRESH , + .dir =IIO_EV_DIR_EITHER , + .mask_separate =BIT (IIO_EV_INFO_VALUE ) | +BIT (IIO_EV_INFO_ENABLE ) +}; +static const unsigned long st_lsm6dsx_available_scan_masks[] = {0x7 ,0x0 };extern const struct dev_pm_ops st_lsm6dsx_pm_ops;drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +0
-0@@ -76,6 +76,16 @@#define ST_LSM6DSX_REG_GYRO_OUT_Y_L_ADDR 0x24#define ST_LSM6DSX_REG_GYRO_OUT_Z_L_ADDR 0x26
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c line 80
Quoted 2 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +2
-0+#define ST_LSM6DSX_REG_TAP_CFG_ADDR 0x58 +#define ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK BIT(7)I am pretty sure this is not true at least for lsm6ds3/lsm6ds3h
Will check
Quoted 91 lines
Quoted 91 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +52
-12+ +#define ST_LSM6DSX_REG_WAKE_UP_ADDR 0x5B +#define ST_LSM6DSX_REG_WAKE_UP_THRES_MASK GENMASK(5, 0) + +#define ST_LSM6DSX_REG_MD1_CFG_ADDR 0x5E +#define ST_LSM6DSX_REG_MD2_CFG_ADDR 0x5F +#define ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK BIT(5) +static const struct st_lsm6dsx_odr_table_entry st_lsm6dsx_odr_table[] = { [ST_LSM6DSX_ID_ACC ] = { .reg = {@@ -470,12 +480,12 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { };static const struct iio_chan_spec st_lsm6dsx_acc_channels[] = { -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_X_L_ADDR , -IIO_MOD_X ,0 ), -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Y_L_ADDR , -IIO_MOD_Y ,1 ), -ST_LSM6DSX_CHANNEL (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Z_L_ADDR , -IIO_MOD_Z ,2 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_X_L_ADDR , +IIO_MOD_X ,0 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Y_L_ADDR , +IIO_MOD_Y ,1 ), +ST_LSM6DSX_CHANNEL_ACC (IIO_ACCEL ,ST_LSM6DSX_REG_ACC_OUT_Z_L_ADDR , +IIO_MOD_Z ,2 ),IIO_CHAN_SOFT_TIMESTAMP (3 ), };@@ -679,18 +689,21 @@ static int st_lsm6dsx_read_oneshot(struct st_lsm6dsx_sensor *sensor,int err, delay;__le16 data; - err =st_lsm6dsx_sensor_set_enable (sensor, true); -if (err <0 ) -return err; +if (!hw->enable_event) { + err =st_lsm6dsx_sensor_set_enable (sensor, true); +if (err <0 ) +return err; - delay =1000000 / sensor->odr; -usleep_range (delay,2 * delay); + delay =1000000 / sensor->odr; +usleep_range (delay,2 * delay); + } err =st_lsm6dsx_read_locked (hw, addr, &data,sizeof (data));if (err <0 )return err; -st_lsm6dsx_sensor_set_enable (sensor, false); +if (!hw->enable_event) +st_lsm6dsx_sensor_set_enable (sensor, false); *val = (s16 )le16_to_cpu (data);@@ -763,6 +776,94 @@ static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev,return err; } +static int st_lsm6dsx_read_event (struct iio_dev *iio_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 st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + + *val2 =0 ; + *val = hw->event_threshold; + +return IIO_VAL_INT ; +} + +static int st_lsm6dsx_write_event (struct iio_dev *iio_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 st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; +int err;
Quoted 9 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev, · line 813
Quoted 6 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +6
-0+ +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + +if (!hw->enable_event) +return -EBUSY ;I guess it is ok to configure the threshold first, no?
Will test and allow the threshold to be configured first.
Quoted 52 lines
Quoted 39 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +39
-0+ +if (val <0 || val >31 ) +return -EINVAL ; + + err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_WAKE_UP_ADDR , +ST_LSM6DSX_REG_WAKE_UP_THRES_MASK , + val); +if (err) +return -EINVAL ; + + hw->event_threshold = val; + +return 0 ; +} + +static int st_lsm6dsx_read_event_config (struct iio_dev *iio_dev, +const struct iio_chan_spec *chan, +enum iio_event_type type, +enum iio_event_direction dir) +{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH ) +return -EINVAL ; + +return hw->enable_event; +} + +static int st_lsm6dsx_write_event_config (struct iio_dev *iio_dev, +const struct iio_chan_spec *chan, +enum iio_event_type type, +enum iio_event_direction dir, +int state) +{ +struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev); +struct st_lsm6dsx_hw *hw = sensor->hw; + +if (type !=IIO_EV_TYPE_THRESH )drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int st_lsm6dsx_write_raw(struct iio_dev *iio_dev, · line 862
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+return -EINVAL ; + +if (state && hw->enable_event) +return 0 ; + + hw->enable_event = state; +if (state) +st_lsm6dsx_sensor_set_enable (sensor, true); +else +st_lsm6dsx_sensor_set_enable (sensor, false);
st_lsm6dsx_sensor_set_enablecan fails. Why not do
Quoted 7 lines
err = st_lsm6dsx_sensor_set_enable(sensor, state); if (err < 0) return err; hw->enable_event = state;; return 0;
Will change to this approach :-)
Quoted 22 lines
Quoted 22 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +8
-0+ +return 0 ; +} +int st_lsm6dsx_set_watermark (struct iio_dev *iio_dev,unsigned int val) {struct st_lsm6dsx_sensor *sensor =iio_priv (iio_dev);@@ -839,6 +940,10 @@ static const struct iio_info st_lsm6dsx_acc_info = { .attrs = &st_lsm6dsx_acc_attribute_group, .read_raw = st_lsm6dsx_read_raw, .write_raw = st_lsm6dsx_write_raw, + .read_event_value = st_lsm6dsx_read_event, + .write_event_value = st_lsm6dsx_write_event, + .read_event_config = st_lsm6dsx_read_event_config, + .write_event_config = st_lsm6dsx_write_event_config, .hwfifo_set_watermark = st_lsm6dsx_set_watermark, };@@ -1076,6 +1181,38 @@ static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw,return iio_dev; }
Quoted 13 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw, · line 1193
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +10
-0+int st_lsm6dsx_event_setup (int id,struct st_lsm6dsx_hw *hw) +{ +int err; +unsigned int md_reg; + +if (id ==ST_ISM330DLC_ID ) { +/* Enable basic interrupts for ISM330 */ + err =regmap_update_bits (hw->regmap,ST_LSM6DSX_REG_TAP_CFG_ADDR , +ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK , +ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK );please put device differences in st_lsm6dsx_sensor_settings[]
Will do.
Quoted 45 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw, · line 1198
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +5
-0+if (err <0 ) +return err; + } + +switch (hw->drdy_pin) {
drdy_pinit is only used here right? If so we do not need it just enable this configuration by default. I would prefer to maintain the code simpleQuoted 21 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +17
-0+case 1 : + md_reg =ST_LSM6DSX_REG_MD1_CFG_ADDR ; +break ; +case 2 : + md_reg =ST_LSM6DSX_REG_MD2_CFG_ADDR ; +break ; +default : +return -EINVAL ; + } +/* Enable wakeup interrupt */ + err =regmap_update_bits (hw->regmap, md_reg, +ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK , +ST_LSM6DSX_REG_MD_CFG_INT_WU_MASK ); + +return err; +} +static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) {struct st_lsm6dsx_hw *hw = private;drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, · line 1346
Quoted 3 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +0
-0@@ -1207,6 +1344,9 @@ int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, err =st_lsm6dsx_fifo_setup (hw);if (err <0 )return err;newline here please
Quoted 9 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +3
-0+ err =st_lsm6dsx_event_setup (hw_id, hw); +if (err <0 ) +return err; }for (i =0 ; i <ST_LSM6DSX_ID_MAX ; i++) {Signature · 1 line
2.22.0
Re: [PATCH v2 3/6] iio: imu: st_lsm6dsx: add motion events
In reply to Lorenzo BianconiQuoted 34 lines · Lorenzo Bianconi
Quoted 9 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +9
-0+#define ST_LSM6DSX_CHANNEL_ACC (chan_type, addr, mod, scan_idx) \ +{ \ + .type = chan_type, \ + .address = addr, \ + .modified = 1, \ + .channel2 = mod, \ + .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ + BIT(IIO_CHAN_INFO_SCALE), \ + .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h enum st_lsm6dsx_hw_id { · line 72
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +10
-0+ .scan_index = scan_idx, \ + .scan_type = { \ + .sign = 's', \ + .realbits = 16, \ + .storagebits = 16, \ + .endianness = IIO_LE, \ + }, \ + .event_spec = &st_lsm6dsx_event, \ + .num_event_specs = 1, \ +}I would prefer to extend existing macros
Quoted 12 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +3
-0+#define ST_LSM6DSX_CHANNEL (chan_type, addr, mod, scan_idx) \ { \ .type = chan_type, \@@ -297,6 +318,8 @@ struct st_lsm6dsx_hw {u8 enable_mask;u8 ts_sip;u8 sip; +u8 event_threshold; +bool enable_event;int drdy_pin;
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h struct st_lsm6dsx_hw { · line 331
Quoted 5 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h +0
-0u8 *buff;@@ -306,6 +329,13 @@ struct st_lsm6dsx_hw {const struct st_lsm6dsx_settings *settings; };
How would I do that when we have the event_spec for the accelerometer?
/Sean
PATCH v2 4/6 iio: imu: st_lsm6dsx: add wakeup-source option
In reply to Sean NyekjaerThis add ways for the SoC to wake from accelerometer wake events.
In the suspend function we skip disabling the sensor if wakeup-source and events are activated.
---
Changes since v1:
* none, as the call to st_lsm6dsx_flush_fifo will put the fifo in bypass mode.
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 15 +++++++++++++++ 1 file changed, 15 insertions(+)
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +15 -0
@@ -1358,6 +1358,10 @@ int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id,return err; } +if (dev->of_node) +if (of_property_read_bool (dev->of_node,"wakeup-source" )) +device_init_wakeup (dev, true); +return 0 ; }EXPORT_SYMBOL (st_lsm6dsx_probe);
@@ -1372,6 +1376,12 @@ static int __maybe_unused st_lsm6dsx_suspend(struct device *dev)if (!hw->iio_devs[i])continue ; +if (device_may_wakeup (dev) && (i ==ST_LSM6DSX_ID_ACC )) { +/* Enable wake from IRQ */ +enable_irq_wake (hw->irq); +continue ; + } + sensor =iio_priv (hw->iio_devs[i]);if (!(hw->enable_mask &BIT (sensor->id)))continue ;
@@ -1404,6 +1414,11 @@ static int __maybe_unused st_lsm6dsx_resume(struct device *dev)if (!hw->iio_devs[i])continue ; +if (device_may_wakeup (dev) && (i ==ST_LSM6DSX_ID_ACC )) { +disable_irq_wake (hw->irq); +continue ; + } + sensor =iio_priv (hw->iio_devs[i]);if (!(hw->suspend_mask &BIT (sensor->id)))continue ;
Signature · 1 line
2.22.0
Lorenzo Bianconi
maintainerRe: [PATCH v2 4/6] iio: imu: st_lsm6dsx: add wakeup-source option
Quoted 5 lines
This add ways for the SoC to wake from accelerometer wake events.
In the suspend function we skip disabling the sensor if wakeup-source and events are activated.
[...]
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int __maybe_unused st_lsm6dsx_suspend(struct device *dev) · line 1379
Quoted 6 lines
EXPORT_SYMBOL(st_lsm6dsx_probe);drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +1
-0@@ -1372,6 +1376,12 @@ static int __maybe_unused st_lsm6dsx_suspend(struct device *dev)if (!hw->iio_devs[i])continue ; +if (device_may_wakeup (dev) && (i ==ST_LSM6DSX_ID_ACC )) {
unnecessary brackets
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int __maybe_unused st_lsm6dsx_suspend(struct device *dev) · line 1383
Quoted 4 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +4
-0+/* Enable wake from IRQ */ +enable_irq_wake (hw->irq); +continue ; + }
I think we need to move this after enable_mask check, dont' we?
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static int __maybe_unused st_lsm6dsx_resume(struct device *dev) · line 1417
Quoted 9 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +2
-0+ sensor =iio_priv (hw->iio_devs[i]);if (!(hw->enable_mask &BIT (sensor->id)))continue ;@@ -1404,6 +1414,11 @@ static int __maybe_unused st_lsm6dsx_resume(struct device *dev)if (!hw->iio_devs[i])continue ; +if (device_may_wakeup (dev) && (i ==ST_LSM6DSX_ID_ACC )) {
unnecessary brackets
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +4
-0+disable_irq_wake (hw->irq); +continue ; + } + sensor =iio_priv (hw->iio_devs[i]);if (!(hw->suspend_mask &BIT (sensor->id)))continue ;Signature · 1 line
2.22.0
PATCH v2 5/6 iio: imu: st_lsm6dsx: always enter interrupt thread
In reply to Sean NyekjaerThe interrupt source can come from multiple sources, fifo and wake interrupts.
Enter interrupt thread to check which interrupt that has fired.
---
Changes since v1:
* None
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 14 +++++++------- 1 file changed, 7 insertions(+), 7 deletions(-)
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +7 -7
@@ -1215,19 +1215,19 @@ int st_lsm6dsx_event_setup(int id, struct st_lsm6dsx_hw *hw)static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) { -struct st_lsm6dsx_hw *hw = private; - -return hw->sip >0 ?IRQ_WAKE_THREAD :IRQ_NONE ; +return IRQ_WAKE_THREAD ; }static irqreturn_t st_lsm6dsx_handler_thread (int irq,void *private) {struct st_lsm6dsx_hw *hw = private; -int count; +int count =0 ; -mutex_lock (&hw->fifo_lock); - count =st_lsm6dsx_read_fifo (hw); -mutex_unlock (&hw->fifo_lock); +if (hw->sip >0 ) { +mutex_lock (&hw->fifo_lock); + count =st_lsm6dsx_read_fifo (hw); +mutex_unlock (&hw->fifo_lock); + }return !count ?IRQ_NONE :IRQ_HANDLED ; }
Signature · 1 line
2.22.0
Lorenzo Bianconi
maintainerRe: [PATCH v2 5/6] iio: imu: st_lsm6dsx: always enter interrupt thread
Quoted 27 lines
The interrupt source can come from multiple sources, fifo and wake interrupts.
Enter interrupt thread to check which interrupt that has fired.Signed-off-by Sean Nyekjaer <[email protected]>---
Changes since v1:
* Nonedrivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 14 +++++++------- 1 file changed, 7 insertions(+), 7 deletions(-)drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +1
-3@@ -1215,19 +1215,19 @@ int st_lsm6dsx_event_setup(int id, struct st_lsm6dsx_hw *hw)static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) { -struct st_lsm6dsx_hw *hw = private; - -return hw->sip >0 ?IRQ_WAKE_THREAD :IRQ_NONE ; +return IRQ_WAKE_THREAD ; }
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c int st_lsm6dsx_event_setup(int id, struct st_lsm6dsx_hw *hw) · line 1226
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +2
-4static irqreturn_t st_lsm6dsx_handler_thread (int irq,void *private) {struct st_lsm6dsx_hw *hw = private; -int count; +int count =0 ; -mutex_lock (&hw->fifo_lock); - count =st_lsm6dsx_read_fifo (hw); -mutex_unlock (&hw->fifo_lock); +if (hw->sip >0 ) {
I think we do not need this if() statement since st_lsm6dsx_read_fifo will return 0 in case
Quoted 10 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +4
-0+mutex_lock (&hw->fifo_lock); + count =st_lsm6dsx_read_fifo (hw); +mutex_unlock (&hw->fifo_lock); + }return !count ?IRQ_NONE :IRQ_HANDLED ; }Signature · 1 line
2.22.0
PATCH v2 6/6 iio: imu: st_lsm6dsx: add motion report function and call from interrupt
In reply to Sean NyekjaerReport iio motion events to iio subsystem
---
Changes since v1:
* none
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 52 ++++++++++++++++++++ 1 file changed, 52 insertions(+)
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +52 -0
@@ -39,6 +39,7 @@#include <linux/kernel.h> #include <linux/module.h> #include <linux/delay.h> +#include <linux/iio/events.h> #include <linux/iio/iio.h> #include <linux/iio/sysfs.h> #include <linux/interrupt.h>
@@ -76,6 +77,12 @@#define ST_LSM6DSX_REG_GYRO_OUT_Y_L_ADDR 0x24#define ST_LSM6DSX_REG_GYRO_OUT_Z_L_ADDR 0x26 +#define ST_LSM6DSX_REG_WAKE_UP_SRC_ADDR 0x1B +#define ST_LSM6DSX_REG_WAKE_UP_SRC_Z_WU_MASK BIT(0) +#define ST_LSM6DSX_REG_WAKE_UP_SRC_Y_WU_MASK BIT(1) +#define ST_LSM6DSX_REG_WAKE_UP_SRC_X_WU_MASK BIT(2) +#define ST_LSM6DSX_REG_WAKE_UP_SRC_WU_MASK BIT(3) +#define ST_LSM6DSX_REG_TAP_CFG_ADDR 0x58#define ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK BIT(7)
@@ -1212,6 +1219,39 @@ int st_lsm6dsx_event_setup(int id, struct st_lsm6dsx_hw *hw)return err; } +int st_lsm6dsx_report_motion_event (struct st_lsm6dsx_hw *hw,int data) +{ +s64 timestamp =iio_get_time_ns (hw->iio_devs[ST_LSM6DSX_ID_ACC ]); + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_Z_WU_MASK ) +iio_push_event (hw->iio_devs[ST_LSM6DSX_ID_ACC ], +IIO_MOD_EVENT_CODE (IIO_ACCEL , +0 , +IIO_MOD_Z , +IIO_EV_TYPE_THRESH , +IIO_EV_DIR_EITHER ), + timestamp); + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_Y_WU_MASK ) +iio_push_event (hw->iio_devs[ST_LSM6DSX_ID_ACC ], +IIO_MOD_EVENT_CODE (IIO_ACCEL , +0 , +IIO_MOD_Y , +IIO_EV_TYPE_THRESH , +IIO_EV_DIR_EITHER ), + timestamp); + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_X_WU_MASK ) +iio_push_event (hw->iio_devs[ST_LSM6DSX_ID_ACC ], +IIO_MOD_EVENT_CODE (IIO_ACCEL , +0 , +IIO_MOD_X , +IIO_EV_TYPE_THRESH , +IIO_EV_DIR_EITHER ), + timestamp); + +return 0 ; +}static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) {
@@ -1222,7 +1262,19 @@ static irqreturn_t st_lsm6dsx_handler_thread(int irq, void *private) {struct st_lsm6dsx_hw *hw = private;int count =0 ; +int data, err; + +if (hw->enable_event) { + err =regmap_read (hw->regmap, +ST_LSM6DSX_REG_WAKE_UP_SRC_ADDR , &data); +if (err <0 ) + goto try_fifo; + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_WU_MASK ) +st_lsm6dsx_report_motion_event (hw, data); + } +try_fifo:if (hw->sip >0 ) {mutex_lock (&hw->fifo_lock); count =st_lsm6dsx_read_fifo (hw);
Signature · 1 line
2.22.0
Lorenzo Bianconi
maintainerRe: [PATCH v2 6/6] iio: imu: st_lsm6dsx: add motion report function and call from interrupt
Quoted 77 lines
Report iio motion events to iio subsystem
Signed-off-by Sean Nyekjaer <[email protected]>---
Changes since v1:
* nonedrivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 52 ++++++++++++++++++++ 1 file changed, 52 insertions(+)drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +40
-0@@ -39,6 +39,7 @@#include <linux/kernel.h> #include <linux/module.h> #include <linux/delay.h> +#include <linux/iio/events.h> #include <linux/iio/iio.h> #include <linux/iio/sysfs.h> #include <linux/interrupt.h> @@ -76,6 +77,12 @@#define ST_LSM6DSX_REG_GYRO_OUT_Y_L_ADDR 0x24#define ST_LSM6DSX_REG_GYRO_OUT_Z_L_ADDR 0x26 +#define ST_LSM6DSX_REG_WAKE_UP_SRC_ADDR 0x1B +#define ST_LSM6DSX_REG_WAKE_UP_SRC_Z_WU_MASK BIT(0) +#define ST_LSM6DSX_REG_WAKE_UP_SRC_Y_WU_MASK BIT(1) +#define ST_LSM6DSX_REG_WAKE_UP_SRC_X_WU_MASK BIT(2) +#define ST_LSM6DSX_REG_WAKE_UP_SRC_WU_MASK BIT(3) +#define ST_LSM6DSX_REG_TAP_CFG_ADDR 0x58#define ST_LSM6DSX_REG_TAP_CFG_INT_EN_MASK BIT(7)@@ -1212,6 +1219,39 @@ int st_lsm6dsx_event_setup(int id, struct st_lsm6dsx_hw *hw)return err; } +int st_lsm6dsx_report_motion_event (struct st_lsm6dsx_hw *hw,int data) +{ +s64 timestamp =iio_get_time_ns (hw->iio_devs[ST_LSM6DSX_ID_ACC ]); + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_Z_WU_MASK ) +iio_push_event (hw->iio_devs[ST_LSM6DSX_ID_ACC ], +IIO_MOD_EVENT_CODE (IIO_ACCEL , +0 , +IIO_MOD_Z , +IIO_EV_TYPE_THRESH , +IIO_EV_DIR_EITHER ), + timestamp); + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_Y_WU_MASK ) +iio_push_event (hw->iio_devs[ST_LSM6DSX_ID_ACC ], +IIO_MOD_EVENT_CODE (IIO_ACCEL , +0 , +IIO_MOD_Y , +IIO_EV_TYPE_THRESH , +IIO_EV_DIR_EITHER ), + timestamp); + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_X_WU_MASK ) +iio_push_event (hw->iio_devs[ST_LSM6DSX_ID_ACC ], +IIO_MOD_EVENT_CODE (IIO_ACCEL , +0 , +IIO_MOD_X , +IIO_EV_TYPE_THRESH , +IIO_EV_DIR_EITHER ), + timestamp); + +return 0 ; +}static irqreturn_t st_lsm6dsx_handler_irq (int irq,void *private) {
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c static irqreturn_t st_lsm6dsx_handler_thread(int irq, void *private) · line 1269
Quoted 8 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +5
-0@@ -1222,7 +1262,19 @@ static irqreturn_t st_lsm6dsx_handler_thread(int irq, void *private) {struct st_lsm6dsx_hw *hw = private;int count =0 ; +int data, err; + +if (hw->enable_event) { + err =regmap_read (hw->regmap, +ST_LSM6DSX_REG_WAKE_UP_SRC_ADDR , &data);
I think we can move the ST_LSM6DSX_REG_WAKE_UP_SRC_ADDR read in st_lsm6dsx_report_motion_event (and rename it) and avoid goto try_fifo
Quoted 14 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c +7
-0+if (err <0 ) + goto try_fifo; + +if (data &ST_LSM6DSX_REG_WAKE_UP_SRC_WU_MASK ) +st_lsm6dsx_report_motion_event (hw, data); + } +try_fifo:if (hw->sip >0 ) {mutex_lock (&hw->fifo_lock); count =st_lsm6dsx_read_fifo (hw);Signature · 1 line
2.22.0
Lorenzo Bianconi
maintainerQuoted 17 lines
This prepares the interrupt to be used for other stuff than fifo reading + event readings.
Signed-off-by Sean Nyekjaer <[email protected]>---
Changes since v1:
* none.../iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c | 78 +---------------- drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 87 +++++++++++++++++++ 2 files changed, 88 insertions(+), 77 deletions(-)drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c +0
-0
[...]
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, · line 1206
Quoted 10 lines
int st_lsm6dsx_probe(struct device *dev, int irq, int
hw_id,drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c +3
-0struct regmap *regmap) {@@ -1117,6 +1201,9 @@ int st_lsm6dsx_probe(struct device *dev, int irq, int hw_id, }if (hw->irq >0 ) { + err =st_lsm6dsx_irq_setup (hw); +if (err <0 ) +return err;
Could you please put a 'newline' here?
Quoted 6 lines
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c +0
-0err =st_lsm6dsx_fifo_setup (hw);if (err <0 )return err;Signature · 1 line
2.22.0