Rover: Report GPS health

This commit is contained in:
Michael du Breuil 2017-09-21 18:41:21 -07:00 committed by Francisco Ferreira
parent 52fc2c82af
commit 4f83d39b5e

View File

@ -329,7 +329,7 @@ void Rover::update_sensor_status_flags(void)
if (g.compass_enabled && compass.healthy(0) && ahrs.use_compass()) {
control_sensors_health |= MAV_SYS_STATUS_SENSOR_3D_MAG;
}
if (gps.status() >= AP_GPS::GPS_OK_FIX_3D) {
if (gps.status() >= AP_GPS::GPS_OK_FIX_3D && gps.is_healthy()) {
control_sensors_health |= MAV_SYS_STATUS_SENSOR_GPS;
}
if (g2.visual_odom.enabled() && !g2.visual_odom.healthy()) {