fix(mpc_lateral_controller): remove overlaps when calculating trajectory

[maxime-clem]

Description

Remove overlaps in some trajectories calculated in the MPC controller.
This prevents the following error message.

[motion_utils] calcLongitudinalOffsetToSegment: Longitudinal offset calculation is not supported for the same points. Return NaN since no_throw option is enabled. The maintainer must check the code. 

Tests performed

Psim

Effects on system behavior

Reduce log messages

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

• I've confirmed the contribution guidelines.
• The PR follows the pull request guidelines.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

• The PR follows the pull request guidelines.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

• There are no open discussions or they are tracked via tickets.

After all checkboxes are checked, anyone who has write access can merge the PR.

[codecov]

Codecov Report

Attention: Patch coverage is 0% with 1 lines in your changes are missing coverage. Please review.

Project coverage is 14.78%. Comparing base (ebb4172) to head (feaf4b8).
Report is 303 commits behind head on main.

Files	Patch %	Lines
control/mpc_lateral_controller/src/mpc_utils.cpp	0.00%	0 Missing and 1 partial ⚠️

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #6538      +/-   ##
==========================================
- Coverage   14.78%   14.78%   -0.01%     
==========================================
  Files        1917     1917              
  Lines      132046   132047       +1     
  Branches    39228    39229       +1     
==========================================
  Hits        19523    19523              
  Misses      90734    90734              
- Partials    21789    21790       +1     

Flag	Coverage Δ		*Carryforward flag
differential	44.98% <0.00%> (?)
total	14.78% <ø> (ø)		Carriedforward from ebb4172

*This pull request uses carry forward flags. Click here to find out more.

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

[stale]

This pull request has been automatically marked as stale because it has not had recent activity.