fix(behavior_path_planner): fix keeping terminal point

[kosuke55]

Description

If the difference between s and s_end was exactly epsilon, that point would be missing, but modified to keep it.

Related links

#3720

Tests performed

psim

Notes for reviewers

Interface changes

not applicable

Effects on system behavior

not applicable

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.
• The PR has been properly tested.
• The PR has been reviewed by the code owners.

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.
• The PR is ready for merge.

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

[codecov]

Codecov Report

Patch coverage: 75.00% and project coverage change: -0.04 ⚠️

Comparison is base (98169fe) 14.11% compared to head (1d2d9aa) 14.08%.

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #3813      +/-   ##
==========================================
- Coverage   14.11%   14.08%   -0.04%     
==========================================
  Files        1438     1438              
  Lines      101445   101898     +453     
  Branches    27021    27355     +334     
==========================================
+ Hits        14318    14351      +33     
- Misses      71446    71841     +395     
- Partials    15681    15706      +25     

Flag	Coverage Δ		*Carryforward flag
differential	13.17% <75.00%> (?)
total	14.11% <ø> (-0.01%)	⬇️	Carriedforward from 98169fe

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

Impacted Files	Coverage Δ
...ing/behavior_path_planner/src/utils/path_utils.cpp	12.88% <75.00%> (+0.78%)	⬆️

... and 3 files with indirect coverage changes

☔ View full report in Codecov by Sentry.
📢 Do you have feedback about the report comment? Let us know in this issue.