diff --git a/src/processor/processor_tracker_gnss.cpp b/src/processor/processor_tracker_gnss.cpp index 1682d65de64ed88c72d5e18419a94a29e3244431..81fc43a2c953474cc951dcab7d771d6716ee35d9 100644 --- a/src/processor/processor_tracker_gnss.cpp +++ b/src/processor/processor_tracker_gnss.cpp @@ -207,7 +207,8 @@ unsigned int ProcessorTrackerGnss::trackFeatures(const FeatureBasePtrList& _feat if (_features_in.empty()) return 0; - //WOLF_DEBUG("tracking " , _features_in.size() , " features..."); + WOLF_DEBUG_COND(_features_out.begin() == new_features_incoming_.begin(), "ProcessorTrackerGnss::trackFeatures tracking " , _features_in.size() , " new features..."); + WOLF_DEBUG_COND(_features_out.begin() == known_features_incoming_.begin(), "ProcessorTrackerGnss::trackFeatures tracking " , _features_in.size() , " known features..."); assert(_capture == incoming_ptr_); @@ -241,10 +242,16 @@ unsigned int ProcessorTrackerGnss::trackFeatures(const FeatureBasePtrList& _feat WOLF_DEBUG_COND(untracked_incoming_features_.count(sat_num) == 1, "\tnot tracked, wrong carrier phase value" ); } } - WOLF_WARN_COND(_features_out.empty() and not _features_in.empty(), + WOLF_WARN_COND(_features_out.empty() and + _features_out.begin() == known_features_incoming_.begin(), "ProcessorTrackerGnss::trackFeatures: LOST TRACK OF ALL SATELLITES of ", _features_in.size(), - " - ", common_sats, " wrong Carrier Phase info."); - WOLF_DEBUG("ProcessorTrackerGnss::trackFeatures: tracked " , _features_out.size(), " (of ", _features_in.size(), ")"); + " - ", common_sats, " due to wrong Carrier Phase data."); + WOLF_DEBUG_COND(_features_out.begin() == new_features_incoming_.begin(), + "ProcessorTrackerGnss::trackFeatures: tracked " , + _features_out.size(), " new features (of ", _features_in.size(), ")"); + WOLF_DEBUG_COND(_features_out.begin() == known_features_incoming_.begin(), + "ProcessorTrackerGnss::trackFeatures: tracked " , + _features_out.size(), " known features (of ", _features_in.size(), ")"); return _features_out.size(); }