Airspeed calibration: wait on filter before preflight check

This commit is contained in:
Andreas Antener
2016-12-02 22:56:48 +01:00
committed by Lorenz Meier
parent e9737d6f7a
commit ef495d26b8
@@ -249,6 +249,7 @@ int do_airspeed_calibration(orb_advert_t *mavlink_log_pub)
feedback_calibration_failed(mavlink_log_pub);
goto error_return;
} else {
calibration_log_info(mavlink_log_pub, "[cal] Positive pressure: OK (%d Pa)",
(int)diff_pres.differential_pressure_raw_pa);
@@ -272,6 +273,10 @@ int do_airspeed_calibration(orb_advert_t *mavlink_log_pub)
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name);
tune_neutral(true);
/* Wait 2sec for the airflow to stop and ensure the driver filter has caught up, otherwise
* the followup preflight checks might fail. */
usleep(2e6);
normal_return:
calibrate_cancel_unsubscribe(cancel_sub);
px4_close(diff_pres_sub);