diff --git a/gtsam/linear/IterativeSolver.cpp b/gtsam/linear/IterativeSolver.cpp index c7d4e5405..c5007206d 100644 --- a/gtsam/linear/IterativeSolver.cpp +++ b/gtsam/linear/IterativeSolver.cpp @@ -115,8 +115,11 @@ void KeyInfo::initialize(const GaussianFactorGraph &fg) { size_t start = 0; for (size_t i = 0; i < n; ++i) { - const size_t key = ordering_[i]; - const size_t dim = colspec.find(key)->second; + const Key key = ordering_[i]; + const auto it_key = colspec.find(key); + if (it_key==colspec.end()) + throw std::runtime_error("KeyInfo: Inconsistency in key-dim map"); + const size_t dim = it_key->second; this->emplace(key, KeyInfoEntry(i, dim, start)); start += dim; }