diff --git a/src/processor/processor_motion.cpp b/src/processor/processor_motion.cpp index 4a798a037c8851591d5367f838de28b43cef13b4..53f6f71589987ef9f04f60e55aea91c3ba6bb981 100644 --- a/src/processor/processor_motion.cpp +++ b/src/processor/processor_motion.cpp @@ -119,9 +119,6 @@ void ProcessorMotion::mergeCaptures(CaptureMotionPtr cap_prev, // emplace new feature and factor (if origin has frame) if (cap_prev->getOriginCapture() and cap_prev->getOriginCapture()->getFrame()) { - // auto new_feature = emplaceFeature(cap_target); - // emplaceFactor(new_feature, cap_prev->getOriginCapture()); - emplaceFeaturesAndFactors(cap_prev->getOriginCapture(), cap_target); } } @@ -315,11 +312,7 @@ void ProcessorMotion::processCapture(CaptureBasePtr _incoming_ptr) splitBuffer(capture_existing, timestamp_from_callback, capture_for_keyframe_callback); // // create motion feature and add it to the capture - // auto feature_new = emplaceFeature(capture_for_keyframe_callback); - // // create motion factor and add it to the feature, and constrain to the other capture (origin) - // emplaceFactor(feature_new, capture_origin ); - emplaceFeaturesAndFactors(capture_origin, capture_for_keyframe_callback); // modify existing feature and factor (if they exist in the existing capture) @@ -330,10 +323,6 @@ void ProcessorMotion::processCapture(CaptureBasePtr _incoming_ptr) assert(capture_existing->getFeatureList().empty());// there was only one feature! - // auto new_feature_existing = emplaceFeature(capture_existing); - - // emplaceFactor(new_feature_existing, capture_for_keyframe_callback); - emplaceFeaturesAndFactors(capture_for_keyframe_callback, capture_existing); } @@ -411,12 +400,8 @@ void ProcessorMotion::processCapture(CaptureBasePtr _incoming_ptr) // and give the part of the buffer before the new keyframe to the capture for the KF callback splitBuffer(capture_existing, timestamp_from_callback, capture_for_keyframe_callback); - // // create motion feature and add it to the capture - // auto feature_for_keyframe_callback = emplaceFeature(capture_for_keyframe_callback); - - // // create motion factor and add it to the feature, and constrain to the other capture (origin) - // emplaceFactor(feature_for_keyframe_callback, capture_origin ); - + // create motion feature and add it to the capture + // create motion factor and add it to the feature, and constrain to the other capture (origin) emplaceFeaturesAndFactors(capture_origin, capture_for_keyframe_callback); // reset processor origin