Fix normalizeAngle and wrapAngle (again?)
Merge pull request #218 from TheJare/dev

Fix normalizeAngle and wrapAngle (again?)