fix(drivable_area_expansion): fix invalid access (autowarefoundation#…

…6566) Signed-off-by: satoshi-ota <[email protected]>
tier4 · Mar 8, 2024 · 63e6fa8 · 63e6fa8
1 parent efeda95
commit 63e6fa8
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/...g/behavior_path_planner_common/src/utils/drivable_area_expansion/static_drivable_area.cpp b/...g/behavior_path_planner_common/src/utils/drivable_area_expansion/static_drivable_area.cpp
@@ -1481,6 +1481,10 @@ std::vector<geometry_msgs::msg::Point> postProcess(
   const auto & vehicle_length = planner_data->parameters.vehicle_length;
   constexpr double overlap_threshold = 0.01;
 
+  if (original_bound.size() < 2) {
+    return original_bound;
+  }
+
   const auto addPoints =
     [](const lanelet::ConstLineString3d & points, std::vector<geometry_msgs::msg::Point> & bound) {
       for (const auto & bound_p : points) {