Added some unit-testing, and worked on frustum culling
More Matrix4 tests