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

VTOL: don't wait on TECS in FW state if TECS is not running

Browse Source
This commit is contained in:
Andreas Antener
2016-07-25 08:56:19 +02:00
parent 254358ef86
commit f069880504
1 changed files with 4 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/vtol_att_control/vtol_type.cpp
+4 -2
View File
@@ -173,8 +173,10 @@ void VtolType::update_fw_state()
_tecs_running_ts = hrt_absolute_time();
}
// tecs didn't publish yet or the position controller didn't publish yet AFTER tecs
if (!_tecs_running || (_tecs_running && _fw_virtual_att_sp->timestamp <= _tecs_running_ts)) {
// TECS didn't publish yet or the position controller didn't publish yet AFTER tecs
// only wait on TECS we're in a mode where it is actually running
if ((!_tecs_running || (_tecs_running && _fw_virtual_att_sp->timestamp <= _tecs_running_ts))
&& _v_control_mode->flag_control_altitude_enabled) {
waiting_on_tecs();
}