diff --git a/src/processor_tracker_feature_dummy.cpp b/src/processor_tracker_feature_dummy.cpp index 9ffd9e2e4be6c001f996be7639b68b01c33b8928..c25ac9b4b7024828e34d0548f12c030ee2a0fcb2 100644 --- a/src/processor_tracker_feature_dummy.cpp +++ b/src/processor_tracker_feature_dummy.cpp @@ -11,30 +11,27 @@ namespace wolf { +unsigned int ProcessorTrackerFeatureDummy::count_ = 0; + unsigned int ProcessorTrackerFeatureDummy::trackFeatures(const FeatureBaseList& _feature_list_in, FeatureBaseList& _feature_list_out, FeatureMatchMap& _feature_correspondences) { WOLF_INFO("tracking " , _feature_list_in.size() , " features..."); - // loosing the track of the first 2 features - auto features_lost = 0; - for (auto feat_in_ptr : _feature_list_in) + for (auto feat_in : _feature_list_in) { - - if ( rand() % static_cast<int>(101) < 30 ) + if (++count_ % 3 == 2) // lose one every 3 tracks { - features_lost++; - - WOLF_INFO("track: " , feat_in_ptr->trackId() , " feature: " , feat_in_ptr->id() , " lost!"); + WOLF_INFO("track: " , feat_in->trackId() , " feature: " , feat_in->id() , " lost!"); } else { - FeatureBasePtr ftr(std::make_shared<FeatureBase>("POINT IMAGE", feat_in_ptr->getMeasurement(), feat_in_ptr->getMeasurementCovariance())); + FeatureBasePtr ftr(std::make_shared<FeatureBase>("POINT IMAGE", feat_in->getMeasurement(), feat_in->getMeasurementCovariance())); _feature_list_out.push_back(ftr); - _feature_correspondences[_feature_list_out.back()] = std::make_shared<FeatureMatch>(FeatureMatch({feat_in_ptr,0})); + _feature_correspondences[_feature_list_out.back()] = std::make_shared<FeatureMatch>(FeatureMatch({feat_in,0})); - WOLF_INFO("track: " , feat_in_ptr->trackId() , " last: " , feat_in_ptr->id() , " inc: " , ftr->id() , " !" ); + WOLF_INFO("track: " , feat_in->trackId() , " last: " , feat_in->id() , " inc: " , ftr->id() , " !" ); } } diff --git a/src/processor_tracker_feature_dummy.h b/src/processor_tracker_feature_dummy.h index 1cb423f364a09b7834c171db727594db3f32444f..6fa449695f09a56fa93932dddf4d359e29000369 100644 --- a/src/processor_tracker_feature_dummy.h +++ b/src/processor_tracker_feature_dummy.h @@ -27,6 +27,7 @@ class ProcessorTrackerFeatureDummy : public ProcessorTrackerFeature protected: + static unsigned int count_; unsigned int n_feature_, min_feat_for_keyframe_; // virtual void preProcess() { }