提交 1ee6e142 编写于 作者: Z Zhang Liangliang 提交者: Jiangtao Hu

fixed a bug in qp_spline_path

上级 62bad286
...@@ -139,7 +139,6 @@ bool QpSplinePathGenerator::Generate(const DecisionData& decision_data, ...@@ -139,7 +139,6 @@ bool QpSplinePathGenerator::Generate(const DecisionData& decision_data,
} }
bool QpSplinePathGenerator::CalculateInitFrenetPoint( bool QpSplinePathGenerator::CalculateInitFrenetPoint(
const common::TrajectoryPoint& traj_point, const common::TrajectoryPoint& traj_point,
common::FrenetFramePoint* const frenet_frame_point) { common::FrenetFramePoint* const frenet_frame_point) {
common::SLPoint sl_point; common::SLPoint sl_point;
...@@ -190,7 +189,6 @@ bool QpSplinePathGenerator::InitCoordRange(const QpFrenetFrame& qp_frenet_frame, ...@@ -190,7 +189,6 @@ bool QpSplinePathGenerator::InitCoordRange(const QpFrenetFrame& qp_frenet_frame,
} }
bool QpSplinePathGenerator::InitSpline( bool QpSplinePathGenerator::InitSpline(
const common::FrenetFramePoint& init_frenet_point, const double start_s, const common::FrenetFramePoint& init_frenet_point, const double start_s,
const double end_s) { const double end_s) {
// set knots // set knots
...@@ -265,7 +263,7 @@ bool QpSplinePathGenerator::AddConstraint( ...@@ -265,7 +263,7 @@ bool QpSplinePathGenerator::AddConstraint(
boundary_low.push_back(boundary.first); boundary_low.push_back(boundary.first);
boundary_high.push_back(boundary.second); boundary_high.push_back(boundary.second);
} }
if (!spline_constraint->add_fx_boundary(knots_, boundary_low, if (!spline_constraint->add_fx_boundary(evaluated_s_, boundary_low,
boundary_high)) { boundary_high)) {
AERROR << "Add boundary constraint failed"; AERROR << "Add boundary constraint failed";
return false; return false;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册