iio: move inv_icm42600 timestamp module in common
Create new inv_sensors common modules and move inv_icm42600 timestamp module inside. This module will be used by IMUs and also in the future by other chips. Modify inv_icm42600 driver to use timestamp module and do some headers cleanup. Signed-off-by: Jean-Baptiste Maneyrol <jean-baptiste.maneyrol@tdk.com> Reviewed-by: Andy Shevchenko <andy.shevchenko@gmail.com> Link: https://lore.kernel.org/r/20230606162147.79667-3-inv.git-commit@tdk.com Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
This commit is contained in:
committed by
Jonathan Cameron
parent
6e9f2d8375
commit
d99ff463ec
@@ -0,0 +1,79 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0-or-later */
|
||||
/*
|
||||
* Copyright (C) 2020 Invensense, Inc.
|
||||
*/
|
||||
|
||||
#ifndef INV_ICM42600_TIMESTAMP_H_
|
||||
#define INV_ICM42600_TIMESTAMP_H_
|
||||
|
||||
/**
|
||||
* struct inv_icm42600_timestamp_interval - timestamps interval
|
||||
* @lo: interval lower bound
|
||||
* @up: interval upper bound
|
||||
*/
|
||||
struct inv_icm42600_timestamp_interval {
|
||||
int64_t lo;
|
||||
int64_t up;
|
||||
};
|
||||
|
||||
/**
|
||||
* struct inv_icm42600_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_icm42600_timestamp_acc {
|
||||
uint32_t val;
|
||||
size_t idx;
|
||||
uint32_t values[32];
|
||||
};
|
||||
|
||||
/**
|
||||
* struct inv_icm42600_timestamp - timestamp management states
|
||||
* @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_icm42600_timestamp {
|
||||
struct inv_icm42600_timestamp_interval it;
|
||||
int64_t timestamp;
|
||||
uint32_t mult;
|
||||
uint32_t new_mult;
|
||||
uint32_t period;
|
||||
struct inv_icm42600_timestamp_acc chip_period;
|
||||
};
|
||||
|
||||
void inv_icm42600_timestamp_init(struct inv_icm42600_timestamp *ts,
|
||||
uint32_t period);
|
||||
|
||||
int inv_icm42600_timestamp_update_odr(struct inv_icm42600_timestamp *ts,
|
||||
uint32_t period, bool fifo);
|
||||
|
||||
void inv_icm42600_timestamp_interrupt(struct inv_icm42600_timestamp *ts,
|
||||
uint32_t fifo_period, size_t fifo_nb,
|
||||
size_t sensor_nb, int64_t timestamp);
|
||||
|
||||
static inline int64_t
|
||||
inv_icm42600_timestamp_pop(struct inv_icm42600_timestamp *ts)
|
||||
{
|
||||
ts->timestamp += ts->period;
|
||||
return ts->timestamp;
|
||||
}
|
||||
|
||||
void inv_icm42600_timestamp_apply_odr(struct inv_icm42600_timestamp *ts,
|
||||
uint32_t fifo_period, size_t fifo_nb,
|
||||
unsigned int fifo_no);
|
||||
|
||||
static inline void
|
||||
inv_icm42600_timestamp_reset(struct inv_icm42600_timestamp *ts)
|
||||
{
|
||||
const struct inv_icm42600_timestamp_interval interval_init = {0LL, 0LL};
|
||||
|
||||
ts->it = interval_init;
|
||||
ts->timestamp = 0;
|
||||
}
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user