From 3a088c1bbb36f9e8e60228118cbc511751b77fb6 Mon Sep 17 00:00:00 2001 From: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Date: Wed, 3 Aug 2022 21:59:39 +0900 Subject: [PATCH] fix(lanelet2_extension,had_map_utils): fix node dying bug by lanelet resampling (#1506) * fix: lanelet empty case * fix(lanelet2_extension,had_map_utils): fix case point 1 Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> * fix(lanelet2_extension,had_map_utils): fix case point 1 Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> --- common/had_map_utils/src/had_map_utils.cpp | 1 + map/lanelet2_extension/lib/utilities.cpp | 1 + 2 files changed, 2 insertions(+) diff --git a/common/had_map_utils/src/had_map_utils.cpp b/common/had_map_utils/src/had_map_utils.cpp index db9721504c7e6..81f9517f6a8d2 100644 --- 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 resamplePoints( // Calculate accumulated lengths const auto accumulated_lengths = calculateAccumulatedLengths(line_string); + if (accumulated_lengths.size() < 2) return {}; // Create each segment std::vector resampled_points; diff --git a/map/lanelet2_extension/lib/utilities.cpp b/map/lanelet2_extension/lib/utilities.cpp index 1371190421aa9..4af74f0120a55 100644 --- a/map/lanelet2_extension/lib/utilities.cpp +++ b/map/lanelet2_extension/lib/utilities.cpp @@ -148,6 +148,7 @@ std::vector resamplePoints( // Calculate accumulated lengths const auto accumulated_lengths = calculateAccumulatedLengths(line_string); + if (accumulated_lengths.size() < 2) return {}; // Create each segment std::vector resampled_points;