Skip to content

Commit c6b78a7

Browse files
committed
fix
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
1 parent 4673814 commit c6b78a7

File tree

1 file changed

+8
-4
lines changed
  • planning/behavior_velocity_planner/autoware_behavior_velocity_detection_area_module/src

1 file changed

+8
-4
lines changed

planning/behavior_velocity_planner/autoware_behavior_velocity_detection_area_module/src/scene.cpp

+8-4
Original file line numberDiff line numberDiff line change
@@ -106,11 +106,15 @@ bool DetectionAreaModule::modifyPathVelocity(PathWithLaneId * path)
106106
}
107107

108108
// Check state
109-
last_obstacle_found_time_ = {};
110-
if (!planner_param_.suppress_pass_judge_when_stopping || !is_stopped) {
111-
state_ = State::GO;
109+
const bool is_safe = detection_area::can_clear_stop_state(
110+
last_obstacle_found_time_, clock_->now(), planner_param_.state_clear_time);
111+
if (is_safe) {
112+
last_obstacle_found_time_ = {};
113+
if (!planner_param_.suppress_pass_judge_when_stopping || !is_stopped) {
114+
state_ = State::GO;
115+
}
116+
return true;
112117
}
113-
return true;
114118

115119
// Force ignore objects after dead_line
116120
if (planner_param_.use_dead_line) {

0 commit comments

Comments
 (0)