From 44669449b182a57c6b7ba380cab864c488568782 Mon Sep 17 00:00:00 2001
From: joanvallve <jvallve@iri.upc.edu>
Date: Mon, 29 Jul 2019 10:13:22 +0200
Subject: [PATCH] debugging printing
---
.../processor_tracker_feature_polyline_2D.cpp | 10 +++++-----
1 file changed, 5 insertions(+), 5 deletions(-)
diff --git a/src/processor/processor_tracker_feature_polyline_2D.cpp b/src/processor/processor_tracker_feature_polyline_2D.cpp
index 0ceaa6cb1..7a78ca90f 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;
}
--
GitLab