put TECS init bug to rest:

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:02:50 +01:00
parent dd6549e1a2
commit c1e1d0b031
2 changed files with 2 additions and 0 deletions

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;
_TAS_dem_last = _TAS_dem;
_TAS_dem_adj = _TAS_dem;
_pitch_dem_unc = pitch;
_underspeed = false;
_badDescent = false;

View File

@ -72,6 +72,7 @@ public:
_detect_underspeed_enabled(true),
_badDescent(false),
_climbOutDem(false),
_pitch_dem_unc(0.0f),
_SPE_dem(0.0f),
_SKE_dem(0.0f),
_SPEdot_dem(0.0f),