diff --git a/cpp/LieConfig-inl.h b/cpp/LieConfig-inl.h index d4e19ed8f..62417d06a 100644 --- a/cpp/LieConfig-inl.h +++ b/cpp/LieConfig-inl.h @@ -40,7 +40,7 @@ namespace gtsam { bool LieConfig::equals(const LieConfig& expected, double tol) const { if (values_.size() != expected.values_.size()) return false; BOOST_FOREACH(const typename Values::value_type& v, values_) { - if (!exists(v.first)) return false; + if (!expected.exists(v.first)) return false; if(!gtsam::equal(v.second, expected[v.first], tol)) return false; }