Skip to content

Conversation

@forty-eridani
Copy link
Contributor

Fixes #12 by wrapping both angles to a unit circle with the target position relative to the robot represented by angles [-π, π] which always give the shortest angular distance to the corresponding point on the unit circle. The difference is reapplied to the robot's current unbound heading in order to give an accurate set point to the PID controller.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

Angle wrap bug

2 participants