diff --git a/ros/src/Utils.hpp b/ros/src/Utils.hpp index 09c9cd8e..8caccda8 100644 --- a/ros/src/Utils.hpp +++ b/ros/src/Utils.hpp @@ -185,11 +185,6 @@ inline void FillPointCloud2XYZ(const std::vector &points, Point } } -inline void FillPointCloud2Timestamp(const std::vector ×tamps, PointCloud2 &msg) { - sensor_msgs::PointCloud2Iterator msg_t(msg, "time"); - for (size_t i = 0; i < timestamps.size(); i++, ++msg_t) *msg_t = timestamps[i]; -} - inline std::vector GetTimestamps(const PointCloud2::ConstSharedPtr msg) { auto timestamp_field = GetTimestampField(msg); if (!timestamp_field.has_value()) return {}; @@ -228,13 +223,4 @@ inline std::unique_ptr EigenToPointCloud2(const std::vector EigenToPointCloud2(const std::vector &points, - const std::vector ×tamps, - const Header &header) { - auto msg = CreatePointCloud2Msg(points.size(), header, true); - FillPointCloud2XYZ(points, *msg); - FillPointCloud2Timestamp(timestamps, *msg); - return msg; -} } // namespace kiss_icp_ros::utils