Additional Matrix3 tests, some refactoring Vector3 for readability