[STM32U5] STM32U585AI探索套件压力传感器LPS22HH驱动与海拔换算

#include <inttypes.h>



typedef enum

{

  LPS22HH_PASSED = 0U,

  LPS22HH_FAILED

} LPS22HHState;



#define LPS22HH_RD 0xBB

#define LPS22HH_WR 0xBA



#define IF_CTRL 0x0E

#define CTRL_REG1 0x10

#define REG_WHO_AM_I 0x0F



#define PRESSURE_OUT_XL 0x28

#define PRESSURE_OUT_L 0x29

#define PRESSURE_OUT_H 0x2A



#define TEMP_OUT_L 0x2B

#define TEMP_OUT_H 0x2C



void LPS22HH_Init(void);

float LPS22HH_GET_Pressure(void);

float LPS22HH_GET_Temperature(void);

LPS22HHState LPS22HH_Identity_Verification(void);

void LPS22HH_Init(void)

{

        uint8_t cfg1[2] = {IF_CTRL, 0x00};

        HAL_I2C_Mem_Write(&hi2c2, LPS22HH_WR, cfg1[0], I2C_MEMADD_SIZE_8BIT, cfg1 + 1, 1, 0xFF);

        uint8_t cfg2[2] = {CTRL_REG1, 0x20};

        HAL_I2C_Mem_Write(&hi2c2, LPS22HH_WR, cfg2[0], I2C_MEMADD_SIZE_8BIT, cfg2 + 1, 1, 0xFF);

}

LPS22HHState LPS22HH_Identity_Verification(void)

{

        uint8_t reg_value = 0;

        HAL_I2C_Mem_Read(&hi2c2, LPS22HH_RD, REG_WHO_AM_I, I2C_MEMADD_SIZE_8BIT, reg_value, 1, 0xFFFF);

        if (reg_value == 0xB3)

                return LPS22HH_PASSED;

        else

                return LPS22HH_FAILED;

}

float LPS22HH_GET_Pressure(void)

{

        float pressure = 0;

        int32_t pressure_s32 = 0;

        uint8_t pressure_xl, pressure_l, pressure_h = 0;

        HAL_I2C_Mem_Read(&hi2c2, LPS22HH_RD, PRESSURE_OUT_XL, I2C_MEMADD_SIZE_8BIT, &pressure_xl, 1, 0xFFFF);

        HAL_I2C_Mem_Read(&hi2c2, LPS22HH_RD, PRESSURE_OUT_L, I2C_MEMADD_SIZE_8BIT, &pressure_l, 1, 0xFFFF);

        HAL_I2C_Mem_Read(&hi2c2, LPS22HH_RD, PRESSURE_OUT_H, I2C_MEMADD_SIZE_8BIT, &pressure_h, 1, 0xFFFF);

        pressure_s32 = (pressure_h << 16) | (pressure_l << 8) | pressure_xl;

        pressure = (float)pressure_s32 / 4096 / 10;

        return pressure;

}

float LPS22HH_GET_Temperature(void)

{

        float temperature = 0;

        int16_t temperature_s16 = 0;

        uint8_t temperature_l, temperature_h = 0;

        HAL_I2C_Mem_Read(&hi2c2, LPS22HH_RD, TEMP_OUT_L, I2C_MEMADD_SIZE_8BIT, &temperature_l, 1, 0xFFFF);

        HAL_I2C_Mem_Read(&hi2c2, LPS22HH_RD, TEMP_OUT_H, I2C_MEMADD_SIZE_8BIT, &temperature_h, 1, 0xFFFF);

        temperature_s16 = (temperature_h << 8) | temperature_l;

        temperature = (float)temperature_s16 / 100 - 1.5;

        return temperature;

}

printf("----Altitude-----: %fm\r\n",44330*(1- pow(pressure/102.3,0.19))/1000);