fix boundary point exclusion in convexFillCells (#2161)

ros-navigation · Apr 5, 2021 · 6253845 · 6253845
1 parent bfc4f32
commit 6253845
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/nav2_costmap_2d/src/costmap_2d.cpp b/nav2_costmap_2d/src/costmap_2d.cpp
@@ -435,7 +435,7 @@ void Costmap2D::convexFillCells(
 
     MapLocation pt;
     // loop though cells in the column
-    for (unsigned int y = min_pt.y; y < max_pt.y; ++y) {
+    for (unsigned int y = min_pt.y; y <= max_pt.y; ++y) {
       pt.x = x;
       pt.y = y;
       polygon_cells.push_back(pt);