mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-16 13:30:34 +08:00
Mission: do not autocontinue if in multicopter mode and next wp has a hold time
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
@@ -1165,7 +1165,11 @@ Mission::set_mission_items()
|
||||
}
|
||||
|
||||
} else {
|
||||
if (_mission_item.autocontinue && get_time_inside(_mission_item) < FLT_EPSILON) {
|
||||
/* allow the vehicle to decelerate before reaching a wp with a hold time */
|
||||
const bool brake_for_hold = _navigator->get_vstatus()->vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING
|
||||
&& get_time_inside(_mission_item) > FLT_EPSILON;
|
||||
|
||||
if (_mission_item.autocontinue && !brake_for_hold) {
|
||||
/* try to process next mission item */
|
||||
if (has_next_position_item) {
|
||||
/* got next mission item, update setpoint triplet */
|
||||
|
||||
Reference in New Issue
Block a user