Skip to content

Commit d1fc0c1

Browse files
yuki-takagi-66emuemuJP
authored andcommitted
fix(pid_longitudinal_controller): fix the same point error (autowarefoundation#8758)
* fix same point Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp> Signed-off-by: emuemuJP <k.matsumoto.0807@gmail.com>
1 parent aca5022 commit d1fc0c1

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)