stm32duino
diff --git a/‎src/LSM6DSOXSensor.cpp
Copy file name to clipboardExpand all lines: src/LSM6DSOXSensor.cpp
+82Lines changed: 82 additions & 0 deletions b/‎src/LSM6DSOXSensor.cpp
Copy file name to clipboardExpand all lines: src/LSM6DSOXSensor.cpp
+82Lines changed: 82 additions & 0 deletions
diff --git a/‎src/LSM6DSOXSensor.h
Copy file name to clipboardExpand all lines: src/LSM6DSOXSensor.h
+6Lines changed: 6 additions & 0 deletions b/‎src/LSM6DSOXSensor.h
Copy file name to clipboardExpand all lines: src/LSM6DSOXSensor.h
+6Lines changed: 6 additions & 0 deletions
@@ -3018,6 +3018,22 @@ LSM6DSOXStatusTypeDef LSM6DSOXSensor::Get_FIFO_Data(uint8_t *Data)
   return LSM6DSOX_OK;
 }
 
+/**
+ * @brief  Get the LSM6DSOX FIFO sample
+ * @param  Sample FIFO sample array [multiple of 7]
+ * @param  Count Count of samples to get.
+ * @retval 0 in case of success, an error code otherwise
+ */
+LSM6DSOXStatusTypeDef LSM6DSOXSensor::Get_FIFO_Sample(uint8_t *Sample, uint16_t Count)
+{
+  if (lsm6dsox_read_reg(&reg_ctx, LSM6DSOX_FIFO_DATA_OUT_TAG, Sample, Count * 7) != LSM6DSOX_OK)
+  {
+    return LSM6DSOX_ERROR;
+  }
+
+  return LSM6DSOX_OK;
+}
+
 /**
  * @brief  Get the LSM6DSOX FIFO accelero single sample (16-bit data per 3 axes) and calculate acceleration [mg]
  * @param  Acceleration FIFO accelero axes [mg]
@@ -3170,6 +3186,72 @@ LSM6DSOXStatusTypeDef LSM6DSOXSensor::Get_MLC_Output(uint8_t *Output)
   return LSM6DSOX_OK;
 }
 
+/**
+ * @brief  Get the LSM6DSOX timestamp enable status
+ * @param  Status Timestamp enable status
+ * @retval 0 in case of success, an error code otherwise
+ */
+LSM6DSOXStatusTypeDef LSM6DSOXSensor::Get_Timestamp_Status(uint8_t *Status)
+{
+  if (lsm6dsox_timestamp_get(&reg_ctx, Status) != LSM6DSOX_OK)
+  {
+    return LSM6DSOX_ERROR;
+  }
+
+  return LSM6DSOX_OK;
+}
+
+/**
+ * @brief  Set the LSM6DSOX timestamp enable status
+ * @param  Status Timestamp enable status
+ * @retval 0 in case of success, an error code otherwise
+ */
+LSM6DSOXStatusTypeDef LSM6DSOXSensor::Set_Timestamp_Status(uint8_t Status)
+{
+  if (lsm6dsox_timestamp_set(&reg_ctx, Status) != LSM6DSOX_OK)
+  {
+    return LSM6DSOX_ERROR;
+  }
+
+  return LSM6DSOX_OK;
+}
+
+/**
+ * @brief  Set the LSM6DSOX FIFO timestamp decimation
+ * @param  Decimation FIFO timestamp decimation
+ * @retval 0 in case of success, an error code otherwise
+ */
+LSM6DSOXStatusTypeDef LSM6DSOXSensor::Set_FIFO_Timestamp_Decimation(uint8_t Decimation)
+{
+  LSM6DSOXStatusTypeDef ret = LSM6DSOX_OK;
+
+  /* Verify that the passed parameter contains one of the valid values. */
+  switch ((lsm6dsox_odr_ts_batch_t)Decimation)
+  {
+    case LSM6DSOX_NO_DECIMATION:
+    case LSM6DSOX_DEC_1:
+    case LSM6DSOX_DEC_8:
+    case LSM6DSOX_DEC_32:
+      break;
+
+    default:
+      ret = LSM6DSOX_ERROR;
+      break;
+  }
+
+  if (ret == LSM6DSOX_ERROR)
+  {
+    return ret;
+  }
+
+  if (lsm6dsox_fifo_timestamp_decimation_set(&reg_ctx, (lsm6dsox_odr_ts_batch_t)Decimation) != LSM6DSOX_OK)
+  {
+    return LSM6DSOX_ERROR;
+  }
+
+  return ret;
+}
+
 int32_t LSM6DSOX_io_write(void *handle, uint8_t WriteAddr, uint8_t *pBuffer, uint16_t nBytesToWrite)
 {
   return ((LSM6DSOXSensor *)handle)->IO_Write(pBuffer, WriteAddr, nBytesToWrite);
 
@@ -213,6 +213,7 @@ class LSM6DSOXSensor
     LSM6DSOXStatusTypeDef Set_FIFO_Mode(uint8_t Mode);
     LSM6DSOXStatusTypeDef Get_FIFO_Tag(uint8_t *Tag);
     LSM6DSOXStatusTypeDef Get_FIFO_Data(uint8_t *Data);
+    LSM6DSOXStatusTypeDef Get_FIFO_Sample(uint8_t *Sample, uint16_t Count = 1);
     LSM6DSOXStatusTypeDef Get_FIFO_X_Axes(int32_t *Acceleration);
     LSM6DSOXStatusTypeDef Set_FIFO_X_BDR(float Bdr);
     LSM6DSOXStatusTypeDef Get_FIFO_G_Axes(int32_t *AngularVelocity);
@@ -221,6 +222,11 @@ class LSM6DSOXSensor
     LSM6DSOXStatusTypeDef Get_MLC_Status(LSM6DSOX_MLC_Status_t *Status);
     LSM6DSOXStatusTypeDef Get_MLC_Output(uint8_t *Output);
 
+    LSM6DSOXStatusTypeDef Get_Timestamp_Status(uint8_t *Status);
+    LSM6DSOXStatusTypeDef Set_Timestamp_Status(uint8_t Status);
+
+    LSM6DSOXStatusTypeDef Set_FIFO_Timestamp_Decimation(uint8_t Decimation);
+
     /**
      * @brief Utility function to read data.
      * @param  pBuffer: pointer to data to be read.