Fixed typo in quaternion path
parent
04e04eed52
commit
d6581cdef9
|
@ -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<gtsam::Quaternion>::Expmap(v);
|
||||
const Rot3 R = traits<gtsam::Quaternion>::Expmap(w);
|
||||
#else
|
||||
const Rot3 R(local.expmap());
|
||||
#endif
|
||||
|
|
|
@ -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<gtsam::Quaternion>::Expmap(v);
|
||||
const Rot3 R = traits<gtsam::Quaternion>::Expmap(w);
|
||||
#else
|
||||
const Rot3 R(local.expmap());
|
||||
#endif
|
||||
|
|
Loading…
Reference in New Issue