diff --git a/gtsam_unstable/nonlinear/tests/testConcurrentIncrementalFilter.cpp b/gtsam_unstable/nonlinear/tests/testConcurrentIncrementalFilter.cpp index 143c79d83..eeb6a8563 100644 --- a/gtsam_unstable/nonlinear/tests/testConcurrentIncrementalFilter.cpp +++ b/gtsam_unstable/nonlinear/tests/testConcurrentIncrementalFilter.cpp @@ -31,9 +31,6 @@ #include #include -#include -tbb::task_scheduler_init init(1); - using namespace std; using namespace gtsam; @@ -514,7 +511,7 @@ TEST( ConcurrentIncrementalFilter, update_and_marginalize_2 ) partialGraph.push_back(BetweenFactor(1, 2, poseOdometry, noiseOdometery)); partialGraph.push_back(BetweenFactor(2, 3, poseOdometry, noiseOdometery)); - GaussianFactorGraph linearGraph = *partialGraph.linearize(newValues); + GaussianFactorGraph linearGraph = *partialGraph.linearize(optimalValues); GaussianFactorGraph marginal = *linearGraph.eliminatePartialMultifrontal(vector(keysToMove.begin(), keysToMove.end()), EliminateCholesky).second;