fix(obstacle_avoidance_planner): fix inf loop in mpt

[takayuki5168]

Signed-off-by: Takayuki Murooka takayuki5168@gmail.com

Description

fix inf loop in mpt because of diverged elastic band

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

Base: 10.35% // Head: 10.41% // Increases project coverage by +0.06% 🎉

Coverage data is based on head (3e80e63) compared to base (7e2370d).
Patch coverage: 0.00% of modified lines in pull request are covered.

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #1881      +/-   ##
==========================================
+ Coverage   10.35%   10.41%   +0.06%     
==========================================
  Files        1159     1232      +73     
  Lines       76241    88077   +11836     
  Branches    18730    20428    +1698     
==========================================
+ Hits         7895     9174    +1279     
- Misses      59481    69569   +10088     
- Partials     8865     9334     +469     

Flag	Coverage Δ		*Carryforward flag
differential	0.00% <0.00%> (?)
total	10.41% <0.00%> (+0.06%)	⬆️	Carriedforward from ce3ecfb

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

Impacted Files	Coverage Δ
planning/obstacle_avoidance_planner/src/node.cpp	0.00% <0.00%> (ø)
...lude/freespace_planning_algorithms/reeds_shepp.hpp	50.00% <0.00%> (-50.00%)	⬇️
...tic_evaluator/include/kinematic_evaluator/stat.hpp	62.50% <0.00%> (-19.32%)	⬇️
..._evaluator/include/localization_evaluator/stat.hpp	56.25% <0.00%> (-16.48%)	⬇️
...vehicle_model/sim_model_ideal_steer_acc_geared.cpp	73.58% <0.00%> (-9.44%)	⬇️
.../src/vehicle/test_vehicle_state_checker_helper.hpp	70.58% <0.00%> (-9.42%)	⬇️
planning/behavior_path_planner/test/input.cpp	60.00% <0.00%> (-7.86%)	⬇️
...city_planner/include/utilization/state_machine.hpp	31.03% <0.00%> (-7.07%)	⬇️
common/perception_utils/src/perception_utils.cpp	56.75% <0.00%> (-6.88%)	⬇️
...include/motion_utils/trajectory/tmp_conversion.hpp	60.00% <0.00%> (-6.67%)	⬇️
... and 854 more

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 at Codecov.
📢 Do you have feedback about the report comment? Let us know in this issue.

[h-ohta]

LGTM