From 53bb7584b6075cea9e04501eaf1ec0851e3709e9 Mon Sep 17 00:00:00 2001
From: Alex Cunningham <alexgcunningham@gmail.com>
Date: Thu, 31 Mar 2011 03:14:21 +0000
Subject: [PATCH] Added a print function for RangeFactor

---
 gtsam/slam/RangeFactor.h | 8 ++++++--
 1 file changed, 6 insertions(+), 2 deletions(-)

diff --git a/gtsam/slam/RangeFactor.h b/gtsam/slam/RangeFactor.h
index 5bbed45b2..1bda0b7bb 100644
--- a/gtsam/slam/RangeFactor.h
+++ b/gtsam/slam/RangeFactor.h
@@ -16,8 +16,7 @@
 
 #pragma once
 
-//#include <gtsam/geometry/Pose2.h>
-//#include <gtsam/geometry/Point2.h>
+#include <boost/lexical_cast.hpp>
 #include <gtsam/nonlinear/NonlinearFactor.h>
 
 namespace gtsam {
@@ -63,6 +62,11 @@ namespace gtsam {
 			return e != NULL && Base::equals(*e, tol) && fabs(this->z_ - e->z_) < tol;
 		}
 
+		/** print contents */
+		void print(const std::string& s="") const {
+			Base::print(s + std::string(" range: ") + boost::lexical_cast<std::string>(z_));
+		}
+
 	private:
 
 		/** Serialization function */