diff --git a/gtsam/nonlinear/Values.cpp b/gtsam/nonlinear/Values.cpp index 002ce8c3e..4f2845a66 100644 --- a/gtsam/nonlinear/Values.cpp +++ b/gtsam/nonlinear/Values.cpp @@ -190,6 +190,7 @@ namespace gtsam { /* ************************************************************************* */ vector Values::dims(const Ordering& ordering) const { + assert(ordering.size() == this->size()); // reads off of end of array if difference in size vector result(values_.size()); BOOST_FOREACH(const ConstKeyValuePair& key_value, *this) { result[ordering[key_value.key]] = key_value.value.dim();