Added Wrap methods to MathUtil.

These methods are very useful in many cases. WrapAngle is too limited for these cases.