Skip to content

Commit 0efb315

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

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
@@ -507,6 +507,8 @@ PidLongitudinalController::ControlData PidLongitudinalController::getControlData
507507
// calculate the target motion for delay compensation
508508
constexpr double min_running_dist = 0.01;
509509
if (control_data.state_after_delay.running_distance > min_running_dist) {
510+
control_data.interpolated_traj.points =
511+
autoware::motion_utils::removeOverlapPoints(control_data.interpolated_traj.points);
510512
const auto target_pose = longitudinal_utils::findTrajectoryPoseAfterDistance(
511513
control_data.nearest_idx, control_data.state_after_delay.running_distance,
512514
control_data.interpolated_traj);

0 commit comments

Comments
 (0)