mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-19 00:30:34 +08:00
Navigator: VTOL: fix mission yawing timeout (MIS_YAW_TMT)
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
committed by
Roman Bapst
parent
ab28f1e4f7
commit
b1d38ee050
@@ -319,7 +319,7 @@ MissionBlock::is_mission_item_reached()
|
||||
}
|
||||
}
|
||||
|
||||
if (_waypoint_position_reached) {
|
||||
if (_waypoint_position_reached && !_waypoint_position_reached_previously) {
|
||||
// reached just now
|
||||
_time_wp_reached = now;
|
||||
}
|
||||
@@ -408,6 +408,7 @@ MissionBlock::is_mission_item_reached()
|
||||
}
|
||||
|
||||
// all acceptance criteria must be met in the same iteration
|
||||
_waypoint_position_reached_previously = _waypoint_position_reached;
|
||||
_waypoint_position_reached = false;
|
||||
_waypoint_yaw_reached = false;
|
||||
return false;
|
||||
|
||||
Reference in New Issue
Block a user