fix(avoidance): fix invalid vector access

[satoshi-ota]

Description

Fix invalid vector access. 🙏

Tests performed

Psim

Effects on system behavior

Nothing.

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.

[kyoichi-sugahara]

LGTM

[satoshi-ota]

🙏

[codecov]

Codecov Report

Patch coverage has no change and project coverage change: +0.01 🎉

Comparison is base (6bf539b) 15.21% compared to head (ae2352c) 15.22%.

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #4253      +/-   ##
==========================================
+ Coverage   15.21%   15.22%   +0.01%     
==========================================
  Files        1489     1489              
  Lines      102611   102543      -68     
  Branches    31524    31513      -11     
==========================================
  Hits        15611    15611              
+ Misses      70048    69979      -69     
- Partials    16952    16953       +1     

Flag	Coverage Δ		*Carryforward flag
differential	13.67% <0.00%> (?)
total	15.22% <ø> (+0.01%)	⬆️	Carriedforward from 6bf539b

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

Impacted Files	Coverage Δ
...ed_object_validation/src/object_lanelet_filter.cpp	0.00% <ø> (ø)
...dation/src/obstacle_pointcloud_based_validator.cpp	0.00% <ø> (ø)
..._validation/src/occupancy_grid_based_validator.cpp	0.00% <ø> (ø)
...ction_by_tracker/src/detection_by_tracker_core.cpp	0.00% <ø> (ø)
...heatmap_visualizer/src/heatmap_visualizer_node.cpp	0.00% <ø> (ø)
...ulti_object_tracker/tracker/model/tracker_base.hpp	0.00% <ø> (ø)
..._tracker/src/data_association/data_association.cpp	0.00% <ø> (ø)
...i_object_tracker/src/multi_object_tracker_core.cpp	0.00% <ø> (ø)
...ject_tracker/src/tracker/model/bicycle_tracker.cpp	0.00% <ø> (ø)
..._tracker/src/tracker/model/big_vehicle_tracker.cpp	0.00% <ø> (ø)
... and 23 more

... and 10 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.