bugfix: platform position controller is turning into wrong direction
Changes
- Orientation PID controller with 'limitless' flag to clamp error to [-pi, pi]
- Clamping incoming angles (target orientation and current orientation) to [-pi, pi]
- Simplified implementation (removed the buggy/incorrect code)
Tests
Tested in simulation: from orientation -1.3 to 1.5
Edited by Fabian Reister