Update MathUtils.hpp