fix(behavior_path_planner): use findSegment for segment search

[TakaHoribe]

Description

It should use findSegment function for the segment search, not findIndex.

Tests performed

run psim

Effects on system behavior

The following terminal log will disappear.

[component_container_mt-28] Segment index is invalid.

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.