Update matrixmath.cpp