From cc858224aacba633c7d1ba2a6e17aa7675d3913c Mon Sep 17 00:00:00 2001 From: Alex Cunningham Date: Sat, 26 Nov 2011 22:28:45 +0000 Subject: [PATCH] Comments only - broken parts in Pose3 correct expmap --- gtsam/geometry/Pose3.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/gtsam/geometry/Pose3.cpp b/gtsam/geometry/Pose3.cpp index a7e687af1..fa6f02828 100644 --- a/gtsam/geometry/Pose3.cpp +++ b/gtsam/geometry/Pose3.cpp @@ -188,7 +188,7 @@ namespace gtsam { boost::optional H1, boost::optional H2) const { if (H1) { #ifdef CORRECT_POSE3_EXMAP - *H1 = AdjointMap(inverse(p2)); + *H1 = AdjointMap(inverse(p2)); // FIXME: this function doesn't exist with this interface #else const Rot3& R2 = p2.rotation(); const Point3& t2 = p2.translation(); @@ -216,7 +216,7 @@ namespace gtsam { Pose3 Pose3::inverse(boost::optional H1) const { if (H1) #ifdef CORRECT_POSE3_EXMAP - { *H1 = - AdjointMap(p); } + { *H1 = - AdjointMap(p); } // FIXME: this function doesn't exist with this interface - should this be "*H1 = -AdjointMap();" ? #else { Matrix Rt = R_.transpose();