fix: path distance calculator

[tkimura4]

Signed-off-by: tomoya.kimura tomoya.kimura@tier4.jp

Description

When the size of path is 1, path distance calculator died with following messages.

[path_distance_calculator_node-42] terminate called after throwing an instance of 'std::out_of_range'
[path_distance_calculator_node-42]   what():  vector::_M_range_check: __n (which is 1) >= this->size() (which is 1)

I fixed it.

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

Merging #975 (060dabd) into main (3537ec1) will decrease coverage by 0.00%.
The diff coverage is 0.00%.

@@           Coverage Diff            @@
##            main    #975      +/-   ##
========================================
- Coverage   9.56%   9.56%   -0.01%     
========================================
  Files        941     941              
  Lines      58230   58233       +3     
  Branches   10577   10577              
========================================
  Hits        5572    5572              
- Misses     47941   47944       +3     
  Partials    4717    4717              

Flag	Coverage Δ		*Carryforward flag
differential	0.00% <0.00%> (?)
total	9.56% <0.00%> (ø)		Carriedforward from 3537ec1

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

Impacted Files	Coverage Δ
...stance_calculator/src/path_distance_calculator.cpp	0.00% <0.00%> (ø)

---

Continue to review full report at Codecov.

Legend - Click here to learn more
Δ = absolute <relative> (impact), ø = not affected, ? = missing data
Powered by Codecov. Last update 3537ec1...060dabd. Read the comment docs.

[taikitanaka3]

LGTM