WIP: Resolve "Adapt to std::set and std::map instead of std::list in wolf nodes"

Closes #14 (closed)

src/processor/processor_closeloop_icp.cpp

@@ -141,11 +141,11 @@ FrameBasePtrList ProcessorCloseloopIcp::selectCandidates(FrameBasePtr _keyframe_
 {
     FrameBasePtrList candidates;
     int key_frames_counter = 0;
-    const auto &frames = this->getProblem()->getTrajectory()->getFrameList();
+    const auto &trajectory = getProblem()->getTrajectory();
     //Consider only key_frames from 1 to n - match_past_key_frame_
     // std::copy_if(frames.begin(), frames.end(), std::back_inserter(candidates), [&](FrameBasePtr _frame) { if(_frame->isKey()) {key_frames_counter++; return (key_frames_counter % match_past_key_frame_ == 0);
     //                                                                                                                     }else{ return false;};});
-        for(auto it=frames.rbegin(); it != frames.rend(); it++){
+        for(auto it=trajectory->rbegin(); it != trajectory->rend(); it++){
             if((*it)->isKey()){
                 // WOLF_DEBUG("TIMESTAMP KEY FRAME ", (*it)->id(), " ", (*it)->getTimeStamp());
                 key_frames_counter++;