mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 11:13:34 +08:00
Play safe with calibration done messages
This commit is contained in:
@@ -216,14 +216,17 @@ int do_mag_calibration(orb_advert_t *mavlink_log_pub)
|
|||||||
calibration_log_info(mavlink_log_pub, CAL_QGC_PROGRESS_MSG, 100);
|
calibration_log_info(mavlink_log_pub, CAL_QGC_PROGRESS_MSG, 100);
|
||||||
usleep(20000);
|
usleep(20000);
|
||||||
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name);
|
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name);
|
||||||
|
usleep(20000);
|
||||||
break;
|
break;
|
||||||
} else {
|
} else {
|
||||||
calibration_log_critical(mavlink_log_pub, CAL_ERROR_SAVE_PARAMS_MSG);
|
calibration_log_critical(mavlink_log_pub, CAL_ERROR_SAVE_PARAMS_MSG);
|
||||||
|
usleep(20000);
|
||||||
}
|
}
|
||||||
// Fall through
|
// Fall through
|
||||||
|
|
||||||
default:
|
default:
|
||||||
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name);
|
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name);
|
||||||
|
usleep(20000);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user