fix bug in published point timestamps

MOLAorg · Feb 18, 2024 · c3dc1fc · c3dc1fc
1 parent 457f4ad
commit c3dc1fc
Showing 1 changed file with 6 additions and 4 deletions.
diff --git a/mola_input_paris_luco_dataset/src/ParisLucoDataset.cpp b/mola_input_paris_luco_dataset/src/ParisLucoDataset.cpp
@@ -246,11 +246,13 @@ void ParisLucoDataset::load_lidar(timestep_t step) const
     obs->sensorLabel = "lidar";
     obs->pointcloud  = pts;
 
-    const double shiftTime = -0.5 * lidarPeriod_;
-    auto*        Ts        = pts->getPointsBufferRef_timestamp();
+    auto* Ts = pts->getPointsBufferRef_timestamp();
     ASSERT_(Ts);
-    std::transform(Ts->begin(), Ts->end(), Ts->begin(), [=](double t) {
-        return t - shiftTime;
+    const float earliestTime = *std::min_element(Ts->cbegin(), Ts->cend());
+    const float shiftTime    = -earliestTime - 0.5 * lidarPeriod_;
+
+    std::transform(Ts->cbegin(), Ts->cend(), Ts->begin(), [=](double t) {
+        return t + shiftTime;
     });
 
     // Fix missing RING_ID: ParisLuco does not have a RING_ID field,