From d6581cdef98ed6acb263afca14d9ce579038ed47 Mon Sep 17 00:00:00 2001 From: Frank Dellaert Date: Wed, 15 Jan 2025 00:45:07 -0500 Subject: [PATCH] Fixed typo in quaternion path --- gtsam/geometry/Pose3.cpp | 2 +- gtsam/navigation/NavState.cpp | 2 +- 2 files changed, 2 insertions(+), 2 deletions(-) diff --git a/gtsam/geometry/Pose3.cpp b/gtsam/geometry/Pose3.cpp index 9c3bd77339..0c47e3eed6 100644 --- a/gtsam/geometry/Pose3.cpp +++ b/gtsam/geometry/Pose3.cpp @@ -189,7 +189,7 @@ Pose3 Pose3::Expmap(const Vector6& xi, OptionalJacobian<6, 6> Hxi) { // Compute rotation using Expmap #ifdef GTSAM_USE_QUATERNIONS - const Rot3 R = traits::Expmap(v); + const Rot3 R = traits::Expmap(w); #else const Rot3 R(local.expmap()); #endif diff --git a/gtsam/navigation/NavState.cpp b/gtsam/navigation/NavState.cpp index d033c96e88..d102340ce8 100644 --- a/gtsam/navigation/NavState.cpp +++ b/gtsam/navigation/NavState.cpp @@ -123,7 +123,7 @@ NavState NavState::Expmap(const Vector9& xi, OptionalJacobian<9, 9> Hxi) { // Compute rotation using Expmap #ifdef GTSAM_USE_QUATERNIONS - const Rot3 R = traits::Expmap(v); + const Rot3 R = traits::Expmap(w); #else const Rot3 R(local.expmap()); #endif