fix(behavior_path_planner): fix distance from original goal of goal search

[kosuke55]

Description

Considering the curved lane, the pose moved laterally should have the same longitudinal distance as the original pose.

Related links

Tests performed

psim

Notes for reviewers

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 has no change and project coverage change: -0.02 ⚠️

Comparison is base (50916f9) 12.41% compared to head (80478ff) 12.39%.

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #3270      +/-   ##
==========================================
- Coverage   12.41%   12.39%   -0.02%     
==========================================
  Files        1364     1364              
  Lines       95157    95723     +566     
  Branches    27076    27497     +421     
==========================================
+ Hits        11810    11869      +59     
- Misses      70922    71367     +445     
- Partials    12425    12487      +62     

Flag	Coverage Δ		*Carryforward flag
differential	5.58% <0.00%> (?)
total	12.41% <ø> (+<0.01%)	⬆️	Carriedforward from 50916f9

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

Impacted Files	Coverage Δ
..._path_planner/src/util/pull_over/goal_searcher.cpp	0.00% <0.00%> (ø)

... and 2 files with indirect coverage changes

Help us with your feedback. Take ten seconds to tell us how you rate us. Have a feature suggestion? Share it here.

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