diff --git a/src/sensor_base.cpp b/src/sensor_base.cpp index 7d36d7bf8284f9836cd7d4ee97a00c82665e05cd..e16a01fb375c4809b36be966d8c500b81aa536df 100644 --- a/src/sensor_base.cpp +++ b/src/sensor_base.cpp @@ -226,6 +226,8 @@ CaptureBasePtr SensorBase::lastCapture(const TimeStamp& _ts) // we search for the most recent Capture of this sensor before _ts CaptureBasePtr capture = nullptr; FrameBaseList frame_list = getProblem()->getTrajectoryPtr()->getFrameList(); + + // We iterate in reverse since we're likely to find it close to the rbegin() place. FrameBaseRevIter frame_rev_it = frame_list.rbegin(); while (frame_rev_it != frame_list.rend()) {