diff --git a/src/xrt/tracking/hand/mercury/kine_lm/lm_main.cpp b/src/xrt/tracking/hand/mercury/kine_lm/lm_main.cpp index 1e8c55520..9835e138d 100644 --- a/src/xrt/tracking/hand/mercury/kine_lm/lm_main.cpp +++ b/src/xrt/tracking/hand/mercury/kine_lm/lm_main.cpp @@ -564,7 +564,8 @@ CostFunctor::operator()(const T *const x, T *residual) const return true; } - +// look at tests_quat_change_of_basis +#if 0 template static inline void zldtt_ori_right(Quat &orientation, xrt_quat *out) @@ -591,6 +592,17 @@ zldtt_ori_right(Quat &orientation, xrt_quat *out) math_quat_from_plus_x_z(&x, &z, out); } +#else +template +static inline void +zldtt_ori_right(Quat &orientation, xrt_quat *out) +{ + out->x = -orientation.x; + out->y = orientation.y; + out->z = orientation.z; + out->w = -orientation.w; +} +#endif template static inline void