On Oct 30, Francesco Lavra wrote: > The st_lsm6dsx_event_settings structure contains fields specific > for one event type (wakeup). In preparation for adding support for > more event types, introduce an event id enum and a generic event > source structure, and replace wakeup-specific data in struct > st_lsm6dsx_event_settings with an array of event source structures. > > Signed-off-by: Francesco Lavra > --- > drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h | 21 ++- > drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 136 +++++++++++-------- > 2 files changed, 96 insertions(+), 61 deletions(-) > > diff --git a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h > index db863bd1898d..05689887f7ec 100644 > --- a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h > +++ b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx.h > @@ -221,14 +221,23 @@ struct st_lsm6dsx_shub_settings { > u8 pause; > }; > > +enum st_lsm6dsx_event_id { > + ST_LSM6DSX_EVENT_WAKEUP, > + ST_LSM6DSX_EVENT_MAX > +}; > + > +struct st_lsm6dsx_event_src { > + struct st_lsm6dsx_reg value; > + u8 status_reg; > + u8 status_mask; > + u8 status_x_mask; > + u8 status_y_mask; > + u8 status_z_mask; you can use st_lsm6dsx_reg here. > +}; > + > struct st_lsm6dsx_event_settings { > struct st_lsm6dsx_reg enable_reg; > - struct st_lsm6dsx_reg wakeup_reg; > - u8 wakeup_src_reg; > - u8 wakeup_src_status_mask; > - u8 wakeup_src_z_mask; > - u8 wakeup_src_y_mask; > - u8 wakeup_src_x_mask; > + struct st_lsm6dsx_event_src sources[ST_LSM6DSX_EVENT_MAX]; > }; > > enum st_lsm6dsx_ext_sensor_id { > diff --git a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c > index 17b46e15cce5..bb4c4c531128 100644 > --- a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c > +++ b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c > @@ -350,15 +350,19 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { > }, > }, > .event_settings = { > - .wakeup_reg = { > - .addr = 0x5B, > - .mask = GENMASK(5, 0), > + .sources = { > + [ST_LSM6DSX_EVENT_WAKEUP] = { > + .value = { > + .addr = 0x5b, > + .mask = GENMASK(5, 0), > + }, > + .status_reg = 0x1b, > + .status_mask = BIT(3), > + .status_z_mask = BIT(0), > + .status_y_mask = BIT(1), > + .status_x_mask = BIT(2), > + }, > }, > - .wakeup_src_reg = 0x1b, > - .wakeup_src_status_mask = BIT(3), > - .wakeup_src_z_mask = BIT(0), > - .wakeup_src_y_mask = BIT(1), > - .wakeup_src_x_mask = BIT(2), > }, > }, > { > @@ -510,15 +514,19 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { > }, > }, > .event_settings = { > - .wakeup_reg = { > - .addr = 0x5B, > - .mask = GENMASK(5, 0), > + .sources = { > + [ST_LSM6DSX_EVENT_WAKEUP] = { > + .value = { > + .addr = 0x5b, > + .mask = GENMASK(5, 0), > + }, > + .status_reg = 0x1b, > + .status_mask = BIT(3), > + .status_z_mask = BIT(0), > + .status_y_mask = BIT(1), > + .status_x_mask = BIT(2), > + }, > }, > - .wakeup_src_reg = 0x1b, > - .wakeup_src_status_mask = BIT(3), > - .wakeup_src_z_mask = BIT(0), > - .wakeup_src_y_mask = BIT(1), > - .wakeup_src_x_mask = BIT(2), > }, > }, > { > @@ -741,15 +749,19 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { > .addr = 0x58, > .mask = BIT(7), > }, > - .wakeup_reg = { > - .addr = 0x5B, > - .mask = GENMASK(5, 0), > + .sources = { > + [ST_LSM6DSX_EVENT_WAKEUP] = { > + .value = { > + .addr = 0x5b, > + .mask = GENMASK(5, 0), > + }, > + .status_reg = 0x1b, > + .status_mask = BIT(3), > + .status_z_mask = BIT(0), > + .status_y_mask = BIT(1), > + .status_x_mask = BIT(2), > + }, > }, > - .wakeup_src_reg = 0x1b, > - .wakeup_src_status_mask = BIT(3), > - .wakeup_src_z_mask = BIT(0), > - .wakeup_src_y_mask = BIT(1), > - .wakeup_src_x_mask = BIT(2), > }, > }, > { > @@ -972,15 +984,19 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { > .addr = 0x58, > .mask = BIT(7), > }, > - .wakeup_reg = { > - .addr = 0x5b, > - .mask = GENMASK(5, 0), > + .sources = { > + [ST_LSM6DSX_EVENT_WAKEUP] = { > + .value = { > + .addr = 0x5b, > + .mask = GENMASK(5, 0), > + }, > + .status_reg = 0x1b, > + .status_mask = BIT(3), > + .status_z_mask = BIT(0), > + .status_y_mask = BIT(1), > + .status_x_mask = BIT(2), > + }, > }, > - .wakeup_src_reg = 0x1b, > - .wakeup_src_status_mask = BIT(3), > - .wakeup_src_z_mask = BIT(0), > - .wakeup_src_y_mask = BIT(1), > - .wakeup_src_x_mask = BIT(2), > }, > }, > { > @@ -1147,15 +1163,19 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { > .addr = 0x58, > .mask = BIT(7), > }, > - .wakeup_reg = { > - .addr = 0x5B, > - .mask = GENMASK(5, 0), > + .sources = { > + [ST_LSM6DSX_EVENT_WAKEUP] = { > + .value = { > + .addr = 0x5b, > + .mask = GENMASK(5, 0), > + }, > + .status_reg = 0x1b, > + .status_mask = BIT(3), > + .status_z_mask = BIT(0), > + .status_y_mask = BIT(1), > + .status_x_mask = BIT(2), > + }, > }, > - .wakeup_src_reg = 0x1b, > - .wakeup_src_status_mask = BIT(3), > - .wakeup_src_z_mask = BIT(0), > - .wakeup_src_y_mask = BIT(1), > - .wakeup_src_x_mask = BIT(2), > }, > }, > { > @@ -1347,15 +1367,19 @@ static const struct st_lsm6dsx_settings st_lsm6dsx_sensor_settings[] = { > .addr = 0x50, > .mask = BIT(7), > }, > - .wakeup_reg = { > - .addr = 0x5b, > - .mask = GENMASK(5, 0), > + .sources = { > + [ST_LSM6DSX_EVENT_WAKEUP] = { > + .value = { > + .addr = 0x5b, > + .mask = GENMASK(5, 0), > + }, > + .status_reg = 0x45, > + .status_mask = BIT(3), > + .status_z_mask = BIT(0), > + .status_y_mask = BIT(1), > + .status_x_mask = BIT(2), > + }, > }, > - .wakeup_src_reg = 0x45, > - .wakeup_src_status_mask = BIT(3), > - .wakeup_src_z_mask = BIT(0), > - .wakeup_src_y_mask = BIT(1), > - .wakeup_src_x_mask = BIT(2), > }, > }, > { > @@ -1861,7 +1885,7 @@ st_lsm6dsx_write_event(struct iio_dev *iio_dev, > if (val < 0 || val > 31) > return -EINVAL; > > - reg = &hw->settings->event_settings.wakeup_reg; > + reg = &hw->settings->event_settings.sources[ST_LSM6DSX_EVENT_WAKEUP].value; > data = ST_LSM6DSX_SHIFT_VAL(val, reg->mask); > err = st_lsm6dsx_update_bits_locked(hw, reg->addr, > reg->mask, data); > @@ -2318,7 +2342,7 @@ static int st_lsm6dsx_chan_init(struct iio_chan_spec *channels, struct st_lsm6ds > chan->scan_type.endianness = IIO_LE; > chan->ext_info = st_lsm6dsx_ext_info; > if (id == ST_LSM6DSX_ID_ACC) { > - if (hw->settings->event_settings.wakeup_reg.addr) { > + if (hw->settings->event_settings.sources[ST_LSM6DSX_EVENT_WAKEUP].value.addr) { > chan->event_spec = &st_lsm6dsx_event; > chan->num_event_specs = 1; > } > @@ -2389,6 +2413,7 @@ static bool > st_lsm6dsx_report_motion_event(struct st_lsm6dsx_hw *hw) > { > const struct st_lsm6dsx_event_settings *event_settings; > + const struct st_lsm6dsx_event_src *event_src; > int err, data; > s64 timestamp; > > @@ -2396,13 +2421,14 @@ st_lsm6dsx_report_motion_event(struct st_lsm6dsx_hw *hw) > return false; > > event_settings = &hw->settings->event_settings; > - err = st_lsm6dsx_read_locked(hw, event_settings->wakeup_src_reg, > + event_src = &event_settings->sources[ST_LSM6DSX_EVENT_WAKEUP]; > + err = st_lsm6dsx_read_locked(hw, event_src->status_reg, > &data, sizeof(data)); > if (err < 0) > return false; > > timestamp = iio_get_time_ns(hw->iio_devs[ST_LSM6DSX_ID_ACC]); > - if ((data & hw->settings->event_settings.wakeup_src_z_mask) && > + if ((data & event_src->status_z_mask) && > (hw->enable_event & BIT(IIO_MOD_Z))) > iio_push_event(hw->iio_devs[ST_LSM6DSX_ID_ACC], > IIO_MOD_EVENT_CODE(IIO_ACCEL, > @@ -2412,7 +2438,7 @@ st_lsm6dsx_report_motion_event(struct st_lsm6dsx_hw *hw) > IIO_EV_DIR_EITHER), > timestamp); > > - if ((data & hw->settings->event_settings.wakeup_src_y_mask) && > + if ((data & event_src->status_y_mask) && > (hw->enable_event & BIT(IIO_MOD_Y))) > iio_push_event(hw->iio_devs[ST_LSM6DSX_ID_ACC], > IIO_MOD_EVENT_CODE(IIO_ACCEL, > @@ -2422,7 +2448,7 @@ st_lsm6dsx_report_motion_event(struct st_lsm6dsx_hw *hw) > IIO_EV_DIR_EITHER), > timestamp); > > - if ((data & hw->settings->event_settings.wakeup_src_x_mask) && > + if ((data & event_src->status_x_mask) && > (hw->enable_event & BIT(IIO_MOD_X))) > iio_push_event(hw->iio_devs[ST_LSM6DSX_ID_ACC], > IIO_MOD_EVENT_CODE(IIO_ACCEL, > @@ -2432,7 +2458,7 @@ st_lsm6dsx_report_motion_event(struct st_lsm6dsx_hw *hw) > IIO_EV_DIR_EITHER), > timestamp); > > - return data & event_settings->wakeup_src_status_mask; > + return data & event_src->status_mask; > } > > static irqreturn_t st_lsm6dsx_handler_thread(int irq, void *private) > -- > 2.39.5 >