From a716a9079f5b31498bcec54c9bad0dcdf1f088d5 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Joan=20Sol=C3=A0?= <jsola@iri.upc.edu>
Date: Wed, 2 Dec 2020 17:16:09 +0100
Subject: [PATCH] Try an EPS tolerance
---
src/sensor/sensor_base.cpp | 2 +-
1 file changed, 1 insertion(+), 1 deletion(-)
diff --git a/src/sensor/sensor_base.cpp b/src/sensor/sensor_base.cpp
index 9e7adfd0b..46456daaf 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)
--
GitLab