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

Planning: bugfix to reduced change lane jerk.

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