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 Original file line number Diff line number Diff line change @@ -106,11 +106,15 @@ bool DetectionAreaModule::modifyPathVelocity(PathWithLaneId * path)
106
106
}
107
107
108
108
// 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 ;
112
117
}
113
- return true ;
114
118
115
119
// Force ignore objects after dead_line
116
120
if (planner_param_.use_dead_line ) {
You can’t perform that action at this time.
0 commit comments