Skip to content

Commit 3f4463e

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 bfd740f commit 3f4463e

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
@@ -505,6 +505,8 @@ PidLongitudinalController::ControlData PidLongitudinalController::getControlData
505505
// calculate the target motion for delay compensation
506506
constexpr double min_running_dist = 0.01;
507507
if (control_data.state_after_delay.running_distance > min_running_dist) {
508+
control_data.interpolated_traj.points =
509+
autoware::motion_utils::removeOverlapPoints(control_data.interpolated_traj.points);
508510
const auto target_pose = longitudinal_utils::findTrajectoryPoseAfterDistance(
509511
control_data.nearest_idx, control_data.state_after_delay.running_distance,
510512
control_data.interpolated_traj);

0 commit comments

Comments
 (0)