提交 78d0731e 编写于 作者: Z Zhang Liangliang 提交者: Jiangtao Hu

Planning: bugfix to reduced change lane jerk.

上级 78e95abe
......@@ -264,15 +264,18 @@ bool DPRoadGraph::SamplePathWaypoints(
double sample_right_boundary = -eff_right_width;
double sample_left_boundary = eff_left_width;
if (reference_line_info_.IsChangeLanePath() &&
init_sl_point_.l() > eff_left_width) {
sample_right_boundary =
std::fmax(sample_right_boundary, init_sl_point_.l() - sample_l_range);
}
if (reference_line_info_.IsChangeLanePath() &&
init_sl_point_.l() < eff_right_width) {
sample_left_boundary =
std::fmin(sample_left_boundary, init_sl_point_.l() + sample_l_range);
if (reference_line_info_.IsChangeLanePath()) {
sample_right_boundary = std::fmin(-eff_right_width, init_sl_point_.l());
sample_left_boundary = std::fmax(eff_left_width, init_sl_point_.l());
if (init_sl_point_.l() > eff_left_width) {
sample_right_boundary = std::fmax(sample_right_boundary,
init_sl_point_.l() - sample_l_range);
}
if (init_sl_point_.l() < eff_right_width) {
sample_left_boundary = std::fmin(sample_left_boundary,
init_sl_point_.l() + sample_l_range);
}
}
std::vector<double> sample_l;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册