Skip to content
Snippets Groups Projects
Commit 285af44b authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

Merge branch 'Apriltag' of ssh://gitlab.iri.upc.edu:2202/mobile_robotics/wolf into Apriltag

parents dcd272f3 c14f214a
No related branches found
No related tags found
1 merge request!233WIP: Apriltag
Pipeline #2444 passed
...@@ -117,9 +117,9 @@ template<typename T> bool ConstraintAutodiffApriltag::operator ()( const T* cons ...@@ -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; 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 // 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; 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; // Eigen::Transform<T, 3, Eigen::Affine> c_M_err = c_M_l_est.inverse() * c_M_l_meas;
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment