diff --git a/planning/freespace_planner/src/freespace_planner/freespace_planner_node.cpp b/planning/freespace_planner/src/freespace_planner/freespace_planner_node.cpp index ea24f4e57ff1c..d6cfdc5dc7285 100644 --- a/planning/freespace_planner/src/freespace_planner/freespace_planner_node.cpp +++ b/planning/freespace_planner/src/freespace_planner/freespace_planner_node.cpp @@ -193,14 +193,7 @@ Trajectory createStopTrajectory(const PoseStamped & current_pose) Trajectory createStopTrajectory(const Trajectory & trajectory) { - Trajectory stop_trajectory; - stop_trajectory.header = trajectory.header; - stop_trajectory.header.stamp = rclcpp::Clock().now(); - - stop_trajectory.points.reserve(trajectory.points.size()); - for (size_t i = 0; i < trajectory.points.size(); ++i) { - stop_trajectory.points.push_back(trajectory.points.at(i)); - } + Trajectory stop_trajectory = trajectory; for (size_t i = 0; i < trajectory.points.size(); ++i) { stop_trajectory.points.at(i).longitudinal_velocity_mps = 0.0; }