提交 a5c38ada 编写于 作者: S sjiang2018 提交者: Calvin Miao

Planning: adjust ROI resolution in Park_and_go scenario.

上级 f4f43363
......@@ -47,6 +47,7 @@ stage_config:{
task_type: OPEN_SPACE_ROI_DECIDER
open_space_roi_decider_config {
roi_type: PARK_AND_GO
roi_linesegment_length: 0.2
perception_obstacle_buffer: 0.5
end_pose_s_distance: 10.0
}
......
......@@ -48,7 +48,7 @@ Stage::StageStatus ParkAndGoStageAdjust::Process(
AERROR << "ParkAndGoStageAdjust planning error";
return StageStatus::ERROR;
}
bool is_ready_to_cruise =
const bool is_ready_to_cruise =
scenario::util::CheckADCReadyToCruise(frame, scenario_config_);
bool is_end_of_trajectory = false;
......@@ -56,11 +56,8 @@ Stage::StageStatus ParkAndGoStageAdjust::Process(
if (history_frame) {
const auto& trajectory_points =
history_frame->current_frame_planned_trajectory().trajectory_point();
const auto trajectory_point_size =
history_frame->current_frame_planned_trajectory()
.trajectory_point_size();
auto last_point = trajectory_points[trajectory_point_size - 1];
is_end_of_trajectory = last_point.relative_time() < 0.0;
CHECK(trajectory_points.empty());
is_end_of_trajectory = (trajectory_points.rbegin()->relative_time() < 0.0);
}
if (!is_ready_to_cruise && !is_end_of_trajectory) {
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册