From 7f8796c22383b082c1c296ee5f10eae7716f3872 Mon Sep 17 00:00:00 2001 From: Varun Agrawal Date: Thu, 6 Feb 2025 16:58:49 -0500 Subject: [PATCH] fix initialization --- examples/ISAM2_City10000.cpp | 17 +++++++++-------- 1 file changed, 9 insertions(+), 8 deletions(-) diff --git a/examples/ISAM2_City10000.cpp b/examples/ISAM2_City10000.cpp index 3382e313b..1764a336a 100644 --- a/examples/ISAM2_City10000.cpp +++ b/examples/ISAM2_City10000.cpp @@ -53,19 +53,20 @@ class Experiment { const bool isWithAmbiguity = false; private: - ISAM2Params parameters; - parameters.optimizationParams = gtsam::ISAM2GaussNewtonParams(0.0); - parameters.relinearizeThreshold = 0.01; - parameters.relinearizeSkip = 1; - - ISAM2 isam2_(parameters); + ISAM2 isam2_; NonlinearFactorGraph graph_; Values initial_; Values results; public: /// Construct with filename of experiment to run - explicit Experiment(const std::string& filename) : dataset_(filename) {} + explicit Experiment(const std::string& filename) : dataset_(filename) { + ISAM2Params parameters; + parameters.optimizationParams = gtsam::ISAM2GaussNewtonParams(0.0); + parameters.relinearizeThreshold = 0.01; + parameters.relinearizeSkip = 1; + isam2_ = ISAM2(parameters); + } /// @brief Run the main experiment with a given maxLoopCount. void run() { @@ -118,7 +119,7 @@ class Experiment { int id = index % numMeasurements; if (isWithAmbiguity && id % 2 == 0) { graph_.add(BetweenFactor(X(keyS), X(keyT), odomPose, - kPoseNoiseModel)); + kPoseNoiseModel)); } else { graph_.add(BetweenFactor( X(keyS), X(keyT), odomPose,