Commit 65a60a59 authored by Jean-Baptiste Maneyrol's avatar Jean-Baptiste Maneyrol Committed by Jonathan Cameron
Browse files

iio: imu: inv_icm42600: fix timestamps after suspend if sensor is on 



Currently suspending while sensors are one will result in timestamping
continuing without gap at resume. It can work with monotonic clock but
not with other clocks. Fix that by resetting timestamping.

Fixes: ec74ae9f ("iio: imu: inv_icm42600: add accurate timestamping")
Cc: stable@vger.kernel.org
Signed-off-by: default avatarJean-Baptiste Maneyrol <jean-baptiste.maneyrol@tdk.com>
Link: https://patch.msgid.link/20241113-inv_icm42600-fix-timestamps-after-suspend-v1-1-dfc77c394173@tdk.com


Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent c0f866de

drivers/iio/imu/inv_icm42600/inv_icm42600_core.c

+6 −1
Original line number Diff line number Diff line
@@ -829,6 +829,8 @@ static int inv_icm42600_suspend(struct device *dev) 
static int inv_icm42600_resume(struct device *dev)

{

	struct inv_icm42600_state *st = dev_get_drvdata(dev);

	struct inv_icm42600_sensor_state *gyro_st = iio_priv(st->indio_gyro);

	struct inv_icm42600_sensor_state *accel_st = iio_priv(st->indio_accel);

	int ret;



	mutex_lock(&st->lock);
@@ -849,9 +851,12 @@ static int inv_icm42600_resume(struct device *dev) 
		goto out_unlock;



	/* restore FIFO data streaming */

	if (st->fifo.on)

	if (st->fifo.on) {

		inv_sensors_timestamp_reset(&gyro_st->ts);

		inv_sensors_timestamp_reset(&accel_st->ts);

		ret = regmap_write(st->map, INV_ICM42600_REG_FIFO_CONFIG,

				   INV_ICM42600_FIFO_CONFIG_STREAM);

	}



out_unlock:

	mutex_unlock(&st->lock);