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