fix(behavior_path_planner): fix the calculation of prepare length #1479
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.
Signed-off-by: tomoya.kimura tomoya.kimura@tier4.jp
Description
In the current implementation, lane_change_prepare_length is proportional to current speed. So, when the vehicle is stopped, lane_change_prepare_length is also 0.
As a result, there are cases that lane-change lanes cannot be searched sufficiently and then a lane change candidate route does not appear.
Fixed this issue by setting a minimum distance to lane_change_prepare_length
Before:
https://user-images.githubusercontent.com/59680180/182078036-47d30538-ec96-4b97-b55e-de3348819231.mp4
After:
https://user-images.githubusercontent.com/59680180/182078023-39006b2b-b9c0-481f-9f3a-d92de7ed7a88.mp4
Pre-review checklist for the PR author
The PR author must check the checkboxes below when creating the PR.
In-review checklist for the PR reviewers
The PR reviewers must check the checkboxes below before approval.
Post-review checklist for the PR author
The PR author must check the checkboxes below before merging.
After all checkboxes are checked, anyone who has write access can merge the PR.