diff --git a/src/processor/processor_tracker_feature_polyline_2D.cpp b/src/processor/processor_tracker_feature_polyline_2D.cpp index 0ceaa6cb15961743a7e603a2940ad8ac33824e60..7a78ca90fdc45643ef83e4c13443e4b43b59aa18 100644 --- a/src/processor/processor_tracker_feature_polyline_2D.cpp +++ b/src/processor/processor_tracker_feature_polyline_2D.cpp @@ -76,7 +76,7 @@ unsigned int ProcessorTrackerFeaturePolyline2D::trackFeatures(const FeatureBaseP // Removed match 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; } @@ -1416,10 +1416,10 @@ bool ProcessorTrackerFeaturePolyline2D::tryUpdateMatchTransformation(LandmarkMat // "\n\tUpdated pose:", // T2pose2D(lmk_match->T_feature_landmark_).transpose()); - WOLF_WARN_COND(lmk_match->computeSqDistArray().maxCoeff() > prev_sqdist.maxCoeff() + 1e-9, - "after tryUpdateMatchTransformation more error! ", - "\nprev:", prev_sqdist.transpose(), - "\nnow: ", lmk_match->computeSqDistArray().transpose()); + //WOLF_WARN_COND(lmk_match->computeSqDistArray().maxCoeff() > prev_sqdist.maxCoeff() + 1e-9, + // "after tryUpdateMatchTransformation more error! ", + // "\nprev:", prev_sqdist.transpose(), + // "\nnow: ", lmk_match->computeSqDistArray().transpose()); return true; }