Removed code section mapping [-pi/2, pi/2] -> [-pi,pi] when I wasn't using atan2, atan2 handles this automatically.