From bb0a296ea3bc1a2257b9ffeabea018bd257f951b Mon Sep 17 00:00:00 2001
From: Shumpei Wakabayashi <42209144+shmpwk@users.noreply.github.com>
Date: Mon, 4 Mar 2024 13:01:36 +0900
Subject: [PATCH] fix(lanelet2_extension): invalid access (#240)

---
 tmp/lanelet2_extension/lib/utilities.cpp | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/tmp/lanelet2_extension/lib/utilities.cpp b/tmp/lanelet2_extension/lib/utilities.cpp
index b1f7e406..f11588b8 100644
--- a/tmp/lanelet2_extension/lib/utilities.cpp
+++ b/tmp/lanelet2_extension/lib/utilities.cpp
@@ -180,6 +180,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];