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

position_estimator_inav: surface offset estimation improved

Browse Source
This commit is contained in:
Anton Babushkin
2013-10-13 21:23:53 +02:00
parent 419cb4bc80
commit fe21bb7198
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/position_estimator_inav/position_estimator_inav_main.c
+1 -1
View File
@@ -636,7 +636,7 @@ int position_estimator_inav_thread_main(int argc, char *argv[])
/* surface distance correction */ /* surface distance correction */
if (sonar_valid) { if (sonar_valid) {
surface_offset_rate -= sonar_corr * params.w_alt_sonar * params.w_alt_sonar * dt; surface_offset_rate -= sonar_corr * 0.5f * params.w_alt_sonar * params.w_alt_sonar * dt;
surface_offset -= sonar_corr * params.w_alt_sonar * dt; surface_offset -= sonar_corr * params.w_alt_sonar * dt;
} }
} }