Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-01 02:55:07 +08:00
Code Issues Actions 19 Packages Projects Releases Wiki Activity

commander: calibration restore sleep after CAL_QGC_DONE_MSG/CAL_QGC_FAILED_MSG

Browse Source
This commit is contained in:
Daniel Agar
2020-10-19 22:16:55 -04:00
parent 171bd6d784
commit 69986affbf
3 changed files with 7 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/accelerometer_calibration.cpp
+2
View File
@@ -442,11 +442,13 @@ int do_accel_calibration(orb_advert_t *mavlink_log_pub)
if (!failed) { if (!failed) {
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name); calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name);
px4_usleep(600000); // give this message enough time to propagate
return PX4_OK; return PX4_OK;
} }
} }
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name); calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name);
px4_usleep(600000); // give this message enough time to propagate
return PX4_ERROR; return PX4_ERROR;
} }
src/modules/commander/gyro_calibration.cpp
+3
View File
@@ -338,10 +338,13 @@ int do_gyro_calibration(orb_advert_t *mavlink_log_pub)
if (!failed) { if (!failed) {
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name); calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name);
px4_usleep(600000); // give this message enough time to propagate
return PX4_OK; return PX4_OK;
} }
} }
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name); calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name);
px4_usleep(600000); // give this message enough time to propagate
return PX4_ERROR; return PX4_ERROR;
} }
src/modules/commander/level_calibration.cpp
+2
View File
@@ -175,10 +175,12 @@ out:
if (success) { if (success) {
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, "level"); calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, "level");
px4_usleep(600000); // give this message enough time to propagate
return 0; return 0;
} else { } else {
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, "level"); calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, "level");
px4_usleep(600000); // give this message enough time to propagate
return 1; return 1;
} }
} }