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.
Description
Make functions synonymous with the
https://github.com/PX4/PX4-Autopilot/blob/37fa4bccb638410734e077ef18c3c9c0ecd117c4/src/lib/motion_planning/VelocitySmoothing.hpp
Main Changes
update
function, which was only constraining velocity setpointQuestions
It seems like this PR broke the internal state 'X' integration (it flattens out even when velocity setpoint is 0 🤔). Can't figure out now why this change has been introduced. Ideas? @bresch


Before the Change
After the Change (this PR)
Does it make sense to call the "updateDurations" every loop? Even in the upstream implementation, since it ALWAYS resets the internally tracked time