public static float WrapAngle(float angle) { angle = (float)System.Math.IEEERemainder(angle, TwoPi); if (angle < -Pi) { angle += TwoPi; return angle; } if (angle >= Pi) { angle -= TwoPi; } return angle; }