Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 00:28:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_TECS: no underspeed when in VTOL

Browse Source
This commit is contained in:
Andrew Tridgell 2016-01-01 17:36:29 +11:00
parent 4f70ca22c1
commit b3bd83b1c6
1 changed files with 3 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_TECS/AP_TECS.cpp
View File

@ -454,7 +454,9 @@ void AP_TECS::_update_height_demand(void)
void AP_TECS::_detect_underspeed(void)
{
if (((_integ5_state < _TASmin * 0.9f) &&
if (_flight_stage == AP_TECS::FLIGHT_VTOL) {
_underspeed = false;
} else if (((_integ5_state < _TASmin * 0.9f) &&
(_throttle_dem >= _THRmaxf * 0.95f) &&
_flight_stage != AP_TECS::FLIGHT_LAND_FINAL) ||
((_height < _hgt_dem_adj) && _underspeed))