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

Planning: adjust ROI resolution in Park_and_go scenario.

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