diff --git a/gtsam/base/TestableAssertions.h b/gtsam/base/TestableAssertions.h index 42001b6f4..12138d192 100644 --- a/gtsam/base/TestableAssertions.h +++ b/gtsam/base/TestableAssertions.h @@ -231,8 +231,6 @@ bool assert_container_equal(const std::vector >& expected, template bool assert_container_equal(const V& expected, const V& actual, double tol = 1e-9) { bool match = true; - if (expected.size() != actual.size()) - match = false; typename V::const_iterator itExp = expected.begin(), itAct = actual.begin(); @@ -243,6 +241,8 @@ bool assert_container_equal(const V& expected, const V& actual, double tol = 1e- break; } } + if(itExp != expected.end() || itAct != actual.end()) + match = false; } if(!match) { std::cout << "expected: " << std::endl;