diff --git a/cartographer_ros/cartographer_ros/assets_writer.cc b/cartographer_ros/cartographer_ros/assets_writer.cc index 1ca3e099f..d03ec0e16 100644 --- a/cartographer_ros/cartographer_ros/assets_writer.cc +++ b/cartographer_ros/cartographer_ros/assets_writer.cc @@ -122,8 +122,8 @@ std::unique_ptr HandleMessage( const carto::transform::Rigid3f sensor_to_map = (tracking_to_map * sensor_to_tracking).cast(); points_batch->points.push_back( - sensor_to_map * - carto::sensor::ToRangefinderPoint(point_cloud.points[i])); + sensor_to_map * carto::sensor::ToRangefinderPoint( + point_cloud.points[i], Eigen::Vector3f::Zero())); points_batch->intensities.push_back(point_cloud.intensities[i]); // We use the last transform for the origin, which is approximately correct. points_batch->origin = sensor_to_map * Eigen::Vector3f::Zero();