diff --git a/src/processor/processor_motion.cpp b/src/processor/processor_motion.cpp index bd7d8ebc247417762c1ca5d5c2d45170f5721d09..5751ac804e6398ad40aaa9c96b8a7216ffc4f250 100644 --- a/src/processor/processor_motion.cpp +++ b/src/processor/processor_motion.cpp @@ -272,11 +272,11 @@ void ProcessorMotion::processCapture(CaptureBasePtr _incoming_ptr) // update KF state (adding missing StateBlocks) auto proc_state = getState(timestamp_from_callback); - for (auto pair_ckey_vec : proc_state) - if (!keyframe_from_callback->isInStructure(pair_ckey_vec.first)) - keyframe_from_callback->addStateBlock(pair_ckey_vec.first, - FactoryStateBlock::create(string(1, pair_ckey_vec.first), - pair_ckey_vec.second, + for (auto pair_key_vec : proc_state) + if (!keyframe_from_callback->isInStructure(pair_key_vec.first)) + keyframe_from_callback->addStateBlock(pair_key_vec.first, + FactoryStateBlock::create(string(1, pair_key_vec.first), + pair_key_vec.second, false), getProblem()); keyframe_from_callback->setState(proc_state); @@ -416,11 +416,11 @@ void ProcessorMotion::processCapture(CaptureBasePtr _incoming_ptr) last_ptr_->setTimeStamp( ts ); last_ptr_->getFrame()->setTimeStamp( ts ); VectorComposite state_propa = getState( ts ); - for (auto pair_ckey_vec : state_propa) - if (!last_ptr_->getFrame()->isInStructure(pair_ckey_vec.first)) - last_ptr_->getFrame()->addStateBlock(pair_ckey_vec.first, - FactoryStateBlock::create(string(1, pair_ckey_vec.first), - pair_ckey_vec.second, + for (auto & pair_key_vec : state_propa) + if (!last_ptr_->getFrame()->isInStructure(pair_key_vec.first)) + last_ptr_->getFrame()->addStateBlock(pair_key_vec.first, + FactoryStateBlock::create(string(1, pair_key_vec.first), + pair_key_vec.second, false), getProblem()); last_ptr_->getFrame()->setState( state_propa );