From d4995a0fadd38fc2cc4b881be42274aeb57536b1 Mon Sep 17 00:00:00 2001 From: Takayuki Murooka Date: Wed, 11 Oct 2023 15:43:07 +0900 Subject: [PATCH] feat(intersection): not detect stuck vehicle when turning left Signed-off-by: Takayuki Murooka --- .../src/scene_intersection.cpp | 5 +++++ 1 file changed, 5 insertions(+) diff --git a/planning/behavior_velocity_intersection_module/src/scene_intersection.cpp b/planning/behavior_velocity_intersection_module/src/scene_intersection.cpp index 75bb4e861a60f..3044bf563941c 100644 --- a/planning/behavior_velocity_intersection_module/src/scene_intersection.cpp +++ b/planning/behavior_velocity_intersection_module/src/scene_intersection.cpp @@ -1185,6 +1185,11 @@ IntersectionModule::DecisionResult IntersectionModule::modifyPathVelocityDetail( bool IntersectionModule::checkStuckVehicle( const std::shared_ptr & planner_data, const util::PathLanelets & path_lanelets) { + // NOTE: No need to stop for stuck vehicle when the ego will turn left. + if (turn_direction_ == std::string("left")) { + return false; + } + const auto & objects_ptr = planner_data->predicted_objects; // considering lane change in the intersection, these lanelets are generated from the path