fix(goal_planner): fix waiting approval path of backward parking #10015
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Description
due to #9829, the waiting approval path is cut to original goal, but this is intended for ARC_BACKWARD.
when using ARC_BACKWARD, the start pose of parking is after goal pose, so the path should be generated to the start pose
before
stuck with arc_backward
after
works with arc_backward
no problem with shift too
Related links
Parent Issue:
How was this PR tested?
psim
2025/01/24 https://evaluation.tier4.jp/evaluation/reports/bfe6f4b8-3f63-5172-aa67-3f143be862fe/?project_id=prd_jt
Notes for reviewers
None.
Interface changes
None.
Effects on system behavior
None.