diff --git a/src/processor/processor_visual_odometry.cpp b/src/processor/processor_visual_odometry.cpp index bef67520c0f48dc3429676553b8e5dd817ef6138..0be8e83c3f3ff5eaf3d60dd7a598fa05c35ecc54 100644 --- a/src/processor/processor_visual_odometry.cpp +++ b/src/processor/processor_visual_odometry.cpp @@ -267,7 +267,7 @@ void ProcessorVisualOdometry::preProcess() for (auto & cvkp : kps_last_new){ WKeyPoint wkp(cvkp); mwkps_last_new[wkp.getId()] = wkp; - } + } WOLF_INFO("Detected ", mwkps_last_new.size(), " new keypoints in last"); TracksMap tracks_last_incoming_new = kltTrack(img_last, img_incoming, mwkps_last_new, mwkps_incoming_new); @@ -294,6 +294,10 @@ void ProcessorVisualOdometry::preProcess() // add a flag so that voteForKeyFrame use it to vote for a KeyFrame capture_image_incoming_->setLastWasRepopulated(true); + + // Update captures + capture_image_last_->addKeyPoints(mwkps_last_new); + } else {