Skip to content
Snippets Groups Projects
Commit cc7be4b0 authored by Joan Vallvé Navarro's avatar Joan Vallvé Navarro
Browse files

small code cleaning

parent 102abd7b
No related branches found
No related tags found
No related merge requests found
...@@ -203,11 +203,8 @@ void ProcessorTrackerLandmarkApriltag::preProcess() ...@@ -203,11 +203,8 @@ void ProcessorTrackerLandmarkApriltag::preProcess()
if (!use_rotation){ if (!use_rotation){
// WOLF_INFO("Ambiguity on estimated rotation is likely"); // WOLF_INFO("Ambiguity on estimated rotation is likely");
// Put a very high covariance on angles measurements (low info matrix ?) // Put a very high covariance on angles measurements (low info matrix)
// cov.bottomRightCorner(3, 3) = 1000000*Eigen::Matrix3s::Identity(); info.bottomRightCorner(3,3) = 0.001 * Eigen::Matrix3s::Identity();
Eigen::Matrix6s new_info = 0.001*Eigen::Matrix6s::Identity();
new_info.topLeftCorner(3, 3) = info.topLeftCorner(3, 3);
info = new_info;
} }
// FOR TEST ONLY // FOR TEST ONLY
......
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