Update MatrixMath.cpp