Rover: set gyros disabled when calibrating

This commit is contained in:
Andrew Tridgell 2015-03-09 08:25:44 +11:00
parent 47e9409d00
commit d9950ea07f

View File

@ -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,