feat(intersection): disable peeking while collision is detected

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
mkuri · May 22, 2023 · 6cbac75 · 6cbac75
1 parent a9da72e
commit 6cbac75
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/planning/behavior_velocity_intersection_module/src/scene_intersection.cpp b/planning/behavior_velocity_intersection_module/src/scene_intersection.cpp
@@ -306,7 +306,7 @@ bool IntersectionModule::modifyPathVelocity(PathWithLaneId * path, StopReason *
       RCLCPP_DEBUG(logger_, "===== plan end =====");
       return true;
     }
-    if (before_creep_state_machine_.getState() == StateMachine::State::GO) {
+    if (before_creep_state_machine_.getState() == StateMachine::State::GO && has_collision) {
       occlusion_stop_required = true;
       occlusion_peeking_line_idx = occlusion_peeking_line_idx_opt;