fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-27 07:13:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

airspeed verify using filtered differential pressure

Browse Source
This commit is contained in:
Daniel Agar
2017-07-06 10:05:07 -04:00
parent 72969f00d7
commit 936f92fd0b
1 changed files with 7 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/airspeed_calibration.cpp
+7 -13
View File
@@ -215,18 +215,13 @@ int do_airspeed_calibration(orb_advert_t *mavlink_log_pub)
calibration_counter++; calibration_counter++;
if (fabsf(diff_pres.differential_pressure_raw_pa) < 50.0f) { if (fabsf(diff_pres.differential_pressure_filtered_pa) < 50.0f) {
if (calibration_counter % 500 == 0) { if (calibration_counter % 500 == 0) {
calibration_log_info(mavlink_log_pub, "[cal] Create air pressure! (got %d, wanted: 50 Pa)", calibration_log_info(mavlink_log_pub, "[cal] Create air pressure! (got %d, wanted: 50 Pa)", (int)diff_pres.differential_pressure_filtered_pa);
(int)diff_pres.differential_pressure_raw_pa);
} }
continue; } else if (diff_pres.differential_pressure_filtered_pa < 0.0f) {
} /* do not allow negative values */
calibration_log_info(mavlink_log_pub, "[cal] Negative pressure difference detected (%d Pa)", (int)diff_pres.differential_pressure_filtered_pa);
/* do not allow negative values */
if (diff_pres.differential_pressure_raw_pa < 0.0f) {
calibration_log_info(mavlink_log_pub, "[cal] Negative pressure difference detected (%d Pa)",
(int)diff_pres.differential_pressure_raw_pa);
calibration_log_info(mavlink_log_pub, "[cal] Swap static and dynamic ports!"); calibration_log_info(mavlink_log_pub, "[cal] Swap static and dynamic ports!");
/* the user setup is wrong, wipe the calibration to force a proper re-calibration */ /* the user setup is wrong, wipe the calibration to force a proper re-calibration */
@@ -238,14 +233,13 @@ int do_airspeed_calibration(orb_advert_t *mavlink_log_pub)
/* save */ /* save */
calibration_log_info(mavlink_log_pub, CAL_QGC_PROGRESS_MSG, 0); calibration_log_info(mavlink_log_pub, CAL_QGC_PROGRESS_MSG, 0);
(void)param_save_default(); param_save_default();
feedback_calibration_failed(mavlink_log_pub); feedback_calibration_failed(mavlink_log_pub);
goto error_return; goto error_return;
} else { } else {
calibration_log_info(mavlink_log_pub, "[cal] Positive pressure: OK (%d Pa)", calibration_log_info(mavlink_log_pub, "[cal] Positive pressure: OK (%d Pa)", (int)diff_pres.differential_pressure_filtered_pa);
(int)diff_pres.differential_pressure_raw_pa);
break; break;
} }