提交 27a33334 编写于 作者: K kechxu 提交者: Yajia Zhang

modify the increment pf path_s for more points to compute trajectory cost

上级 f7cb4550
......@@ -62,8 +62,8 @@ double TrajectoryCost::calculate(const QuinticPolynomialCurve1d &curve,
double dl = std::fabs(curve.evaluate(1, path_s));
total_cost += dl;
path_s += config_.path_resolution();
// TODO(all): add the 5.0 as a parameter into config
path_s += config_.path_resolution() / 5.0;
}
// obstacle cost
return total_cost;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册