mirror of https://github.com/ArduPilot/ardupilot
AP_Baro: consider a baro unhealthy when outside of -200 to 200 C
this helps detects unhealthy baros on SPI where we can't detect comms failure
This commit is contained in:
parent
ecd9c88003
commit
49f7e22c72
|
@ -27,6 +27,15 @@ void AP_Baro_Backend::update_healthy_flag(uint8_t instance)
|
||||||
(now - _frontend.sensors[instance].last_change_ms < BARO_DATA_CHANGE_TIMEOUT_MS) &&
|
(now - _frontend.sensors[instance].last_change_ms < BARO_DATA_CHANGE_TIMEOUT_MS) &&
|
||||||
!is_zero(_frontend.sensors[instance].pressure);
|
!is_zero(_frontend.sensors[instance].pressure);
|
||||||
|
|
||||||
|
if (_frontend.sensors[instance].temperature < -200 ||
|
||||||
|
_frontend.sensors[instance].temperature > 200) {
|
||||||
|
// if temperature is way out of range then we likely have bad
|
||||||
|
// data from the sensor, treat is as unhealthy. This is done
|
||||||
|
// so SPI sensors which have no data validity checking can
|
||||||
|
// mark a sensor unhealthy
|
||||||
|
_frontend.sensors[instance].healthy = false;
|
||||||
|
}
|
||||||
|
|
||||||
_sem->give();
|
_sem->give();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue