Fixed the RTL return path error for multi-axis models when RTL_TYPE is 1 #25750
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Issue Description
Problem Summary
In multi-axis vehicles with
RTL_TYPE
set to 1 (mission land on RTL), the RTL behavior during mid-mission return incorrectly prioritizes landing at themission_land
waypoint, even if the home position is closer. This results in the vehicle flying directly tomission_land
for landing, potentially leading to inefficient or unsafe paths.Question
Since I am a beginner, I don't know if this is the original design. If so, I'm sorry to bother you.
Expected Behavior
The RTL logic should evaluate the distance to both the home position and
mission_land
, then select the closer one for landing—similar to thegz_standard_vto
model in Gazebo simulation. Fixed-wing models should continue to land atmission_land
as per current design.Reproduction Steps
RTL_TYPE
to 1.mission_land
waypoint farther from home.mission_land
regardless of proximity to home.Testing
gz_standard_vto
and 'gz_x500'Screenshot