diff --git a/src/constraints/constraint_autodiff_apriltag.h b/src/constraints/constraint_autodiff_apriltag.h index 6cfb83f2f421e048d1b485df0ca0fee3b979dea7..f122cbaa4158fd1684abbcc2ba3edf12112ea46a 100644 --- a/src/constraints/constraint_autodiff_apriltag.h +++ b/src/constraints/constraint_autodiff_apriltag.h @@ -117,9 +117,9 @@ template<typename T> bool ConstraintAutodiffApriltag::operator ()( const T* cons Eigen::Transform<T, 3, Eigen::Affine> c_M_l_est = (w_M_r * r_M_c).inverse() * w_M_l; // expectation error, in camera frame - // left-minus + // right-minus Eigen::Transform<T, 3, Eigen::Affine> c_M_err = c_M_l_meas.inverse() * c_M_l_est; - // right-minus also works + // opposite of the previous formula and therefore equivalent // Eigen::Transform<T, 3, Eigen::Affine> c_M_err = c_M_l_est.inverse() * c_M_l_meas;