Resolve "follow core:#313"

Closes #15 (closed)

src/processor/processor_closeloop_icp.cpp

@@ -145,13 +145,12 @@ FrameBasePtrList ProcessorCloseloopIcp::selectCandidates(FrameBasePtr _keyframe_
     //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=trajectory->rbegin(); it != trajectory->rend(); it++){
-            if((*it)->isKey()){
-                // WOLF_DEBUG("TIMESTAMP KEY FRAME ", (*it)->id(), " ", (*it)->getTimeStamp());
-                key_frames_counter++;
-                if (key_frames_counter > recent_key_frames_ignored_
-                    and (_keyframe_ptr->getP()->getState() - (*it)->getP()->getState()).norm() < laser_scan_params_.range_max_) candidates.push_back(*it);
-            }
+    for(auto it=trajectory->rbegin(); it != trajectory->rend(); it++)
+    {
+        // WOLF_DEBUG("TIMESTAMP KEY FRAME ", (*it)->id(), " ", (*it)->getTimeStamp());
+        key_frames_counter++;
+        if (key_frames_counter > recent_key_frames_ignored_
+                and (_keyframe_ptr->getP()->getState() - (*it)->getP()->getState()).norm() < laser_scan_params_.range_max_) candidates.push_back(*it);
     }
     WOLF_DEBUG("%%%%%%%%%%%%%%%%%% CANDIDATES SIZE ", candidates.size());
     return candidates;