Manuel Caballero
Digital Barometric Pressure Sensor
Diff: QMP6988.cpp
- Revision:
- 2:b186771f85a2
- Parent:
- 0:24413d35ed9c
--- a/QMP6988.cpp Fri Feb 25 15:03:01 2022 +0000
+++ b/QMP6988.cpp Fri Feb 25 15:24:48 2022 +0000
@@ -0,0 +1,1154 @@
+/**
+ * @brief QMP6988.cpp
+ * @details Digital Barometric Pressure Sensor.
+ * Function file.
+ *
+ *
+ * @return N/A
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A.
+ * @warning N/A
+ * @pre This code belongs to AqueronteBlog ( http://unbarquero.blogspot.com ).
+ */
+
+#include "QMP6988.h"
+
+
+QMP6988::QMP6988 ( PinName sda, PinName scl, uint32_t addr, uint32_t freq )
+ : _i2c ( sda, scl )
+ , _QMP6988_Addr ( addr )
+{
+ _i2c.frequency( freq );
+}
+
+
+QMP6988::~QMP6988()
+{
+}
+
+
+
+/**
+ * @brief QMP6988_GetRawCompensationCoefficients ( QMP6988_raw_compensation_coefficients_t* )
+ * @details It gets the raw compensation coefficients.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myRawK: Raw compensation coefficients.
+ *
+ *
+ * @return Status of QMP6988_GetRawCompensationCoefficients
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetRawCompensationCoefficients ( QMP6988_raw_compensation_coefficients_t* myRawK )
+{
+ char cmd[25] = { 0 };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_COE_B00_1;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ) );
+
+ /* Parse the data */
+ myRawK->raw_b00 = cmd[0];
+ myRawK->raw_b00 <<= 8U;
+ myRawK->raw_b00 |= cmd[1];
+ myRawK->raw_b00 <<= 4U;
+ myRawK->raw_b00 |= ( ( cmd[24] & 0xF0 ) >> 4U );
+
+ myRawK->raw_bt1 = cmd[2];
+ myRawK->raw_bt1 <<= 8U;
+ myRawK->raw_bt1 |= cmd[3];
+
+ myRawK->raw_bt2 = cmd[4];
+ myRawK->raw_bt2 <<= 8U;
+ myRawK->raw_bt2 |= cmd[5];
+
+ myRawK->raw_bp1 = cmd[6];
+ myRawK->raw_bp1 <<= 8U;
+ myRawK->raw_bp1 |= cmd[7];
+
+ myRawK->raw_b11 = cmd[8];
+ myRawK->raw_b11 <<= 8U;
+ myRawK->raw_b11 |= cmd[9];
+
+ myRawK->raw_bp2 = cmd[10];
+ myRawK->raw_bp2 <<= 8U;
+ myRawK->raw_bp2 |= cmd[11];
+
+ myRawK->raw_b12 = cmd[12];
+ myRawK->raw_b12 <<= 8U;
+ myRawK->raw_b12 |= cmd[13];
+
+ myRawK->raw_b21 = cmd[14];
+ myRawK->raw_b21 <<= 8U;
+ myRawK->raw_b21 |= cmd[15];
+
+ myRawK->raw_bp3 = cmd[16];
+ myRawK->raw_bp3 <<= 8U;
+ myRawK->raw_bp3 |= cmd[17];
+
+ myRawK->raw_a0 = cmd[18];
+ myRawK->raw_a0 <<= 8U;
+ myRawK->raw_a0 |= cmd[19];
+ myRawK->raw_a0 <<= 4U;
+ myRawK->raw_a0 |= ( cmd[24] & 0x0F );
+
+ myRawK->raw_a1 = cmd[20];
+ myRawK->raw_a1 <<= 8U;
+ myRawK->raw_a1 |= cmd[21];
+
+ myRawK->raw_a2 = cmd[22];
+ myRawK->raw_a2 <<= 8U;
+ myRawK->raw_a2 |= cmd[23];
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetChipID ( uint8_t* )
+ * @details It gets the chip ID.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myChipID: Chip ID.
+ *
+ *
+ * @return Status of QMP6988_GetChipID
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetChipID ( uint8_t* myChipID )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_CHIP_ID;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myChipID = cmd;
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SoftReset ( void )
+ * @details It performs a software reset.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SoftReset
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning The user must wait for at least 100us (Trst) after using this function.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SoftReset ( void )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_RESET;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetIIR_Filter ( QMP6988_iir_filter_t )
+ * @details It sets the IIR filter co-efficient.
+ *
+ * @param[in] N/A.
+ * @param[in] myFilter: IIR filter
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetIIR_Filter
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetIIR_Filter ( QMP6988_iir_filter_t myFilter )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Write the register */
+ cmd[0] = QMP6988_IIR_CNT;
+ cmd[1] = myFilter;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetIIR_Filter ( QMP6988_iir_filter_t* )
+ * @details It gets the IIR filter co-efficient.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myFilter: IIR filter.
+ *
+ *
+ * @return Status of QMP6988_GetIIR_Filter
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetIIR_Filter ( QMP6988_iir_filter_t* myFilter )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_IIR_CNT;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myFilter = (QMP6988_iir_filter_t)cmd;
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetMasterCodeI2C ( QMP6988_i2c_set_master_code_t )
+ * @details It sets the master code setting at I2C HS mode.
+ *
+ * @param[in] myMasterCode: Master code setting at I2C HS mode
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetMasterCodeI2C
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetMasterCodeI2C ( QMP6988_i2c_set_master_code_t myMasterCode )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Write the register */
+ cmd[0] = QMP6988_I2C_SET;
+ cmd[1] = myMasterCode;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetMasterCodeI2C ( QMP6988_i2c_set_master_code_t* )
+ * @details It gets the master code setting at I2C HS mode.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myMasterCode: Master code setting at I2C HS mode.
+ *
+ *
+ * @return Status of QMP6988_GetMasterCodeI2C
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetMasterCodeI2C ( QMP6988_i2c_set_master_code_t* myMasterCode )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_I2C_SET;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myMasterCode = (QMP6988_i2c_set_master_code_t)cmd;
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetDeviceStat ( uint8_t* )
+ * @details It gets the device stat.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myDeviceStat: Device stat: Measure and OTP update.
+ *
+ *
+ * @return Status of QMP6988_GetDeviceStat
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetDeviceStat ( uint8_t* myDeviceStat )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_DEVICE_STAT;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myDeviceStat = cmd;
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetPowerMode ( QMP6988_ctrl_meas_power_mode_t )
+ * @details It sets the power mode.
+ *
+ * @param[in] myPowerMode: Power mode setting.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetPowerMode
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetPowerMode ( QMP6988_ctrl_meas_power_mode_t myPowerMode )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_CTRL_MEAS;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[1], 1U );
+
+ /* Update the register */
+ cmd[0] = QMP6988_CTRL_MEAS;
+ cmd[1] &= ~CTRL_MEAS_POWER_MODE_MASK;
+ cmd[1] |= myPowerMode;
+ aux |= _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetPowerMode ( QMP6988_ctrl_meas_power_mode_t* )
+ * @details It gets the power mode.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myPowerMode: Power mode setting.
+ *
+ *
+ * @return Status of QMP6988_GetPowerMode
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetPowerMode ( QMP6988_ctrl_meas_power_mode_t* myPowerMode )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_CTRL_MEAS;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myPowerMode = (QMP6988_ctrl_meas_power_mode_t)( cmd & CTRL_MEAS_POWER_MODE_MASK );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetTemperatureAverage ( QMP6988_ctrl_meas_temp_average_t )
+ * @details It sets the temperature averaging time.
+ *
+ * @param[in] myTempAvrg: Temperature averaging time.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetTemperatureAverage
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetTemperatureAverage ( QMP6988_ctrl_meas_temp_average_t myTempAvrg )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_CTRL_MEAS;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[1], 1U );
+
+ /* Update the register */
+ cmd[0] = QMP6988_CTRL_MEAS;
+ cmd[1] &= ~CTRL_MEAS_TEMP_AVERAGE_MASK;
+ cmd[1] |= myTempAvrg;
+ aux |= _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetTemperatureAverage ( QMP6988_ctrl_meas_temp_average_t* )
+ * @details It gets the temperature averaging time.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myTempAvrg: Temperature averaging time.
+ *
+ *
+ * @return Status of QMP6988_GetTemperatureAverage
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetTemperatureAverage ( QMP6988_ctrl_meas_temp_average_t* myTempAvrg )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_CTRL_MEAS;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myTempAvrg = (QMP6988_ctrl_meas_temp_average_t)( cmd & CTRL_MEAS_TEMP_AVERAGE_MASK );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetPressureAverage ( QMP6988_ctrl_meas_press_average_t )
+ * @details It sets the pressure averaging time.
+ *
+ * @param[in] myPressAvrg: Pressure averaging time.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetPressureAverage
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetPressureAverage ( QMP6988_ctrl_meas_press_average_t myPressAvrg )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_CTRL_MEAS;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[1], 1U );
+
+ /* Update the register */
+ cmd[0] = QMP6988_CTRL_MEAS;
+ cmd[1] &= ~CTRL_MEAS_PRESS_AVERAGE_MASK;
+ cmd[1] |= myPressAvrg;
+ aux |= _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetPressureAverage ( QMP6988_ctrl_meas_press_average_t* )
+ * @details It gets the pressure averaging time.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myPressAvrg: Pressure averaging time.
+ *
+ *
+ * @return Status of QMP6988_GetPressureAverage
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetPressureAverage ( QMP6988_ctrl_meas_press_average_t* myPressAvrg )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_CTRL_MEAS;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myPressAvrg = (QMP6988_ctrl_meas_press_average_t)( cmd & CTRL_MEAS_PRESS_AVERAGE_MASK );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetStandbyTimeSetting ( QMP6988_io_setup_t_standby_t )
+ * @details It sets the standby time setting.
+ *
+ * @param[in] myStandbyTime: Standby time setting.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetStandbyTimeSetting
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetStandbyTimeSetting ( QMP6988_io_setup_t_standby_t myStandbyTime )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_IO_SETUP;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[1], 1U );
+
+ /* Update the register */
+ cmd[0] = QMP6988_IO_SETUP;
+ cmd[1] &= ~IO_SETUP_T_STANDBY_MASK;
+ cmd[1] |= myStandbyTime;
+ aux |= _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetStandbyTimeSetting ( QMP6988_io_setup_t_standby_t* )
+ * @details It gets the standby time setting.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myStandbyTime: Standby time setting.
+ *
+ *
+ * @return Status of QMP6988_GetStandbyTimeSetting
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetStandbyTimeSetting ( QMP6988_io_setup_t_standby_t* myStandbyTime )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_IO_SETUP;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *myStandbyTime = (QMP6988_io_setup_t_standby_t)( cmd & IO_SETUP_T_STANDBY_MASK );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetSPI_ModeSetting ( QMP6988_io_setup_spi3w_t )
+ * @details It sets the SPI mode setting (4 or 3 wire).
+ *
+ * @param[in] mySPI: the SPI mode setting (4 or 3 wire).
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetSPI_ModeSetting
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetSPI_ModeSetting ( QMP6988_io_setup_spi3w_t mySPI )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_IO_SETUP;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[1], 1U );
+
+ /* Update the register */
+ cmd[0] = QMP6988_IO_SETUP;
+ cmd[1] &= ~IO_SETUP_SPI3W_MASK;
+ cmd[1] |= mySPI;
+ aux |= _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetSPI_ModeSetting ( QMP6988_io_setup_spi3w_t* )
+ * @details It gets the SPI mode setting (4 or 3 wire).
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] mySPI: SPI mode setting (4 or 3 wire).
+ *
+ *
+ * @return Status of QMP6988_GetSPI_ModeSetting
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetSPI_ModeSetting ( QMP6988_io_setup_spi3w_t* mySPI )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_IO_SETUP;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *mySPI = (QMP6988_io_setup_spi3w_t)( cmd & IO_SETUP_SPI3W_MASK );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_SetSDI_Output ( QMP6988_io_setup_spi3_sdim_t )
+ * @details It sets the selected output type of SDI terminal.
+ *
+ * @param[in] mySDI: Output type of SDI terminal.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Status of QMP6988_SetSDI_Output
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_SetSDI_Output ( QMP6988_io_setup_spi3_sdim_t mySDI )
+{
+ char cmd[2] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_IO_SETUP;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[1], 1U );
+
+ /* Update the register */
+ cmd[0] = QMP6988_IO_SETUP;
+ cmd[1] &= ~IO_SETUP_SPI3_SDIM_MASK;
+ cmd[1] |= mySDI;
+ aux |= _i2c.write ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ), false );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetSDI_Output ( QMP6988_io_setup_spi3_sdim_t* )
+ * @details It gets the selected output type of SDI terminal.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] mySDI: Output type of SDI terminal.
+ *
+ *
+ * @return Status of QMP6988_GetSDI_Output
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetSDI_Output ( QMP6988_io_setup_spi3_sdim_t* mySDI )
+{
+ char cmd = 0U;
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd = QMP6988_IO_SETUP;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd, 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd, 1U );
+
+ /* Parse the data */
+ *mySDI = (QMP6988_io_setup_spi3_sdim_t)( cmd & IO_SETUP_SPI3_SDIM_MASK );
+
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_GetRawMeasurements ( QMP6988_raw_measured_data_t* )
+ * @details It gets the raw temperature and pressure data.
+ *
+ * @param[in] N/A.
+ *
+ * @param[out] myData: Raw pressure data and raw temperature data.
+ *
+ *
+ * @return Status of QMP6988_GetRawMeasurements
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+QMP6988::QMP6988_status_t QMP6988::QMP6988_GetRawMeasurements ( QMP6988_raw_measured_data_t* myData )
+{
+ char cmd[6] = { 0U };
+ uint32_t aux = I2C_SUCCESS;
+
+
+ /* Read the register */
+ cmd[0] = QMP6988_PRESS_TXD2;
+ aux = _i2c.write ( _QMP6988_Addr, &cmd[0], 1U, true );
+ aux |= _i2c.read ( _QMP6988_Addr, &cmd[0], sizeof( cmd )/sizeof( cmd[0] ) );
+
+ /* Parse the data */
+ myData->dp = cmd[0];
+ myData->dp <<= 8U;
+ myData->dp |= cmd[1];
+ myData->dp <<= 8U;
+ myData->dp |= cmd[2];
+
+ myData->dt = cmd[3];
+ myData->dt <<= 8U;
+ myData->dt |= cmd[4];
+ myData->dt <<= 8U;
+ myData->dt |= cmd[5];
+
+
+ if ( aux == I2C_SUCCESS ) {
+ return QMP6988_SUCCESS;
+ } else {
+ return QMP6988_FAILURE;
+ }
+}
+
+
+
+/**
+ * @brief QMP6988_CalculateK ( float , float , uint16_t )
+ * @details It calculates the conversion factor. K = A + ( S * OTP ) / 32767.
+ *
+ * @param[in] a: Conversion factor A.
+ * @param[in] s: Conversion factor S.
+ * @param[in] otp: Raw Compensation Coefficient.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Compensation coefficients.
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+float QMP6988::QMP6988_CalculateK ( float a, float s, uint16_t otp )
+{
+ return ( a + ( s * otp ) / 32767.0 );
+}
+
+
+
+/**
+ * @brief QMP6988_CalculateK0 ( uint32_t )
+ * @details It calculates the conversion factor. K = OTP / 16.
+ *
+ * @param[in] otp: Raw Compensation Coefficient.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Compensation coefficients.
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre N/A
+ * @warning N/A.
+ */
+float QMP6988::QMP6988_CalculateK0 ( uint32_t otp )
+{
+ return ( otp / 16.0 );
+}
+
+
+
+/**
+ * @brief QMP6988_CalculateCompensationCoefficients ( QMP6988_raw_compensation_coefficients_t )
+ * @details It calculates the compensation coefficients.
+ *
+ * @param[in] myRawK: Raw compensation coefficients.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Compensation coefficients.
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre Due to in the datasheet is not clear how to calculate the compensated values, those have been taken from the origin repo:
+ * https://github.com/m5stack/UNIT_ENV/tree/master/src.
+ * @warning N/A.
+ */
+QMP6988::QMP6988_compensation_coefficients_t QMP6988::QMP6988_CalculateCompensationCoefficients ( QMP6988_raw_compensation_coefficients_t myRawK )
+{
+ QMP6988_compensation_coefficients_t auxK;
+
+ auxK.a1 = 3608L * (int32_t)myRawK.raw_a1 - 1731677965L;
+ auxK.a2 = 16889L * (int32_t)myRawK.raw_a2 - 87619360L;
+ auxK.bt1 = 2982L * (int64_t)myRawK.raw_bt1 + 107370906L;
+ auxK.bt2 = 329854L * (int64_t)myRawK.raw_bt2 + 108083093L;
+ auxK.bp1 = 19923L * (int64_t)myRawK.raw_bp1 + 1133836764L;
+ auxK.b11 = 2406L * (int64_t)myRawK.raw_b11 + 118215883L;
+ auxK.bp2 = 3079L * (int64_t)myRawK.raw_bp2 - 181579595L;
+ auxK.b12 = 6846L * (int64_t)myRawK.raw_b12 + 85590281L;
+ auxK.b21 = 6846L * (int64_t)myRawK.raw_b21 + 85590281L;
+ auxK.bp3 = 2915L * (int64_t)myRawK.raw_bp3 + 157155561L;
+
+ auxK.a0 = myRawK.raw_a0;
+ auxK.b00 = myRawK.raw_b00;
+
+
+ return auxK;
+}
+
+
+
+/**
+ * @brief QMP6988_CalculateCompensatedMeasuredData ( QMP6988_raw_measured_data_t , QMP6988_compensation_coefficients_t )
+ * @details It calculates the compensated values: temperature and pressure.
+ *
+ * @param[in] myData: Raw measured data: Temperature and Pressure.
+ * @param[in] myK: Raw compensation coefficients.
+ *
+ * @param[out] N/A.
+ *
+ *
+ * @return Compensated Temperature and Pressure values.
+ *
+ * @author Manuel Caballero
+ * @date 25/February/2022
+ * @version 25/February/2022 The ORIGIN
+ * @pre Due to in the datasheet is not clear how to calculate the compensated values, those have been taken from the origin repo:
+ * https://github.com/m5stack/UNIT_ENV/tree/master/src
+ * @warning N/A.
+ */
+QMP6988::QMP6988_compensated_measured_data_t QMP6988::QMP6988_CalculateCompensatedMeasuredData ( QMP6988_raw_measured_data_t myData, QMP6988_compensation_coefficients_t myK )
+{
+ QMP6988_compensated_measured_data_t auxData;
+ int32_t auxT, auxP;
+ int64_t wk1, wk2, wk3;
+ int16_t t_int;
+ uint32_t p_int;
+
+
+ /* Aux data */
+ auxT = (int32_t)( myData.dt - 8388608 );
+ auxP = (int32_t)( myData.dp - 8388608 );
+
+ /* Calculate the compensated temperature */
+ wk1 = ((int64_t)myK.a1 * (int64_t)auxT); // 31Q23+24-1=54 (54Q23)
+ wk2 = ((int64_t)myK.a2 * (int64_t)auxT) >> 14; // 30Q47+24-1=53 (39Q33)
+ wk2 = (wk2 * (int64_t)auxT) >> 10; // 39Q33+24-1=62 (52Q23)
+ wk2 = ((wk1 + wk2) / 32767) >> 19; // 54,52->55Q23 (20Q04)
+ t_int = (int16_t)((myK.a0 + wk2) >> 4); // 21Q4 -> 17Q0
+
+ auxData.temperature = (float)t_int / 256.0;
+
+ /* Calculate the compensated pressure */
+ wk1 = ((int64_t)myK.bt1 * (int64_t)t_int); // 28Q15+16-1=43 (43Q15)
+ wk2 = ((int64_t)myK.bp1 * (int64_t)auxP) >> 5; // 31Q20+24-1=54 (49Q15)
+ wk1 += wk2; // 43,49->50Q15
+ wk2 = ((int64_t)myK.bt2 * (int64_t)t_int) >> 1; // 34Q38+16-1=49 (48Q37)
+ wk2 = (wk2 * (int64_t)t_int) >> 8; // 48Q37+16-1=63 (55Q29)
+ wk3 = wk2; // 55Q29
+ wk2 = ((int64_t)myK.b11 * (int64_t)t_int) >> 4; // 28Q34+16-1=43 (39Q30)
+ wk2 = (wk2 * (int64_t)auxP) >> 1; // 39Q30+24-1=62 (61Q29)
+ wk3 += wk2; // 55,61->62Q29
+ wk2 = ((int64_t)myK.bp2 * (int64_t)auxP) >> 13; // 29Q43+24-1=52 (39Q30)
+ wk2 = (wk2 * (int64_t)auxP) >> 1; // 39Q30+24-1=62 (61Q29)
+ wk3 += wk2; // 62,61->63Q29
+ wk1 += wk3 >> 14; // Q29 >> 14 -> Q15
+ wk2 = ((int64_t)myK.b12 * (int64_t)t_int); // 29Q53+16-1=45 (45Q53)
+ wk2 = (wk2 * (int64_t)t_int) >> 22; // 45Q53+16-1=61 (39Q31)
+ wk2 = (wk2 * (int64_t)auxP) >> 1; // 39Q31+24-1=62 (61Q30)
+ wk3 = wk2; // 61Q30
+ wk2 = ((int64_t)myK.b21 * (int64_t)t_int) >> 6; // 29Q60+16-1=45 (39Q54)
+ wk2 = (wk2 * (int64_t)auxP) >> 23; // 39Q54+24-1=62 (39Q31)
+ wk2 = (wk2 * (int64_t)auxP) >> 1; // 39Q31+24-1=62 (61Q20)
+ wk3 += wk2; // 61,61->62Q30
+ wk2 = ((int64_t)myK.bp3 * (int64_t)auxP) >> 12; // 28Q65+24-1=51 (39Q53)
+ wk2 = (wk2 * (int64_t)auxP) >> 23; // 39Q53+24-1=62 (39Q30)
+ wk2 = (wk2 * (int64_t)auxP); // 39Q30+24-1=62 (62Q30)
+ wk3 += wk2; // 62,62->63Q30
+ wk1 += wk3 >> 15; // Q30 >> 15 = Q15
+ wk1 /= 32767L;
+ wk1 >>= 11; // Q15 >> 7 = Q4
+ wk1 += myK.b00; // Q4 + 20Q4
+ //wk1 >>= 4;
+ p_int = (int32_t)wk1;
+
+ auxData.pressure = (float)p_int / 16.0;
+
+ return auxData;
+}
\ No newline at end of file