Browse Source

Rover: set gyros disabled when calibrating

master
Andrew Tridgell 10 years ago
parent
commit
d9950ea07f
  1. 6
      APMrover2/GCS_Mavlink.pde

6
APMrover2/GCS_Mavlink.pde

@ -182,6 +182,12 @@ static NOINLINE void send_extended_status1(mavlink_channel_t chan) @@ -182,6 +182,12 @@ static NOINLINE void send_extended_status1(mavlink_channel_t chan)
battery_current = battery.current_amps() * 100;
}
if (AP_Notify::flags.initialising) {
// while initialising the gyros and accels are not enabled
control_sensors_enabled &= ~(MAV_SYS_STATUS_SENSOR_3D_GYRO | MAV_SYS_STATUS_SENSOR_3D_ACCEL);
control_sensors_health &= ~(MAV_SYS_STATUS_SENSOR_3D_GYRO | MAV_SYS_STATUS_SENSOR_3D_ACCEL);
}
mavlink_msg_sys_status_send(
chan,
control_sensors_present,

Loading…
Cancel
Save