fix(lanelet2_extension,had_map_utils): fix node dying bug by lanelet …

…resampling (autowarefoundation#1506) * fix: lanelet empty case * fix(lanelet2_extension,had_map_utils): fix case point 1 Co-authored-by: Maxime CLEMENT <[email protected]> * fix(lanelet2_extension,had_map_utils): fix case point 1 Co-authored-by: Maxime CLEMENT <[email protected]> Co-authored-by: Maxime CLEMENT <[email protected]>
tzhong518 · Oct 14, 2022 · 3a088c1 · 3a088c1
1 parent 6b5b576
commit 3a088c1
Show file tree

Hide file tree

Showing 2 changed files with 2 additions and 0 deletions.
diff --git a/common/had_map_utils/src/had_map_utils.cpp b/common/had_map_utils/src/had_map_utils.cpp
@@ -101,6 +101,7 @@ std::vector<lanelet::BasicPoint3d> resamplePoints(
 
   // Calculate accumulated lengths
   const auto accumulated_lengths = calculateAccumulatedLengths(line_string);
+  if (accumulated_lengths.size() < 2) return {};
 
   // Create each segment
   std::vector<lanelet::BasicPoint3d> resampled_points;

diff --git a/map/lanelet2_extension/lib/utilities.cpp b/map/lanelet2_extension/lib/utilities.cpp
@@ -148,6 +148,7 @@ std::vector<lanelet::BasicPoint3d> resamplePoints(
 
   // Calculate accumulated lengths
   const auto accumulated_lengths = calculateAccumulatedLengths(line_string);
+  if (accumulated_lengths.size() < 2) return {};
 
   // Create each segment
   std::vector<lanelet::BasicPoint3d> resampled_points;