From 275fe8ee2dfadb69f0214cc12372fca5ffaecc53 Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Sat, 9 Apr 2016 11:50:50 -0700 Subject: [PATCH] Play safe with calibration done messages --- src/modules/commander/mag_calibration.cpp | 3 +++ 1 file changed, 3 insertions(+) diff --git a/src/modules/commander/mag_calibration.cpp b/src/modules/commander/mag_calibration.cpp index d3db555625..3fc69b237e 100644 --- a/src/modules/commander/mag_calibration.cpp +++ b/src/modules/commander/mag_calibration.cpp @@ -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); usleep(20000); calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name); + usleep(20000); break; } else { calibration_log_critical(mavlink_log_pub, CAL_ERROR_SAVE_PARAMS_MSG); + usleep(20000); } // Fall through default: calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name); + usleep(20000); break; } }