Fixed iterator checking bug in eliminateFrontals

release/4.3a0
Richard Roberts 2012-08-31 15:18:39 +00:00
parent fc1a43e585
commit 3948d70b20
1 changed files with 1 additions and 1 deletions

View File

@ -116,7 +116,7 @@ namespace gtsam {
FactorGraph<FactorType> remainingFactors;
FastSet<size_t>::const_iterator involvedFactorIsIt = involvedFactorIs.begin();
for(size_t i = 0; i < this->size(); ++i) {
if(*involvedFactorIsIt == i) {
if(involvedFactorIsIt != involvedFactorIs.end() && *involvedFactorIsIt == i) {
// If the current factor is involved, add it to involved and increment involved iterator
involvedFactors.push_back((*this)[i]);
++ involvedFactorIsIt;