FlightTaskOrbit: correct acceleration feed-forward #15320
Merged
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.
Describe problem solved by this pull request
The acceleration setpoint gets implicitly inherited from the altitude flight task since #14212. This feed-forward adds an unwanted acceleration when the right stick is deflected.
Describe your solution
Instead of the wrong acceleration setpoint I command the expected centripetal acceleration when flying in a circle as feed-forward for better orbit tracking. This is only possible since #14212.
Test data / coverage


I SITL tested and the direction and amplitude of the acceleration are exactly like expected.
It also leads to better tracking already with the default orbit radius and a bit increased speed like can be seen in the screenshots below.
Before (malicious feed-forward setpoint removed):
After (adding centripetal acceleration feed-forward):