Merge remote-tracking branch 'jhuai-github/develop' into develop

2020-09-04 17:20:18 +08:00 · 2020-09-04 17:20:18 +08:00 · 2518b83f0f
parent 7d91540865 19d1ac42b9
commit 2518b83f0f
1 changed files with 2 additions and 2 deletions
--- a/gtsam/geometry/Pose3.cpp
+++ b/gtsam/geometry/Pose3.cpp
@ -230,8 +230,8 @@ Matrix3 Pose3::computeQforExpmapDerivative(const Vector6& xi, double nearZeroThr
  }
  else {
    Q = -0.5*V + 1./6.*(W*V + V*W - W*V*W)
-        + 1./24.*(W*W*V + V*W*W - 3*W*V*W)
-        - 0.5*(1./24. + 3./120.)*(W*V*W*W + W*W*V*W);
+        - 1./24.*(W*W*V + V*W*W - 3*W*V*W)
+        + 1./120.*(W*V*W*W + W*W*V*W);
  }
 #endif