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

debugging printing

parent cf86c823
No related branches found
No related tags found
No related merge requests found
...@@ -76,7 +76,7 @@ unsigned int ProcessorTrackerFeaturePolyline2D::trackFeatures(const FeatureBaseP ...@@ -76,7 +76,7 @@ unsigned int ProcessorTrackerFeaturePolyline2D::trackFeatures(const FeatureBaseP
// Removed match // Removed match
if(landmark_match_map_.count(pl_last) == 0) if(landmark_match_map_.count(pl_last) == 0)
{ {
std::cout << "\t\tremoved feature last\n"; WOLF_WARN("Match last-landmark was removed, discarding tracking with incoming");
continue; continue;
} }
...@@ -1416,10 +1416,10 @@ bool ProcessorTrackerFeaturePolyline2D::tryUpdateMatchTransformation(LandmarkMat ...@@ -1416,10 +1416,10 @@ bool ProcessorTrackerFeaturePolyline2D::tryUpdateMatchTransformation(LandmarkMat
// "\n\tUpdated pose:", // "\n\tUpdated pose:",
// T2pose2D(lmk_match->T_feature_landmark_).transpose()); // T2pose2D(lmk_match->T_feature_landmark_).transpose());
WOLF_WARN_COND(lmk_match->computeSqDistArray().maxCoeff() > prev_sqdist.maxCoeff() + 1e-9, //WOLF_WARN_COND(lmk_match->computeSqDistArray().maxCoeff() > prev_sqdist.maxCoeff() + 1e-9,
"after tryUpdateMatchTransformation more error! ", // "after tryUpdateMatchTransformation more error! ",
"\nprev:", prev_sqdist.transpose(), // "\nprev:", prev_sqdist.transpose(),
"\nnow: ", lmk_match->computeSqDistArray().transpose()); // "\nnow: ", lmk_match->computeSqDistArray().transpose());
return true; return true;
} }
......
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