From 13866400fa82947b67375eef79766639385571bc Mon Sep 17 00:00:00 2001 From: Julian Oes Date: Tue, 22 Mar 2016 19:58:44 +0100 Subject: [PATCH] commander: workaround to get calibration status If mavlink_log calls follow close after each other a later one will replace the previous one. Therefore do a quick usleep to get the calibration status out the door. --- src/modules/commander/calibration_routines.cpp | 2 ++ 1 file changed, 2 insertions(+) diff --git a/src/modules/commander/calibration_routines.cpp b/src/modules/commander/calibration_routines.cpp index a03688d42d..f025fbc4e2 100644 --- a/src/modules/commander/calibration_routines.cpp +++ b/src/modules/commander/calibration_routines.cpp @@ -476,6 +476,8 @@ calibrate_return calibrate_from_orientation(orb_advert_t *mavlink_log_pub, } mavlink_and_console_log_info(mavlink_log_pub, CAL_QGC_ORIENTATION_DETECTED_MSG, detect_orientation_str(orient)); + // TODO FIXME: sleep here, so that QGC receives this with higher chance. + usleep(1000); orientation_failures = 0; // Call worker routine