Fixed iterator checking bug in eliminateFrontals

release/4.3a0
Richard Roberts 2012-08-31 15:15:16 +00:00
parent a16f91d403
commit 5706481c06
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;