Static Vector3D methods added
Added tests for matrix generation