From 74e82fb6151714731b8cd9d98fe08c5e57524437 Mon Sep 17 00:00:00 2001
From: Yong-Dian Jian <ydjian@gmail.com>
Date: Thu, 4 Nov 2010 14:48:17 +0000
Subject: [PATCH] bug fix

---
 gtsam/linear/GaussianFactorGraph.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/gtsam/linear/GaussianFactorGraph.cpp b/gtsam/linear/GaussianFactorGraph.cpp
index 304686b0e..f98287809 100644
--- a/gtsam/linear/GaussianFactorGraph.cpp
+++ b/gtsam/linear/GaussianFactorGraph.cpp
@@ -215,6 +215,7 @@ bool GaussianFactorGraph::getDiagonalOfHessian(VectorValues &values) const {
 		BOOST_FOREACH( const Index& idx, factor->keys_) {
 			Vector v = columnNormSquare(factor->Ab_(i)) ;
 			values[idx] += v;
+			++i ;
 		}
 	}
 	return true ;