fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-31 18:11:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

put TECS init bug to rest:

Browse Source 
the uncostrained demanded pitch was never initialized which
could lead to large initial pitch integral values
This commit is contained in:
tumbili
2016-02-18 16:29:04 +01:00
parent dd6549e1a2
commit c1e1d0b031
2 changed files with 2 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/external_lgpl/tecs/tecs.cpp
+1
View File
@@ -512,6 +512,7 @@ void TECS::_initialise_states(float pitch, float throttle_cruise, float baro_alt
_hgt_dem_in_old = _hgt_dem_adj_last; _hgt_dem_in_old = _hgt_dem_adj_last;
_TAS_dem_last = _TAS_dem; _TAS_dem_last = _TAS_dem;
_TAS_dem_adj = _TAS_dem; _TAS_dem_adj = _TAS_dem;
_pitch_dem_unc = pitch;
_underspeed = false; _underspeed = false;
_badDescent = false; _badDescent = false;
src/lib/external_lgpl/tecs/tecs.h
+1
View File
@@ -72,6 +72,7 @@ public:
_detect_underspeed_enabled(true), _detect_underspeed_enabled(true),
_badDescent(false), _badDescent(false),
_climbOutDem(false), _climbOutDem(false),
_pitch_dem_unc(0.0f),
_SPE_dem(0.0f), _SPE_dem(0.0f),
_SKE_dem(0.0f), _SKE_dem(0.0f),
_SPEdot_dem(0.0f), _SPEdot_dem(0.0f),