提交 43dd9731 编写于 作者: J Jiangtao Hu 提交者: Yifei Jiang

planning: speed optimizer skips when no path data is available.

上级 d9349e8e
......@@ -59,6 +59,12 @@ Status DpStSpeedOptimizer::Process(const PathData& path_data,
return Status(ErrorCode::PLANNING_ERROR, "Not inited.");
}
if (path_data.discretized_path().NumOfPoints() == 0) {
std::string msg("Empty path data");
AERROR << msg;
return Status(ErrorCode::PLANNING_ERROR, msg);
}
StBoundaryMapper boundary_mapper(st_boundary_config_, reference_line,
path_data,
dp_st_speed_config_.total_path_length(),
......
......@@ -59,6 +59,13 @@ Status QpSplineStSpeedOptimizer::Process(const PathData& path_data,
AERROR << "Please call Init() before Process.";
return Status(ErrorCode::PLANNING_ERROR, "Not init.");
}
if (path_data.discretized_path().NumOfPoints() == 0) {
std::string msg("Empty path data");
AERROR << msg;
return Status(ErrorCode::PLANNING_ERROR, msg);
}
StBoundaryMapper boundary_mapper(
st_boundary_config_, reference_line, path_data,
qp_spline_st_speed_config_.total_path_length(),
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册