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.
Hi!
I was working on a project involving incremental tracking and I noticed that a continuous-revolute joint on the robot would suddenly flip almost 360 degrees (thankfully was doing this in sim) to get to an angle just a tad bit CW or CCW of the current position. Thanks to a pointer from Andy Zelenak, it looked like the angle-wrapping code would wrap around even continuous joint angles leading to these jumpy motions that I was seeing. This PR creates a fix for it that I've verified to be working on my project.