diff --git a/planning/autoware_path_generator/src/utils.cpp b/planning/autoware_path_generator/src/utils.cpp index 8b79f2c54..0cadc6567 100644 --- a/planning/autoware_path_generator/src/utils.cpp +++ b/planning/autoware_path_generator/src/utils.cpp @@ -446,6 +446,7 @@ std::optional get_path_up_to_just_before_pre_goal( // It seems we have a point outside of the circle whose center is the goal const auto min_dist_out_of_circle_index = min_dist_out_of_circle_index_opt.value(); + if (min_dist_out_of_circle_index == 0) return std::nullopt; // Fill all the points up to just before the point outside of the circle PathWithLaneId output;