diff --git a/tests/testNonlinearISAM.cpp b/tests/testNonlinearISAM.cpp index 34e0f29d1..51aa21773 100644 --- a/tests/testNonlinearISAM.cpp +++ b/tests/testNonlinearISAM.cpp @@ -212,11 +212,11 @@ TEST(testNonlinearISAM, markov_chain_with_reconnect ) { // verify values - all but the last one should be very close Values actualChol = isamChol.estimate(); for (size_t i=0; i(i), actualChol.at(i), tol)); + EXPECT(assert_equal(expected.at(i), actualChol.at(i), 1e-4)); Values actualQR = isamQR.estimate(); for (size_t i=0; i(i), actualQR.at(i), tol)); + EXPECT(assert_equal(expected.at(i), actualQR.at(i), 1e-4)); // Check landmarks EXPECT(assert_equal(expected.at(lm1), actualChol.at(lm1), tol));