feat(obstacle_avoidance_planner): fix can be applied to the first trajectory point

[takayuki5168]

PR Type

• Improvement

Related Links

Description

launch PR for autowarefoundation/autoware.universe#1775

Review Procedure

Remarks

Pre-Review Checklist for the PR Author

PR Author should check the checkboxes below when creating the PR.

• Code follows coding guidelines
• Assign PR to reviewer

Checklist for the PR Reviewer

Reviewers should check the checkboxes below before approval.

• Commits are properly organized and messages are according to the guideline
• Code follows coding guidelines
• (Optional) Unit tests have been written for new behavior
• PR title describes the changes

Post-Review Checklist for the PR Author

PR Author should check the checkboxes below before merging.

• All open points are addressed and tracked via issues or tickets
• Write release notes

CI Checks

• Build and test for PR: Required to pass before the merge.
• Check spelling: NOT required to pass before the merge. It is up to the reviewer(s). See here if you want to add some words to the spell check dictionary.