Fix out of bound vector (ros-navigation#3461) (ros-navigation#3463)

(cherry picked from commit 0a63bf9) Co-authored-by: Tony Najjar <[email protected]>
EnjoyRobotics · Oct 24, 2023 · b90d0bf · b90d0bf
1 parent 1b0f6d7
commit b90d0bf
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/nav2_mppi_controller/include/nav2_mppi_controller/tools/utils.hpp b/nav2_mppi_controller/include/nav2_mppi_controller/tools/utils.hpp
@@ -370,7 +370,7 @@ inline void findPathCosts(
   auto * costmap = costmap_ros->getCostmap();
   unsigned int map_x, map_y;
   const size_t path_segments_count = data.path.x.shape(0) - 1;
-  data.path_pts_valid = std::vector<bool>(path_segments_count - 1, false);
+  data.path_pts_valid = std::vector<bool>(path_segments_count, false);
   for (unsigned int idx = 0; idx < path_segments_count; idx++) {
     const auto path_x = data.path.x(idx);
     const auto path_y = data.path.y(idx);