dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

TECS initialize throttle integrator at cruise if in air

This commit is contained in:
Daniel Agar 2017-12-21 16:09:53 -05:00
parent e3da71c89d
commit 8320c8ba14
No known key found for this signature in database
GPG Key ID: FD3CBA98017A69DE
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
tecs/tecs.cpp
View File

@ -531,7 +531,7 @@ void TECS::_initialize_states(float pitch, float throttle_cruise, float baro_alt
_vert_pos_state = baro_altitude;
_tas_rate_state = 0.0f;
_tas_state = _EAS * EAS2TAS;
_throttle_integ_state = 0.0f;
_throttle_integ_state = (_in_air ? throttle_cruise : 0.0f);
_pitch_integ_state = 0.0f;
_last_throttle_setpoint = throttle_cruise;
_last_pitch_setpoint = constrain(pitch, _pitch_setpoint_min, _pitch_setpoint_max);