2017-07-21 01:27:32 -03:00
|
|
|
#pragma once
|
|
|
|
|
|
|
|
#include <AP_HAL/AP_HAL.h>
|
|
|
|
#include <AP_HAL/Device.h>
|
|
|
|
#include <AP_HAL/utility/OwnPtr.h>
|
|
|
|
|
|
|
|
#include "AP_Baro_Backend.h"
|
|
|
|
|
2018-08-22 21:42:06 -03:00
|
|
|
#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
|
|
|
|
|
|
|
|
|
2017-07-21 01:27:32 -03:00
|
|
|
class AP_Baro_FBM320 : public AP_Baro_Backend {
|
|
|
|
public:
|
|
|
|
AP_Baro_FBM320(AP_Baro &baro, AP_HAL::OwnPtr<AP_HAL::Device> dev);
|
|
|
|
|
|
|
|
/* AP_Baro public interface: */
|
|
|
|
void update();
|
|
|
|
|
|
|
|
static AP_Baro_Backend *probe(AP_Baro &baro, AP_HAL::OwnPtr<AP_HAL::Device> 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<AP_HAL::Device> 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;
|
|
|
|
};
|