Matrix4x4 implementation
Add test framework and matrix4x4 tests.