diff --git a/src/processor/processor_tracker_feature_polyline_2D.cpp b/src/processor/processor_tracker_feature_polyline_2D.cpp index 8bf1b9cb102b365b647b3fe25e97ff904079d61d..4fea24612b2c726dcbf5bf05574210f155a26201 100644 --- a/src/processor/processor_tracker_feature_polyline_2D.cpp +++ b/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