diff --git a/tests/testVisualISAM2.cpp b/tests/testVisualISAM2.cpp index cd04c4b31..1ced2af23 100644 --- a/tests/testVisualISAM2.cpp +++ b/tests/testVisualISAM2.cpp @@ -39,9 +39,8 @@ TEST(testVisualISAM2, all) auto measurementNoise = noiseModel::Isotropic::Sigma(2, 1.0); + // Create ground truth data vector points = createPoints(); - - // Create the set of ground-truth poses vector poses = createPoses(); // Set the parameters @@ -98,6 +97,9 @@ TEST(testVisualISAM2, all) // Update iSAM with the new factors isam.update(graph, initialEstimate); + // Do an extra update to converge withing these 8 iterations + isam.update(); + // Optimize Values currentEstimate = isam.calculateEstimate();