diff --git a/src/processor/processor_motion.cpp b/src/processor/processor_motion.cpp index 06d9d37f2b51e47472acd44bd6641105d30e438e..44561aeb1e6a2b2d813f78ba0f34d41d20b8301f 100644 --- a/src/processor/processor_motion.cpp +++ b/src/processor/processor_motion.cpp @@ -61,6 +61,8 @@ void ProcessorMotion::splitBuffer(const wolf::CaptureMotionPtr& _capture_source, // // add to old buffer // _capture_target->getBuffer().get().push_back(motion_interpolated); // } + // start with empty motion + _capture_source->getBuffer().get().push_front(motionZero(_keyframe_target->getTimeStamp())); // Update the existing capture _capture_source->setOriginFrame(_keyframe_target); @@ -407,9 +409,9 @@ void ProcessorMotion::integrateOneStep() void ProcessorMotion::reintegrateBuffer(CaptureMotionPtr _capture_ptr) { - // start with empty motion - _capture_ptr->getBuffer().get().push_front(motionZero(_capture_ptr->getOriginFrame()->getTimeStamp())); - +// // start with empty motion +// _capture_ptr->getBuffer().get().push_front(motionZero(_capture_ptr->getOriginFrame()->getTimeStamp())); +// VectorXs calib = _capture_ptr->getCalibrationPreint(); // Iterate all the buffer