Matrix2x2 and Matrix2x1 implementation and tests, Matrix3x3 refactoring