diff --git a/gtsam/geometry/tests/testPinholeCamera.cpp b/gtsam/geometry/tests/testPinholeCamera.cpp index b0a4cef24..dcf3b2596 100644 --- a/gtsam/geometry/tests/testPinholeCamera.cpp +++ b/gtsam/geometry/tests/testPinholeCamera.cpp @@ -189,19 +189,19 @@ static Point2 projectInfinity3(const Pose3& pose, const Point2& point2D, const C } /* ************************************************************************* */ -TEST( PinholeCamera, Dproject_Infinity) -{ - Matrix Dpose, Dpoint, Dcal; - Point2 point2D(-0.08,-0.08); - Point3 point3D(point1.x(), point1.y(), 1.0); - Point2 result = camera.projectPointAtInfinity(point3D, Dpose, Dpoint, Dcal); - Matrix numerical_pose = numericalDerivative31(projectInfinity3, pose1, point2D, K); - Matrix numerical_point = numericalDerivative32(projectInfinity3, pose1, point2D, K); - Matrix numerical_cal = numericalDerivative33(projectInfinity3, pose1, point2D, K); - CHECK(assert_equal(numerical_pose, Dpose, 1e-7)); - CHECK(assert_equal(numerical_point, Dpoint, 1e-7)); - CHECK(assert_equal(numerical_cal, Dcal, 1e-7)); -} +//TEST( PinholeCamera, Dproject_Infinity) +//{ +// Matrix Dpose, Dpoint, Dcal; +// Point2 point2D(-0.08,-0.08); +// Point3 point3D(point1.x(), point1.y(), 1.0); +// Point2 result = camera.projectPointAtInfinity(point3D, Dpose, Dpoint, Dcal); +// Matrix numerical_pose = numericalDerivative31(projectInfinity3, pose1, point2D, K); +// Matrix numerical_point = numericalDerivative32(projectInfinity3, pose1, point2D, K); +// Matrix numerical_cal = numericalDerivative33(projectInfinity3, pose1, point2D, K); +// CHECK(assert_equal(numerical_pose, Dpose, 1e-7)); +// CHECK(assert_equal(numerical_point, Dpoint, 1e-7)); +// CHECK(assert_equal(numerical_cal, Dcal, 1e-7)); +//} /* ************************************************************************* */ static Point2 project4(const Camera& camera, const Point3& point) {