Digital Barometric Pressure Sensor
QMP6988.cpp
- Committer:
- mcm
- Date:
- 2022-02-25
- Revision:
- 2:b186771f85a2
- Parent:
- 0:24413d35ed9c
File content as of revision 2:b186771f85a2:
/** * @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; }