Skip to content

Commit dfed213

Browse files
fix(pid_longitudinal_controller): fix the same point error (autowarefoundation#8758)
* fix same point Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>
1 parent d2142b9 commit dfed213

File tree

1 file changed

+2
-0
lines changed

1 file changed

+2
-0
lines changed

control/autoware_pid_longitudinal_controller/src/pid_longitudinal_controller.cpp

+2
Original file line numberDiff line numberDiff line change
@@ -488,6 +488,8 @@ PidLongitudinalController::ControlData PidLongitudinalController::getControlData
488488
// calculate the target motion for delay compensation
489489
constexpr double min_running_dist = 0.01;
490490
if (control_data.state_after_delay.running_distance > min_running_dist) {
491+
control_data.interpolated_traj.points =
492+
autoware::motion_utils::removeOverlapPoints(control_data.interpolated_traj.points);
491493
const auto target_pose = longitudinal_utils::findTrajectoryPoseAfterDistance(
492494
control_data.nearest_idx, control_data.state_after_delay.running_distance,
493495
control_data.interpolated_traj);

0 commit comments

Comments
 (0)