From 7a59d3cfe098359a89b07c92a76a20ca1e0b46ce Mon Sep 17 00:00:00 2001
From: Kai Ni <nikai97@gmail.com>
Date: Fri, 10 Dec 2010 07:38:05 +0000
Subject: [PATCH] fixed a bug in colamdOrdering

---
 gtsam/nonlinear/NonlinearFactorGraph-inl.h | 2 ++
 1 file changed, 2 insertions(+)

diff --git a/gtsam/nonlinear/NonlinearFactorGraph-inl.h b/gtsam/nonlinear/NonlinearFactorGraph-inl.h
index 264ab9430..b27da1b15 100644
--- a/gtsam/nonlinear/NonlinearFactorGraph-inl.h
+++ b/gtsam/nonlinear/NonlinearFactorGraph-inl.h
@@ -80,6 +80,8 @@ void NonlinearFactorGraph<VALUES>::print(const std::string& str) const {
 
 	  // Compute the VariableIndex (column-wise index)
 	  VariableIndex variableIndex(*symbolic);
+	  if(config.size() != variableIndex.size())
+	  	throw std::runtime_error("orderingCOLAMD: some variables in the graph are not constrained!");
 
 	  // Compute a fill-reducing ordering with COLAMD
 	  Permutation::shared_ptr colamdPerm(Inference::PermutationCOLAMD(variableIndex));