On Sep 04, Sean Nyekjaer wrote:
> 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.
>
> Signed-off-by: Sean Nyekjaer <sean@xxxxxxxxxx>
> ---
> Changes since v1:
> * none, as the call to st_lsm6dsx_flush_fifo will put the fifo in
> bypass mode.
>
> Changes since v2:
> * Removed unnecessary brackets
> * Move enable_irq to after the enable mask
>
> drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 15 +++++++++++++++
> 1 file changed, 15 insertions(+)
>
> diff --git a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c
> index d4d6ba934b6d..bb72800bf99b 100644
> --- a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c
> +++ b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c
> @@ -1754,6 +1754,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);
if (dev->of_node &&
of_property_read_bool(dev->of_node, "wakeup-source"))
device_init_wakeup(dev, true);
I guess it is more readable in this way, isn't it?
> +
> return 0;
> }
> EXPORT_SYMBOL(st_lsm6dsx_probe);
> @@ -1772,6 +1776,12 @@ static int __maybe_unused st_lsm6dsx_suspend(struct device *dev)
> if (!(hw->enable_mask & BIT(sensor->id)))
> continue;
>
> + if (device_may_wakeup(dev) && i == ST_LSM6DSX_ID_ACC) {
> + /* Enable wake from IRQ */
> + enable_irq_wake(hw->irq);
> + continue;
> + }
> +
> if (sensor->id == ST_LSM6DSX_ID_EXT0 ||
> sensor->id == ST_LSM6DSX_ID_EXT1 ||
> sensor->id == ST_LSM6DSX_ID_EXT2)
> @@ -1804,6 +1814,11 @@ static int __maybe_unused st_lsm6dsx_resume(struct device *dev)
> if (!(hw->suspend_mask & BIT(sensor->id)))
> continue;
>
> + if (device_may_wakeup(dev) && i == ST_LSM6DSX_ID_ACC) {
> + disable_irq_wake(hw->irq);
> + continue;
> + }
> +
> if (sensor->id == ST_LSM6DSX_ID_EXT0 ||
> sensor->id == ST_LSM6DSX_ID_EXT1 ||
> sensor->id == ST_LSM6DSX_ID_EXT2)
> --
> 2.23.0
>
Attachment:
signature.asc
Description: PGP signature
