fix(out_of_lane): calculate path lanelets that we can miss during a lane change

[maxime-clem]

Description

path_lanelets are not considered for overlaps in the out_of_lane. They are currently calculated as all the lanelets crossed by the ego path linestring.
In some lane change edge cases, the ego path linestring does not cross a lanelet but the ego footprint will overlap the lanelet, possibly causing the out_of_lane module to detect a collision and cause a stop.

With this PR, a function to add the missing lane change lanelets is added.

Illustration of the issue

In the following picture, the lane changing path (green) overlaps the 4 lanelets, but the current path_lanelets only includes 3 lanelets (in blue). With this PR, all 4 lanelets are correctly found.

Tests performed

Psim
Evaluator (TIER IV INTERNAL LINK): https://evaluation.tier4.jp/evaluation/reports/tables/new?catalog_id=095ae8b3-a23b-4a08-8674-10a681449693&filter=&job_id=f10ea9b0-4317-557e-99d6-c0648cc11dcd&project_id=prd_jt&table_config=date

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.

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 45.83333% with 13 lines in your changes are missing coverage. Please review.

Project coverage is 14.80%. Comparing base (b7fdccc) to head (905f170).
Report is 2 commits behind head on main.

Files	Patch %	Lines
...city_out_of_lane_module/src/lanelets_selection.cpp	45.83%	0 Missing and 13 partials ⚠️

Additional details and impacted files

@@           Coverage Diff           @@
##             main    #6600   +/-   ##
=======================================
  Coverage   14.79%   14.80%           
=======================================
  Files        1915     1915           
  Lines      132352   132375   +23     
  Branches    39333    39346   +13     
=======================================
+ Hits        19580    19593   +13     
+ Misses      90939    90938    -1     
- Partials    21833    21844   +11     

Flag	Coverage Δ		*Carryforward flag
differential	21.90% <45.83%> (?)
total	14.79% <ø> (+<0.01%)	⬆️	Carriedforward from b7fdccc

*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.