Added untested functionality to matrixmath.java