From 27405fc1852acb1754b8d30a645c6cbf25117bc2 Mon Sep 17 00:00:00 2001
From: dellaert <dellaert@cc.gatech.edu>
Date: Thu, 28 Jan 2016 01:26:57 -0800
Subject: [PATCH] renaming variables

---
 gtsam/geometry/Pose3.cpp | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

diff --git a/gtsam/geometry/Pose3.cpp b/gtsam/geometry/Pose3.cpp
index f373e5ad4..9954240fd 100644
--- a/gtsam/geometry/Pose3.cpp
+++ b/gtsam/geometry/Pose3.cpp
@@ -120,9 +120,9 @@ Pose3 Pose3::Expmap(const Vector6& xi, OptionalJacobian<6, 6> H) {
   Rot3 R = Rot3::Expmap(omega.vector());
   double theta2 = omega.dot(omega);
   if (theta2 > std::numeric_limits<double>::epsilon()) {
-    double omega_v = omega.dot(v);          // translation parallel to axis
-    Point3 omega_cross_v = omega.cross(v);  // points towards axis
-    Point3 t = (omega_cross_v - R * omega_cross_v + omega_v * omega) / theta2;
+    Point3 t_parallel = omega * omega.dot(v); // translation parallel to axis
+    Point3 omega_cross_v = omega.cross(v);    // points towards axis
+    Point3 t = (omega_cross_v - R * omega_cross_v + t_parallel) / theta2;
     return Pose3(R, t);
   } else {
     return Pose3(R, v);