提交 285beeda 编写于 作者: J jiangyifei 提交者: Jiangtao Hu

planning: fixed pass obstacle stage exit conditions in side pass.

上级 e320d2f8
......@@ -358,7 +358,11 @@ Stage::StageStatus SidePassPassObstacle::Process(
double distance_to_path_end =
sl_point.s() - GetContext()->scenario_config_.side_pass_exit_distance();
if (adc_sl_boundary.end_s() > distance_to_path_end) {
double adc_velocity = frame->vehicle_state().linear_velocity();
double max_velocity_for_stop =
GetContext()->scenario_config_.approach_obstacle_max_stop_speed();
if (adc_sl_boundary.end_s() > distance_to_path_end ||
adc_velocity < max_velocity_for_stop) {
next_stage_ = ScenarioConfig::NO_STAGE;
return Stage::FINISHED;
}
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册