diff --git a/test/gtest_factor_diff_drive.cpp b/test/gtest_factor_diff_drive.cpp index 39f0af8be47f69bb928cc06e3e0318b1759f2435..5462c704ec1fad2feef817b538fbf2f21a9ebea9 100644 --- a/test/gtest_factor_diff_drive.cpp +++ b/test/gtest_factor_diff_drive.cpp @@ -444,7 +444,7 @@ TEST(FactorDiffDrive, preintegrate_and_solve_sensor_intrinsics_gt) Vector3d x1(1.5, -1.5, -M_PI/2.0); Vector3d x2(3.0, -3.0, 0.0); // Matrix3d P0; P0.setIdentity(); - VectorComposite s0(Vector3d(0,0,0), "PO", {2,1}); + VectorComposite s0(Vector3d(0.1,0.1,0.1), "PO", {2,1}); // set prior at t=0 and processor origin auto F0 = problem->setPriorFactor(x0, s0, t, 0.1);