bug fix about issue #5

Signed-off-by: Tasaki-Lab <[email protected]>
autowarefoundation · Jun 25, 2020 · 347a746 · 347a746
1 parent ab20e02
commit 347a746
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/costmap_generator/nodes/costmap_generator/points_to_costmap.cpp b/costmap_generator/nodes/costmap_generator/points_to_costmap.cpp
@@ -70,8 +70,8 @@ grid_map::Index PointsToCostmap::fetchGridIndexFromPoint(const pcl::PointXYZ& po
   double mapped_x = (grid_length_x_ - origin_x_offset - point.x) / grid_resolution_;
   double mapped_y = (grid_length_y_ - origin_y_offset - point.y) / grid_resolution_;
 
-  int mapped_x_ind = std::ceil(mapped_x);
-  int mapped_y_ind = std::ceil(mapped_y);
+  int mapped_x_ind = (int)mapped_x;
+  int mapped_y_ind = (int)mapped_y;
   grid_map::Index index(mapped_x_ind, mapped_y_ind);
   return index;
 }