Added more Matrix4x4 functionality & tests.