Added first unit tests for Vector and Mat4