From 472c51b9b1c9a26438373365dc0597dcde531b18 Mon Sep 17 00:00:00 2001
From: Richard Roberts <richard.jw.roberts@gmail.com>
Date: Thu, 1 Sep 2011 21:49:08 +0000
Subject: [PATCH] Finding maximum frontal variables instead of assuming sorted

---
 gtsam/inference/BayesTree-inl.h | 3 ++-
 1 file changed, 2 insertions(+), 1 deletion(-)

diff --git a/gtsam/inference/BayesTree-inl.h b/gtsam/inference/BayesTree-inl.h
index adc3d5d8a..be7ad1a1f 100644
--- a/gtsam/inference/BayesTree-inl.h
+++ b/gtsam/inference/BayesTree-inl.h
@@ -641,7 +641,8 @@ namespace gtsam {
 	    }
 
 	    // Now fill in the nodes index
-	    if(nodes_.size() == 0 || (subtree->conditional()->lastFrontalKey()) > (nodes_.size() - 1)) {
+	    if(nodes_.size() == 0 ||
+	        *std::max_element(subtree->conditional()->beginFrontals(), subtree->conditional()->endFrontals()) > (nodes_.size() - 1)) {
 	      nodes_.resize(subtree->conditional()->lastFrontalKey() + 1);
 	    }
 	    fillNodesIndex(subtree);