diff --git a/src/sensor/sensor_base.cpp b/src/sensor/sensor_base.cpp index 9e7adfd0b99009c41345826e6a3b8ad866e70957..46456daaf164c9a6cbb0a3d38dac1ac2be4b6e16 100644 --- a/src/sensor/sensor_base.cpp +++ b/src/sensor/sensor_base.cpp @@ -263,7 +263,7 @@ CaptureBasePtr SensorBase::findLastCaptureBefore(const TimeStamp& _ts) const TrajectoryRevIter frame_rev_it = trajectory->rbegin(); while (frame_rev_it != trajectory->rend()) { - if ((*frame_rev_it)->getTimeStamp() <= _ts) + if ((*frame_rev_it)->getTimeStamp() <= _ts + Constants::EPS) { auto capture = (*frame_rev_it)->getCaptureOf(shared_from_this()); if (capture)