Browse Source

AP_Baro: update example to use accumulate()

master
Andrew Tridgell 12 years ago
parent
commit
1ce1fa3864
  1. 15
      libraries/AP_Baro/examples/AP_Baro_BMP085_test/AP_Baro_BMP085_test.pde

15
libraries/AP_Baro/examples/AP_Baro_BMP085_test/AP_Baro_BMP085_test.pde

@ -44,11 +44,22 @@ void setup() @@ -44,11 +44,22 @@ void setup()
void loop()
{
float tmp_float;
static uint32_t last_print;
if((hal.scheduler->micros()- timer) > 50000L) {
bmp085.accumulate();
// accumulate values at 50Hz
if ((hal.scheduler->micros()- timer) > 20000L) {
bmp085.read();
timer = hal.scheduler->micros();
}
// print at 2Hz
if ((hal.scheduler->millis()- last_print) >= 500) {
uint32_t start = hal.scheduler->micros();
last_print = hal.scheduler->millis();
bmp085.read();
uint32_t read_time = hal.scheduler->micros() - timer;
uint32_t read_time = hal.scheduler->micros() - start;
if (! bmp085.healthy) {
hal.console->println("not healthy");
return;

Loading…
Cancel
Save