Added some functionality to matrix 3, conversion between matrix3 and matrix4