diff --git a/gtsam/slam/visualSLAM.cpp b/gtsam/slam/visualSLAM.cpp index 1998f1691..5b04b92c6 100644 --- a/gtsam/slam/visualSLAM.cpp +++ b/gtsam/slam/visualSLAM.cpp @@ -108,7 +108,7 @@ namespace visualSLAM { BOOST_FOREACH(const sharedFactor& f, *this) { boost::shared_ptr p = boost::dynamic_pointer_cast(f); - if (p) errors.col(k) = p->unwhitenedError(values); + if (p) errors.col(k++) = p->unwhitenedError(values); } return errors; }