/**
* @brief Read LPS25H output register, and calculate the raw pressure
* @param raw_press the pressure raw value
* @retval PRESSURE_OK in case of success, an error code otherwise
*/
static PRESSURE_StatusTypeDef LPS25H_I2C_ReadRawPressure(int32_t *raw_press)
{
uint8_t buffer[3], i;
uint32_t tempVal = 0;
/* Read the register content */
if(LPS25H_IO_Read(buffer, LPS25H_SlaveAddress, (LPS25H_PRESS_POUT_XL_ADDR | LPS25H_I2C_MULTIPLEBYTE_CMD),
3) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
/* Build the raw data */
for (i = 0 ; i < 3 ; i++)
tempVal |= (((uint32_t) buffer[i]) << (8 * i));
/* convert the 2's complement 24 bit to 2's complement 32 bit */
if (tempVal & 0x00800000)
tempVal |= 0xFF000000;
/* return the built value */
*raw_press = ((int32_t) tempVal);
return PRESSURE_OK;
}
/**
* @brief Read ID address of LPS25H
* @param ht_id the pointer where the ID of the device is stored
* @retval PRESSURE_OK in case of success, an error code otherwise
*/
static PRESSURE_StatusTypeDef LPS25H_ReadID(uint8_t *p_id)
{
if(!p_id)
{
return PRESSURE_ERROR;
}
return LPS25H_IO_Read(p_id, LPS25H_SlaveAddress, LPS25H_WHO_AM_I_ADDR, 1);
}
/**
* @brief Read LPS25H output register, and calculate the raw temperature
* @param raw_data the temperature raw value
* @retval PRESSURE_OK in case of success, an error code otherwise
*/
static PRESSURE_StatusTypeDef LPS25H_I2C_ReadRawTemperature(int16_t *raw_data)
{
uint8_t buffer[2];
uint16_t tempVal = 0;
/* Read the register content */
if(LPS25H_IO_Read(buffer, LPS25H_SlaveAddress, (LPS25H_TEMP_OUT_L_ADDR | LPS25H_I2C_MULTIPLEBYTE_CMD),
2) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
/* Build the raw value */
tempVal = (((uint16_t)buffer[1]) << 8) + (uint16_t)buffer[0];
/* Return it */
*raw_data = ((int16_t)tempVal);
return PRESSURE_OK;
}
/**
* @brief Enter the shutdown mode for LPS25H
* @retval PRESSURE_OK in case of success, an error code otherwise
*/
static PRESSURE_StatusTypeDef LPS25H_PowerOff(void)
{
uint8_t tmpreg;
/* Read the register content */
if(LPS25H_IO_Read(&tmpreg, LPS25H_SlaveAddress, LPS25H_CTRL_REG1_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
/* Reset the power down bit */
tmpreg &= ~(LPS25H_MODE_ACTIVE);
/* Write register */
if(LPS25H_IO_Write(&tmpreg, LPS25H_SlaveAddress, LPS25H_CTRL_REG1_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
return PRESSURE_OK;
}
/**
* @brief Reboot memory content of LPS25H
* @retval PRESSURE_OK in case of success, an error code otherwise
*/
static PRESSURE_StatusTypeDef LPS25H_RebootCmd(void)
{
uint8_t tmpreg;
/* Read CTRL_REG5 register */
if(LPS25H_IO_Read(&tmpreg, LPS25H_SlaveAddress, LPS25H_CTRL_REG2_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
/* Enable or Disable the reboot memory */
tmpreg |= LPS25H_RESET_MEMORY;
/* Write value to MEMS CTRL_REG5 regsister */
if(LPS25H_IO_Write(&tmpreg, LPS25H_SlaveAddress, LPS25H_CTRL_REG2_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
return PRESSURE_OK;
}
/**
* @brief Exit the shutdown mode for LPS25H
* @retval PRESSURE_OK in case of success, an error code otherwise
*/
PRESSURE_StatusTypeDef LPS25H::LPS25H_PowerOn(void)
{
uint8_t tmpreg;
/* Read the register content */
if(LPS25H_IO_Read(&tmpreg, LPS25H_CTRL_REG1_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
/* Set the power down bit */
tmpreg |= LPS25H_MODE_ACTIVE;
/* Write register */
if(LPS25H_IO_Write(&tmpreg, LPS25H_CTRL_REG1_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
return PRESSURE_OK;
}
/**
* @brief Set LPS25H Initialization
* @param LPS25H_Init the configuration setting for the LPS25H
* @retval PRESSURE_OK in case of success, an error code otherwise
*/
static PRESSURE_StatusTypeDef LPS25H_Init(PRESSURE_InitTypeDef *LPS25H_Init)
{
uint8_t tmp1 = 0x00;
/* Configure the low level interface ---------------------------------------*/
if(LPS25H_IO_Init() != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
if(LPS25H_PowerOn() != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
if(LPS25H_IO_Read(&tmp1, LPS25H_SlaveAddress, LPS25H_CTRL_REG1_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
/* Output Data Rate selection */
tmp1 &= ~(LPS25H_ODR_MASK);
tmp1 |= LPS25H_Init->OutputDataRate;
/* Interrupt circuit selection */
tmp1 &= ~(LPS25H_DIFF_EN_MASK);
tmp1 |= LPS25H_Init->DiffEnable;
/* Block Data Update selection */
tmp1 &= ~(LPS25H_BDU_MASK);
tmp1 |= LPS25H_Init->BlockDataUpdate;
/* Serial Interface Mode selection */
tmp1 &= ~(LPS25H_SPI_SIM_MASK);
tmp1 |= LPS25H_Init->SPIMode;
if(LPS25H_IO_Write(&tmp1, LPS25H_SlaveAddress, LPS25H_CTRL_REG1_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
if(LPS25H_IO_Read(&tmp1, LPS25H_SlaveAddress, LPS25H_RES_CONF_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
/* Serial Interface Mode selection */
tmp1 &= ~(LPS25H_P_RES_MASK);
tmp1 |= LPS25H_Init->PressureResolution;
/* Serial Interface Mode selection */
tmp1 &= ~(LPS25H_T_RES_MASK);
tmp1 |= LPS25H_Init->TemperatureResolution;
if(LPS25H_IO_Write(&tmp1, LPS25H_SlaveAddress, LPS25H_RES_CONF_ADDR, 1) != PRESSURE_OK)
{
return PRESSURE_ERROR;
}
LPS25H_IO_ITConfig();
return PRESSURE_OK;
}
