#pragma once #include #include #include #include "AP_Baro_Backend.h" #ifndef HAL_BARO_FBM320_I2C_ADDR #define HAL_BARO_FBM320_I2C_ADDR 0x6C #endif #ifndef HAL_BARO_FBM320_I2C_ADDR2 #define HAL_BARO_FBM320_I2C_ADDR2 0x6D #endif class AP_Baro_FBM320 : public AP_Baro_Backend { public: AP_Baro_FBM320(AP_Baro &baro, AP_HAL::OwnPtr dev); /* AP_Baro public interface: */ void update() override; static AP_Baro_Backend *probe(AP_Baro &baro, AP_HAL::OwnPtr dev); private: bool init(void); bool read_calibration(void); void timer(void); void calculate_PT(int32_t UT, int32_t UP, int32_t &pressure, int32_t &temperature); AP_HAL::OwnPtr dev; uint8_t instance; uint32_t count; float pressure_sum; float temperature_sum; uint8_t step; int32_t value_T; // Internal calibration registers struct fbm320_calibration { uint16_t C0, C1, C2, C3, C6, C8, C9, C10, C11, C12; uint32_t C4, C5, C7; } calibration; };