Browse Source

Rover: report unhealthy compass if primary compass unhealthy

mission-4.1.18
Andrew Tridgell 11 years ago
parent
commit
bf4566095a
  1. 2
      APMrover2/GCS_Mavlink.pde

2
APMrover2/GCS_Mavlink.pde

@ -155,7 +155,7 @@ static NOINLINE void send_extended_status1(mavlink_channel_t chan) @@ -155,7 +155,7 @@ static NOINLINE void send_extended_status1(mavlink_channel_t chan)
// default to all healthy except compass and gps which we set individually
control_sensors_health = control_sensors_present & (~MAV_SYS_STATUS_SENSOR_3D_MAG & ~MAV_SYS_STATUS_SENSOR_GPS);
if (g.compass_enabled && compass.healthy() && ahrs.use_compass()) {
if (g.compass_enabled && compass.healthy(0) && ahrs.use_compass()) {
control_sensors_health |= MAV_SYS_STATUS_SENSOR_3D_MAG;
}
if (g_gps != NULL && g_gps->status() >= GPS::GPS_OK_FIX_3D) {

Loading…
Cancel
Save