couts

src/processor/processor_tracker_feature_polyline_2D.cpp

@@ -437,7 +437,7 @@ unsigned int ProcessorTrackerFeaturePolyline2D::detectNewFeatures(const int& _ma
 
 void ProcessorTrackerFeaturePolyline2D::establishFactors()
 {
-    // WOLF_DEBUG("PTFP ", getName(), "::establishFactors: ");
+    WOLF_DEBUG("PTFP ", getName(), "::establishFactors: ");
     unsigned int N_factors = 0;
 
     // Create a factor for each match in last features
@@ -456,11 +456,11 @@ void ProcessorTrackerFeaturePolyline2D::establishFactors()
         // WOLF_DEBUG("\tLandmark changed?");
         if (lmk_match->isDeprecated())
         {
-            // WOLF_DEBUG("\tLandmark changed or was merged");
+            WOLF_DEBUG("\tLandmark changed or was merged, trying to update...");
             // not successful update
             if (!updateLandmarkMatch(lmk_match))
             {
-                // std::cout << "\t\tNot success: removing feature " << pl_ftr->id() << " and landmark match\n";
+                WOLF_DEBUG("\tUpdate didn't succeess, removing feature...");
                 // remove from match map
                 landmark_match_map_.erase(ftr);
                 // remove feature
@@ -475,7 +475,7 @@ void ProcessorTrackerFeaturePolyline2D::establishFactors()
             // WOLF_DEBUG("\tLandmark removed?");
             if (pl_lmk->isRemoving())
             {
-                // std::cout << "\t\tLandmark was removed: removing feature " << pl_ftr->id() << " and landmark match\n";
+                WOLF_DEBUG("\tLandmark was removed, removing feature...");
                 // remove from match map
                 landmark_match_map_.erase(ftr);
                 // remove feature