Update MatrixMath.h