Regular multiplication now working properly, added matrix subtraction function and some refactoring.