Fix wrong warning message format (ros-navigation#3416)

* Fix wrong warning message format (Closes ros-navigation#3415) * fix code formatting
StratomInc · Feb 23, 2023 · aaf8130 · aaf8130
1 parent 9afd9eb
commit aaf8130
Showing 1 changed file with 4 additions and 3 deletions.
diff --git a/nav2_costmap_2d/plugins/voxel_layer.cpp b/nav2_costmap_2d/plugins/voxel_layer.cpp
@@ -275,12 +275,13 @@ void VoxelLayer::raytraceFreespace(
   if (!worldToMap3DFloat(ox, oy, oz, sensor_x, sensor_y, sensor_z)) {
     RCLCPP_WARN(
       logger_,
-      "Sensor origin at (%.2f, %.2f %.2f) is out of map bounds"
+      "Sensor origin at (%.2f, %.2f %.2f) is out of map bounds "
       "(%.2f, %.2f, %.2f) to (%.2f, %.2f, %.2f). "
       "The costmap cannot raytrace for it.",
       ox, oy, oz,
-      ox + getSizeInMetersX(), oy + getSizeInMetersY(), oz + getSizeInMetersZ(),
-      origin_x_, origin_y_, origin_z_);
+      origin_x_, origin_y_, origin_z_,
+      origin_x_ + getSizeInMetersX(), origin_y_ + getSizeInMetersY(),
+      origin_z_ + getSizeInMetersZ());
 
     return;
   }