|
|
@ -41,7 +41,7 @@ void setup() |
|
|
|
} |
|
|
|
} |
|
|
|
hal.console->println("initialisation complete."); |
|
|
|
hal.console->println("initialisation complete."); |
|
|
|
hal.scheduler->delay(1000); |
|
|
|
hal.scheduler->delay(1000); |
|
|
|
timer = hal.scheduler->micros(); |
|
|
|
timer = AP_HAL::micros(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void loop() |
|
|
|
void loop() |
|
|
@ -50,17 +50,17 @@ void loop() |
|
|
|
static uint32_t last_print; |
|
|
|
static uint32_t last_print; |
|
|
|
|
|
|
|
|
|
|
|
// accumulate values at 100Hz
|
|
|
|
// accumulate values at 100Hz
|
|
|
|
if ((hal.scheduler->micros()- timer) > 20000L) { |
|
|
|
if ((AP_HAL::micros()- timer) > 20000L) { |
|
|
|
bmp085.accumulate(); |
|
|
|
bmp085.accumulate(); |
|
|
|
timer = hal.scheduler->micros(); |
|
|
|
timer = AP_HAL::micros(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// print at 10Hz
|
|
|
|
// print at 10Hz
|
|
|
|
if ((hal.scheduler->millis()- last_print) >= 100) { |
|
|
|
if ((AP_HAL::millis()- last_print) >= 100) { |
|
|
|
uint32_t start = hal.scheduler->micros(); |
|
|
|
uint32_t start = AP_HAL::micros(); |
|
|
|
last_print = hal.scheduler->millis(); |
|
|
|
last_print = AP_HAL::millis(); |
|
|
|
bmp085.read(); |
|
|
|
bmp085.read(); |
|
|
|
uint32_t read_time = hal.scheduler->micros() - start; |
|
|
|
uint32_t read_time = AP_HAL::micros() - start; |
|
|
|
if (! bmp085.healthy) { |
|
|
|
if (! bmp085.healthy) { |
|
|
|
hal.console->println("not healthy"); |
|
|
|
hal.console->println("not healthy"); |
|
|
|
return; |
|
|
|
return; |
|
|
|