diff --git a/planning/behavior_path_planner/src/utilities.cpp b/planning/behavior_path_planner/src/utilities.cpp index 12d7d65626003..993565c7c90a6 100644 --- a/planning/behavior_path_planner/src/utilities.cpp +++ b/planning/behavior_path_planner/src/utilities.cpp @@ -1688,7 +1688,7 @@ bool checkLaneIsInIntersection( const RouteHandler & route_handler, const PathWithLaneId & reference_path, const lanelet::ConstLanelets & lanelet_sequence, double & additional_length_to_add) { - if (lanelet_sequence.size() < 2) { + if (lanelet_sequence.size() < 2 || reference_path.points.empty()) { return false; }