From 784bcbcdc982fbc5b857320884d6faa6c358c3ac Mon Sep 17 00:00:00 2001 From: Marco Lampacrescia Date: Thu, 16 Sep 2021 16:02:35 +0200 Subject: [PATCH] Fix Duration casting issue leading to no undistortion Signed-off-by: Marco Lampacrescia --- src/laser_geometry.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/laser_geometry.cpp b/src/laser_geometry.cpp index 7031290..3928d90 100644 --- a/src/laser_geometry.cpp +++ b/src/laser_geometry.cpp @@ -427,8 +427,8 @@ void LaserProjection::transformLaserScanToPointCloud_( TIME end_time = scan_in.header.stamp; // TODO(anonymous): reconcile all the different time constructs if (!scan_in.ranges.empty()) { - end_time = end_time + rclcpp::Duration( - static_cast((scan_in.ranges.size() - 1) * scan_in.time_increment), 0); + end_time = start_time + rclcpp::Duration::from_seconds( + (scan_in.ranges.size() - 1) * scan_in.time_increment); } std::chrono::nanoseconds start(start_time.nanoseconds());