Update VectorMath.cpp