drivers/sensor: lsm6dsvxxx: add High-g data support in FIFO

Add support for High-g data in FIFO. The HG data wiil be marked in
FIFO with LSM6DSV80X_XL_HG_TAG.

Signed-off-by: Armando Visconti <[email protected]>

Author: avisconti

drivers/sensor/st/lsm6dsvxxx/lsm6dsv320x.c

@@ -664,6 +664,7 @@ static void lsm6dsv320x_config_fifo(const struct device *dev, struct trigger_con
 	lsm6dsv320x_sflp_data_rate_t sflp_odr = LSM6DSV320X_SFLP_120Hz;
 	lsm6dsv320x_fifo_sflp_raw_t sflp_fifo = {0};
 	lsm6dsv320x_sflp_gbias_t gbias;
+	uint8_t xl_hg_batch = 0;
 
 	/* disable FIFO as first thing */
 	lsm6dsv320x_fifo_mode_set(ctx, LSM6DSV320X_BYPASS_MODE);
@@ -678,6 +679,7 @@ static void lsm6dsv320x_config_fifo(const struct device *dev, struct trigger_con
 		xl_batch = config->accel_batch;
 		gy_batch = config->gyro_batch;
 		temp_batch = config->temp_batch;
+		xl_hg_batch = (lsm6dsv320x_is_hg_fs(config->accel_range)) ? 1 : 0;
 
 		fifo_mode = LSM6DSV320X_STREAM_MODE;
 		fifo_wtm = config->fifo_wtm;
@@ -709,6 +711,7 @@ static void lsm6dsv320x_config_fifo(const struct device *dev, struct trigger_con
 	/* Set FIFO batch rates */
 	lsm6dsv320x_fifo_xl_batch_set(ctx, xl_batch);
 	data->accel_batch_odr = xl_batch;
+	lsm6dsv320x_fifo_hg_xl_batch_set(ctx, xl_hg_batch);
 	lsm6dsv320x_fifo_gy_batch_set(ctx, gy_batch);
 	data->gyro_batch_odr = gy_batch;
 #if defined(CONFIG_LSM6DSVXXX_ENABLE_TEMP)

drivers/sensor/st/lsm6dsvxxx/lsm6dsv80x.c

@@ -656,6 +656,7 @@ static void lsm6dsv80x_config_fifo(const struct device *dev, struct trigger_conf
 	lsm6dsv80x_sflp_data_rate_t sflp_odr = LSM6DSV80X_SFLP_120Hz;
 	lsm6dsv80x_fifo_sflp_raw_t sflp_fifo = {0};
 	lsm6dsv80x_sflp_gbias_t gbias;
+	uint8_t xl_hg_batch = 0;
 
 	/* disable FIFO as first thing */
 	lsm6dsv80x_fifo_mode_set(ctx, LSM6DSV80X_BYPASS_MODE);
@@ -670,6 +671,7 @@ static void lsm6dsv80x_config_fifo(const struct device *dev, struct trigger_conf
 		xl_batch = config->accel_batch;
 		gy_batch = config->gyro_batch;
 		temp_batch = config->temp_batch;
+		xl_hg_batch = (lsm6dsv80x_is_hg_fs(config->accel_range)) ? 1 : 0;
 
 		fifo_mode = LSM6DSV80X_STREAM_MODE;
 		fifo_wtm = config->fifo_wtm;
@@ -701,6 +703,7 @@ static void lsm6dsv80x_config_fifo(const struct device *dev, struct trigger_conf
 	/* Set FIFO batch rates */
 	lsm6dsv80x_fifo_xl_batch_set(ctx, xl_batch);
 	data->accel_batch_odr = xl_batch;
+	lsm6dsv80x_fifo_hg_xl_batch_set(ctx, xl_hg_batch);
 	lsm6dsv80x_fifo_gy_batch_set(ctx, gy_batch);
 	data->gyro_batch_odr = gy_batch;
 #if defined(CONFIG_LSM6DSVXXX_ENABLE_TEMP)

drivers/sensor/st/lsm6dsvxxx/lsm6dsvxxx_decoder.c

@@ -162,6 +162,7 @@ static int lsm6dsvxxx_decoder_get_frame_count(const uint8_t *buffer,
 		fifo_tag = (buffer[0] >> 3);
 
 		switch (fifo_tag) {
+		case LSM6DSVXXX_XL_HG_TAG:
 		case LSM6DSVXXX_XL_NC_TAG:
 			tot_accel_fifo_words++;
 			break;
@@ -292,6 +293,7 @@ static int lsm6dsvxxx_decode_fifo(const uint8_t *buffer, struct sensor_chan_spec
 		fifo_tag = (buffer[0] >> 3);
 
 		switch (fifo_tag) {
+		case LSM6DSVXXX_XL_HG_TAG:
 		case LSM6DSVXXX_XL_NC_TAG: {
 			struct sensor_three_axis_data *out = data_out;
 			int16_t x, y, z;