diff --git a/test/gtest_factor_relative_pose_3d_with_extrinsics.cpp b/test/gtest_factor_relative_pose_3d_with_extrinsics.cpp index 3b57c7b8b71d69e3454fe84a4ca5ca0a5b17076a..dde07b529a3719779ce0f40b09c4a78ad8cffa9e 100644 --- a/test/gtest_factor_relative_pose_3d_with_extrinsics.cpp +++ b/test/gtest_factor_relative_pose_3d_with_extrinsics.cpp @@ -109,7 +109,7 @@ class FactorRelativePose3dWithExtrinsics_class : public testing::Test{ // F1 is be origin KF VectorComposite x0(pose_robot, "PO", {3,4}); VectorComposite s0("PO", {Vector3d(1,1,1), Vector3d(1,1,1)}); - F1 = problem->setPriorFactor(x0, s0, 0.0, 0.1); + F1 = problem->setPriorFactor(x0, s0, 0.0); // the sensor is at origin as well as the robot. The measurement matches with the pose of the tag wrt sensor (and also wrt robot and world)