From 5706481c06edba00accc8c99de339720d6677cc2 Mon Sep 17 00:00:00 2001
From: Richard Roberts <richard.jw.roberts@gmail.com>
Date: Fri, 31 Aug 2012 15:15:16 +0000
Subject: [PATCH] Fixed iterator checking bug in eliminateFrontals

---
 gtsam/inference/FactorGraph-inl.h | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/gtsam/inference/FactorGraph-inl.h b/gtsam/inference/FactorGraph-inl.h
index 6bd9c340c..97a7fa1c6 100644
--- a/gtsam/inference/FactorGraph-inl.h
+++ b/gtsam/inference/FactorGraph-inl.h
@@ -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;