diff --git a/libraries/AP_Baro/AP_Baro.cpp b/libraries/AP_Baro/AP_Baro.cpp index 9e63ea25270131d20059567df081a447e2c711f0..44a86137ee449c2668074b8061a58d3de45b0db0 100644 --- a/libraries/AP_Baro/AP_Baro.cpp +++ b/libraries/AP_Baro/AP_Baro.cpp @@ -329,3 +329,16 @@ uint8_t AP_Baro::register_sensor(void) return _num_sensors++; } + +/* + check if all barometers are healthy + */ +bool AP_Baro::all_healthy(void) const +{ + for (uint8_t i=0; i<_num_sensors; i++) { + if (!healthy(i)) { + return false; + } + } + return _num_sensors > 0; +} diff --git a/libraries/AP_Baro/AP_Baro.h b/libraries/AP_Baro/AP_Baro.h index 185de9bddc11f24219adf31ed4326bdbb9234e38..300ab27cf35ea7023f0ae5b2c8248d82c36352a6 100644 --- a/libraries/AP_Baro/AP_Baro.h +++ b/libraries/AP_Baro/AP_Baro.h @@ -44,6 +44,9 @@ public: bool healthy(void) const { return healthy(_primary); } bool healthy(uint8_t instance) const { return sensors[instance].healthy && sensors[instance].alt_ok; } + // check if all baros are healthy - used for SYS_STATUS report + bool all_healthy(void) const; + // pressure in Pascal. Divide by 100 for millibars or hectopascals float get_pressure(void) const { return get_pressure(_primary); } float get_pressure(uint8_t instance) const { return sensors[instance].pressure; }