fix(intersection): fix possible invalid access (autowarefoundation#6542)

Signed-off-by: Mamoru Sobue <[email protected]>
tier4 · Mar 5, 2024 · de648b8 · de648b8
1 parent d9c5e3d
commit de648b8
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/planning/behavior_velocity_intersection_module/src/scene_intersection_stuck.cpp b/planning/behavior_velocity_intersection_module/src/scene_intersection_stuck.cpp
@@ -34,6 +34,9 @@ lanelet::LineString3d getLineStringFromArcLength(
   lanelet::Points3d points;
   double accumulated_length = 0;
   size_t start_index = linestring.size();
+  if (start_index == 0) {
+    return lanelet::LineString3d{lanelet::InvalId, points};
+  }
   for (size_t i = 0; i < linestring.size() - 1; i++) {
     const auto & p1 = linestring[i];
     const auto & p2 = linestring[i + 1];