12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

formatting and fix

release/4.3a0
Varun Agrawal 2023-07-06 04:12:39 -04:00
parent 93ed850c6c
commit a14fb8db7d
2 changed files with 4 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
gtsam/nonlinear/nonlinear.i
View File

@ -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 <gtsam/nonlinear/NonlinearISAM.h>

7
python/gtsam/tests/test_VisualISAMExample.py
View File

@ -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):
"""