2011-12-28 05:32:21 -04:00
|
|
|
/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
2011-11-27 01:34:26 -04:00
|
|
|
#ifndef __AP_BARO_BMP085_H__
|
|
|
|
#define __AP_BARO_BMP085_H__
|
2011-11-27 00:42:52 -04:00
|
|
|
|
2012-03-07 00:55:15 -04:00
|
|
|
#define PRESS_FILTER_SIZE 2
|
2011-11-27 00:42:52 -04:00
|
|
|
|
2012-12-14 21:53:07 -04:00
|
|
|
#include "AP_Baro.h"
|
2012-03-17 13:06:02 -03:00
|
|
|
#include <AverageFilter.h>
|
2011-11-27 00:42:52 -04:00
|
|
|
|
2011-11-30 00:31:40 -04:00
|
|
|
class AP_Baro_BMP085 : public AP_Baro
|
2011-11-27 00:42:52 -04:00
|
|
|
{
|
2012-08-17 03:09:24 -03:00
|
|
|
public:
|
2014-08-13 10:57:56 -03:00
|
|
|
AP_Baro_BMP085() :
|
|
|
|
RawPress(0),
|
|
|
|
RawTemp(0),
|
|
|
|
_temp_sum(0.0f),
|
|
|
|
_press_sum(0.0f),
|
|
|
|
_count(0),
|
|
|
|
Temp(0.0f),
|
|
|
|
Press(0.0f),
|
|
|
|
_last_press_read_command_time(0),
|
|
|
|
_last_temp_read_command_time(0),
|
|
|
|
BMP085_State(0),
|
|
|
|
ac1(0), ac2(0), ac3(0), b1(0), b2(0), mb(0), mc(0), md(0),
|
|
|
|
ac4(0), ac5(0), ac6(0),
|
|
|
|
_retry_time(0)
|
|
|
|
{
|
2012-08-17 03:09:24 -03:00
|
|
|
_pressure_samples = 1;
|
|
|
|
}; // Constructor
|
2011-11-30 00:31:40 -04:00
|
|
|
|
|
|
|
|
|
|
|
/* AP_Baro public interface: */
|
2012-10-11 14:53:21 -03:00
|
|
|
bool init();
|
2012-08-17 03:09:24 -03:00
|
|
|
uint8_t read();
|
2013-01-09 08:05:17 -04:00
|
|
|
void accumulate(void);
|
2012-08-17 03:09:24 -03:00
|
|
|
float get_pressure();
|
|
|
|
float get_temperature();
|
2011-11-30 00:31:40 -04:00
|
|
|
|
2012-08-17 03:09:24 -03:00
|
|
|
private:
|
|
|
|
int32_t RawPress;
|
|
|
|
int32_t RawTemp;
|
2013-01-09 08:05:17 -04:00
|
|
|
float _temp_sum;
|
|
|
|
float _press_sum;
|
|
|
|
uint8_t _count;
|
|
|
|
float Temp;
|
|
|
|
float Press;
|
2013-09-23 00:12:09 -03:00
|
|
|
// Flymaple has no EOC pin, so use times instead
|
|
|
|
uint32_t _last_press_read_command_time;
|
|
|
|
uint32_t _last_temp_read_command_time;
|
|
|
|
|
2013-01-09 08:05:17 -04:00
|
|
|
|
2011-11-27 00:42:52 -04:00
|
|
|
// State machine
|
2012-08-17 03:09:24 -03:00
|
|
|
uint8_t BMP085_State;
|
|
|
|
// Internal calibration registers
|
|
|
|
int16_t ac1, ac2, ac3, b1, b2, mb, mc, md;
|
|
|
|
uint16_t ac4, ac5, ac6;
|
2011-11-27 00:42:52 -04:00
|
|
|
|
2012-08-17 03:09:24 -03:00
|
|
|
AverageFilterInt32_Size4 _temp_filter;
|
2011-11-27 00:42:52 -04:00
|
|
|
|
2012-08-17 03:09:24 -03:00
|
|
|
uint32_t _retry_time;
|
2011-11-27 00:42:52 -04:00
|
|
|
|
2012-08-17 03:09:24 -03:00
|
|
|
void Command_ReadPress();
|
|
|
|
void Command_ReadTemp();
|
|
|
|
void ReadPress();
|
|
|
|
void ReadTemp();
|
|
|
|
void Calculate();
|
2011-11-27 00:42:52 -04:00
|
|
|
};
|
|
|
|
|
2011-11-27 01:34:26 -04:00
|
|
|
#endif // __AP_BARO_BMP085_H__
|