MPC: LAND: adapt land logic to consider emergency braking, and vehicle velocity #23627
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.
Solved Problem
The #23546 did not consider the case when we trigger land from Altitude or Manual FlightTask, where the comanded velocity can greatly exceed the velocity possible in FlightTaskAuto.
For such cases FlightTaskAuto has the emergency braking feature.
This PR moves the landing setpoint logic from navigator back to FlightTaskAuto, and is able to adjust the setpoint depending on if EmergencyBraking is active or not.
When ... I found that ...
Downsides
While emergency braking, im forcing the Position of
_position_smoothing
to be the current vehicle position, meaning we are unable to compensate wind. is probably a conercase as wind compensation while emergency braking is not the most important aspect. and emergency braking only triggers above 15 m/s (54 km/h) with default settings.Changelog Entry
Alternatives
We could also create FlightTaskLand, to take all landing related tasks out of FlightTaskAuto
Test coverage
Context