diff --git a/gtsam/nonlinear/nonlinear.i b/gtsam/nonlinear/nonlinear.i index 3721e27e8..4d0d847c1 100644 --- a/gtsam/nonlinear/nonlinear.i +++ b/gtsam/nonlinear/nonlinear.i @@ -515,7 +515,7 @@ class ISAM2 { gtsam::KeyGroupMap& constrainedKeys, const gtsam::KeyList& noRelinKeys, const gtsam::KeyList& extraReelimKeys, - bool force_relinearize=false); + bool force_relinearize = false); gtsam::ISAM2Result update(const gtsam::NonlinearFactorGraph& newFactors, const gtsam::Values& newTheta, @@ -548,9 +548,8 @@ class ISAM2 { string dot(const gtsam::KeyFormatter& keyFormatter = gtsam::DefaultKeyFormatter) const; - void saveGraph(string s, - const gtsam::KeyFormatter& keyFormatter = - gtsam::DefaultKeyFormatter) const; + void saveGraph(string s, const gtsam::KeyFormatter& keyFormatter = + gtsam::DefaultKeyFormatter) const; }; #include diff --git a/python/gtsam/tests/test_VisualISAMExample.py b/python/gtsam/tests/test_VisualISAMExample.py index c7e72ff8b..39f563a35 100644 --- a/python/gtsam/tests/test_VisualISAMExample.py +++ b/python/gtsam/tests/test_VisualISAMExample.py @@ -63,7 +63,6 @@ class TestVisualISAMExample(GtsamTestCase): def test_isam2_error(self): """Test for isam2 error() method.""" - #TODO(Varun) fix # Initialize iSAM with the first pose and points isam, result, nextPose = visual_isam.initialize( self.data, self.truth, self.isamOptions) @@ -83,13 +82,9 @@ class TestVisualISAMExample(GtsamTestCase): except RuntimeError: v = estimate.atPoint3(key) - print(key) - print(type(v)) - print(v) values.insert(key, v) - print(isam.error(values)) - self.assertEqual(isam.error(values), 34212421.14731998) + self.assertAlmostEqual(isam.error(values), 34212421.14731998) def test_isam2_update(self): """