Update MathUtil.h