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

TECS: fast descend only available if airspeed is available.

This commit is contained in:
Konrad 2024-01-12 11:50:17 +01:00
parent 29145ed941
commit 042257c33f
2 changed files with 3 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
src/lib/tecs/TECS.cpp
View File

@ -773,7 +773,8 @@ bool TECS::_checkFastDescend(const float alt_setpoint, const float alt)
{
bool ret_val{false};
if ((_fast_descend_alt_err > FLT_EPSILON) && ((alt_setpoint + _fast_descend_alt_err) < alt)) {
if (_control_flag.airspeed_enabled && (_fast_descend_alt_err > FLT_EPSILON)
&& ((alt_setpoint + _fast_descend_alt_err) < alt)) {
ret_val = true;
}

1
src/lib/tecs/TECS.hpp
View File

@ -729,6 +729,7 @@ private:
TECSControl::Flag _control_flag{
.airspeed_enabled = false,
.detect_underspeed_enabled = false,
.fast_descend = false
};
/**