From ad8b87c3c2464f979f651c3a007083174a79f4fe Mon Sep 17 00:00:00 2001
From: Chris Beall <chrisbeall@gmail.com>
Date: Thu, 17 Mar 2011 04:34:08 +0000
Subject: [PATCH] added between on StereoCamera

---
 gtsam/geometry/StereoCamera.h | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/gtsam/geometry/StereoCamera.h b/gtsam/geometry/StereoCamera.h
index 84ce0cfb5..cdd62a675 100644
--- a/gtsam/geometry/StereoCamera.h
+++ b/gtsam/geometry/StereoCamera.h
@@ -100,6 +100,12 @@ namespace gtsam {
 					camera.K_, tol);
 		}
 
+		Pose3 between(const StereoCamera &camera,
+		    		boost::optional<Matrix&> H1=boost::none,
+		    		boost::optional<Matrix&> H2=boost::none) const {
+			return leftCamPose_.between(camera.pose(), H1, H2);
+		}
+
 		void print(const std::string& s = "") const {
 			leftCamPose_.print(s + ".camera.");
 			K_.print(s + ".calibration.");