Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Updated on Barometer - increased the Temp filtering and decreased the pressure filtering to and get less temp noise, faster response from pressure. I'm filtering the Climb rate differently now, so this higher pressure noise should not hurt the derivative calcs at all now.

This commit is contained in:
Jason Short 2012-03-06 20:55:15 -08:00
parent f1d67c5638
commit e57b91c2e2
2 changed files with 8 additions and 29 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

30
libraries/AP_Baro/AP_Baro_BMP085.cpp
View File

@ -207,6 +207,7 @@ void AP_Baro_BMP085::Command_ReadTemp()
void AP_Baro_BMP085::ReadTemp()
{
uint8_t buf[2];
int32_t _temp_sensor;
if (!healthy && millis() < _retry_time) {
return;
@ -218,32 +219,13 @@ void AP_Baro_BMP085::ReadTemp()
healthy = false;
return;
}
RawTemp = buf[0];
RawTemp = (RawTemp << 8) | buf[1];
_temp_sensor = buf[0];
_temp_sensor = (_temp_sensor << 8) | buf[1];
if (_offset_temp == 0){
_offset_temp = RawTemp;
RawTemp = 0;
} else {
RawTemp -= _offset_temp;
}
if (RawTemp == 0)
RawTemp = _temp_sensor;
// filter
_temp_filter[_temp_index++] = RawTemp;
if(_temp_index >= TEMP_FILTER_SIZE)
_temp_index = 0;
RawTemp = 0;
// sum our filter
for(uint8_t i = 0; i < TEMP_FILTER_SIZE; i++){
RawTemp += _temp_filter[i];
}
// grab result
RawTemp /= TEMP_FILTER_SIZE;
//RawTemp >>= 4;
RawTemp += _offset_temp;
RawTemp = (float)_temp_sensor * .01 + (float)RawTemp * .99;
}
// Calculate Temperature and Pressure in real units.

5
libraries/AP_Baro/AP_Baro_BMP085.h
View File

@ -2,8 +2,7 @@
#ifndef __AP_BARO_BMP085_H__
#define __AP_BARO_BMP085_H__
#define TEMP_FILTER_SIZE 4
#define PRESS_FILTER_SIZE 8
#define PRESS_FILTER_SIZE 2
#include "AP_Baro.h"
@ -41,9 +40,7 @@ class AP_Baro_BMP085 : public AP_Baro
int16_t ac1, ac2, ac3, b1, b2, mb, mc, md;
uint16_t ac4, ac5, ac6;
int16_t _temp_filter[TEMP_FILTER_SIZE];
int32_t _press_filter[PRESS_FILTER_SIZE];
int32_t _offset_temp;
uint8_t _temp_index;
uint8_t _press_index;