diff --git a/src/processor_tracker_feature_corner.cpp b/src/processor_tracker_feature_corner.cpp index e7889ad636537c0158a83bc0f67015c9ef6f3398..c63ebe5efac9e29b7c3f54f6fdd929b981edbdf4 100644 --- a/src/processor_tracker_feature_corner.cpp +++ b/src/processor_tracker_feature_corner.cpp @@ -64,7 +64,6 @@ unsigned int ProcessorTrackerFeatureCorner::trackFeatures(const FeatureBaseList& if (((*feat_out_it)->getMeasurement().head<3>() - expected_feature_pose).squaredNorm() > position_error_th_*position_error_th_) { // match - //_feature_correspondences[*feat_out_it] = FeatureMatch({feat_in_ptr,0}); _feature_correspondences[*feat_out_it] = std::make_shared<FeatureMatch>(FeatureMatch({feat_in_ptr,0})); // move matched feature to list diff --git a/src/processor_tracker_feature_dummy.cpp b/src/processor_tracker_feature_dummy.cpp index 0bcf1fd0f63c0edb43730015c8ac4a3673b347d8..6a7bba038afe364879eb5ddfa14b7d149a7348e6 100644 --- a/src/processor_tracker_feature_dummy.cpp +++ b/src/processor_tracker_feature_dummy.cpp @@ -29,8 +29,6 @@ unsigned int ProcessorTrackerFeatureDummy::trackFeatures(const FeatureBaseList& else { _feature_list_out.push_back(std::make_shared<FeatureBase>(FEATURE_POINT_IMAGE, "POINT IMAGE", feat_in_ptr->getMeasurement(), feat_in_ptr->getMeasurementCovariance())); - //_feature_correspondences[_feature_list_out.back()] = FeatureMatch({feat_in_ptr,0}); - //_feature_correspondences[_feature_list_out.back()] = std::make_shared<FeatureMatch>({feat_in_ptr,0}); _feature_correspondences[_feature_list_out.back()] = std::make_shared<FeatureMatch>(FeatureMatch({feat_in_ptr,0})); std::cout << "feature " << feat_in_ptr->getMeasurement() << " tracked!" << std::endl; }