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
|
// Compute rotation using Expmap
|
||||||
#ifdef GTSAM_USE_QUATERNIONS
|
#ifdef GTSAM_USE_QUATERNIONS
|
||||||
const Rot3 R = traits<gtsam::Quaternion>::Expmap(v);
|
const Rot3 R = traits<gtsam::Quaternion>::Expmap(w);
|
||||||
#else
|
#else
|
||||||
const Rot3 R(local.expmap());
|
const Rot3 R(local.expmap());
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -123,7 +123,7 @@ NavState NavState::Expmap(const Vector9& xi, OptionalJacobian<9, 9> Hxi) {
|
||||||
|
|
||||||
// Compute rotation using Expmap
|
// Compute rotation using Expmap
|
||||||
#ifdef GTSAM_USE_QUATERNIONS
|
#ifdef GTSAM_USE_QUATERNIONS
|
||||||
const Rot3 R = traits<gtsam::Quaternion>::Expmap(v);
|
const Rot3 R = traits<gtsam::Quaternion>::Expmap(w);
|
||||||
#else
|
#else
|
||||||
const Rot3 R(local.expmap());
|
const Rot3 R(local.expmap());
|
||||||
#endif
|
#endif
|
||||||
|
|
Loading…
Reference in New Issue