|
|
|
@ -15,7 +15,7 @@ static uint8_t counter;
@@ -15,7 +15,7 @@ static uint8_t counter;
|
|
|
|
|
|
|
|
|
|
void setup() |
|
|
|
|
{ |
|
|
|
|
hal.console->println("Barometer library test"); |
|
|
|
|
hal.console->printf("Barometer library test\n"); |
|
|
|
|
|
|
|
|
|
AP_BoardConfig{}.init(); |
|
|
|
|
|
|
|
|
@ -41,19 +41,19 @@ void loop()
@@ -41,19 +41,19 @@ void loop()
|
|
|
|
|
uint32_t read_time = AP_HAL::micros() - timer; |
|
|
|
|
float alt = barometer.get_altitude(); |
|
|
|
|
if (!barometer.healthy()) { |
|
|
|
|
hal.console->println("not healthy"); |
|
|
|
|
hal.console->printf("not healthy\n"); |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
hal.console->print("Pressure:"); |
|
|
|
|
hal.console->print(barometer.get_pressure()); |
|
|
|
|
hal.console->print(" Temperature:"); |
|
|
|
|
hal.console->print(barometer.get_temperature()); |
|
|
|
|
hal.console->print(" Altitude:"); |
|
|
|
|
hal.console->print(alt); |
|
|
|
|
hal.console->printf("Pressure:"); |
|
|
|
|
hal.console->printf(barometer.get_pressure()); |
|
|
|
|
hal.console->printf(" Temperature:"); |
|
|
|
|
hal.console->printf(barometer.get_temperature()); |
|
|
|
|
hal.console->printf(" Altitude:"); |
|
|
|
|
hal.console->printf(alt); |
|
|
|
|
hal.console->printf(" climb=%.2f t=%u", |
|
|
|
|
barometer.get_climb_rate(), |
|
|
|
|
(unsigned)read_time); |
|
|
|
|
hal.console->println(); |
|
|
|
|
hal.console->print("\n"); |
|
|
|
|
} else { |
|
|
|
|
hal.scheduler->delay(1); |
|
|
|
|
} |
|
|
|
|