提交 c8b76b11 编写于 作者: K kechxu 提交者: Kecheng Xu

PnC: add a field of lane_id in path_point proto

上级 4abd4e31
......@@ -44,6 +44,8 @@ message PathPoint {
optional double dkappa = 7;
// derivative of derivative of kappa w.r.t s.
optional double ddkappa = 8;
// The lane ID where the path point is on
optional string lane_id = 9;
}
message Path {
......
......@@ -201,6 +201,7 @@ void GenerateLaneSequenceTrajectoryPoints(
path_point.set_y(point.y());
path_point.set_z(0.0);
path_point.set_theta(theta);
path_point.set_lane_id(lane_id);
trajectory_point.mutable_path_point()->CopyFrom(path_point);
trajectory_point.set_v(lane_speed);
trajectory_point.set_a(lane_acc);
......
......@@ -134,8 +134,6 @@ void MoveSequencePredictor::Predict(Obstacle* obstacle) {
<< "] will draw a lane sequence trajectory [" << ToString(sequence)
<< "] with probability [" << sequence.probability() << "].";
// TODO(Prediction): remove the following line
// std::string curr_lane_id = sequence.lane_segment(0).lane_id();
std::vector<TrajectoryPoint> points;
DrawMoveSequenceTrajectoryPoints(*obstacle, sequence,
FLAGS_prediction_duration,
......@@ -275,6 +273,7 @@ void MoveSequencePredictor::DrawManeuverTrajectoryPoints(
path_point.set_y(point.y());
path_point.set_z(0.0);
path_point.set_theta(theta);
path_point.set_lane_id(lane_id);
trajectory_point.mutable_path_point()->CopyFrom(path_point);
trajectory_point.set_v(lane_speed);
trajectory_point.set_a(lane_acc);
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册