Added some additional Matrix4 tests
Added rotate to matrix, removed static calc variable from some classes to promote thread safety.