Support for minimising the steering angle difference between previous and next angle #1
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.
This enhancement makes the controller behave optimally when selecting steering angles on continuous joint steering based robots.
To find the optimal angle to select we find the minimum angle difference between the previous angle position issued and either the calculated steering joint angle or it's polar opposite angle. When chosing the lesser difference we can gaurantee that the joint never moves more than π/2 radians per turn as opposed to the π radians per turn maxium in the current repo state.
More information on this can be found in this comment . I wasn't sure how we could make simple tests for this enhancement, we'd have to add another monitor to the test code that checks the joint_states prior and post command.
Let me know if you wan't any other work done, you can then merge my work into your existing ros-control pull request. We could also wait until your original code has passed but PR's take a very long time to get checked over so I thought it might be fast this way.
Cheers!