diff --git a/slam/TransformConstraint.h b/slam/TransformConstraint.h index 101fef5e4..af341b75b 100644 --- a/slam/TransformConstraint.h +++ b/slam/TransformConstraint.h @@ -54,7 +54,8 @@ public: Point dummy; *Dlocal = -1* eye(dummy.dim()); } - return Point::Logmap(local.between(newlocal)); + return local.logmap(newlocal); +// return Point::Logmap(local.between(newlocal)); } }; } // \namespace gtsam