mirror of
https://github.com/nxp-imx/linux-imx.git
synced 2025-07-19 07:39:54 +02:00
bf8367b00c
When a sensor is running and there is a FIFO frequency change due to
another sensor turned on/off, there are glitches on timestamp. Fix that
by using only interrupt timestamp when there is the corresponding sensor
data in the FIFO.
Delete FIFO period handling and simplify internal functions.
Update integration inside inv_mpu6050 and inv_icm42600 drivers.
Fixes: 0ecc363cce ("iio: make invensense timestamp module generic")
Cc: Stable@vger.kernel.org
Signed-off-by: Jean-Baptiste Maneyrol <jean-baptiste.maneyrol@tdk.com>
Link: https://lore.kernel.org/r/20240426094835.138389-1-inv.git-commit@tdk.com
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
95 lines
2.7 KiB
C
95 lines
2.7 KiB
C
/* SPDX-License-Identifier: GPL-2.0-or-later */
|
|
/*
|
|
* Copyright (C) 2020 Invensense, Inc.
|
|
*/
|
|
|
|
#ifndef INV_SENSORS_TIMESTAMP_H_
|
|
#define INV_SENSORS_TIMESTAMP_H_
|
|
|
|
/**
|
|
* struct inv_sensors_timestamp_chip - chip internal properties
|
|
* @clock_period: internal clock period in ns
|
|
* @jitter: acceptable jitter in per-mille
|
|
* @init_period: chip initial period at reset in ns
|
|
*/
|
|
struct inv_sensors_timestamp_chip {
|
|
uint32_t clock_period;
|
|
uint32_t jitter;
|
|
uint32_t init_period;
|
|
};
|
|
|
|
/**
|
|
* struct inv_sensors_timestamp_interval - timestamps interval
|
|
* @lo: interval lower bound
|
|
* @up: interval upper bound
|
|
*/
|
|
struct inv_sensors_timestamp_interval {
|
|
int64_t lo;
|
|
int64_t up;
|
|
};
|
|
|
|
/**
|
|
* struct inv_sensors_timestamp_acc - accumulator for computing an estimation
|
|
* @val: current estimation of the value, the mean of all values
|
|
* @idx: current index of the next free place in values table
|
|
* @values: table of all measured values, use for computing the mean
|
|
*/
|
|
struct inv_sensors_timestamp_acc {
|
|
uint32_t val;
|
|
size_t idx;
|
|
uint32_t values[32];
|
|
};
|
|
|
|
/**
|
|
* struct inv_sensors_timestamp - timestamp management states
|
|
* @chip: chip internal characteristics
|
|
* @min_period: minimal acceptable clock period
|
|
* @max_period: maximal acceptable clock period
|
|
* @it: interrupts interval timestamps
|
|
* @timestamp: store last timestamp for computing next data timestamp
|
|
* @mult: current internal period multiplier
|
|
* @new_mult: new set internal period multiplier (not yet effective)
|
|
* @period: measured current period of the sensor
|
|
* @chip_period: accumulator for computing internal chip period
|
|
*/
|
|
struct inv_sensors_timestamp {
|
|
struct inv_sensors_timestamp_chip chip;
|
|
uint32_t min_period;
|
|
uint32_t max_period;
|
|
struct inv_sensors_timestamp_interval it;
|
|
int64_t timestamp;
|
|
uint32_t mult;
|
|
uint32_t new_mult;
|
|
uint32_t period;
|
|
struct inv_sensors_timestamp_acc chip_period;
|
|
};
|
|
|
|
void inv_sensors_timestamp_init(struct inv_sensors_timestamp *ts,
|
|
const struct inv_sensors_timestamp_chip *chip);
|
|
|
|
int inv_sensors_timestamp_update_odr(struct inv_sensors_timestamp *ts,
|
|
uint32_t period, bool fifo);
|
|
|
|
void inv_sensors_timestamp_interrupt(struct inv_sensors_timestamp *ts,
|
|
size_t sample_nb, int64_t timestamp);
|
|
|
|
static inline int64_t inv_sensors_timestamp_pop(struct inv_sensors_timestamp *ts)
|
|
{
|
|
ts->timestamp += ts->period;
|
|
return ts->timestamp;
|
|
}
|
|
|
|
void inv_sensors_timestamp_apply_odr(struct inv_sensors_timestamp *ts,
|
|
uint32_t fifo_period, size_t fifo_nb,
|
|
unsigned int fifo_no);
|
|
|
|
static inline void inv_sensors_timestamp_reset(struct inv_sensors_timestamp *ts)
|
|
{
|
|
const struct inv_sensors_timestamp_interval interval_init = {0LL, 0LL};
|
|
|
|
ts->it = interval_init;
|
|
ts->timestamp = 0;
|
|
}
|
|
|
|
#endif
|