-
Notifications
You must be signed in to change notification settings - Fork 682
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
fix(no_stopping_area): fix stopping in front of a no stopping area in parking on the shoulder #6517
Conversation
I'm checking this with scenario simulator. |
Codecov ReportAttention: Patch coverage is
Additional details and impacted files@@ Coverage Diff @@
## main #6517 +/- ##
=======================================
Coverage 14.80% 14.80%
=======================================
Files 1917 1917
Lines 131915 131898 -17
Branches 39202 39196 -6
=======================================
- Hits 19524 19523 -1
+ Misses 90609 90591 -18
- Partials 21782 21784 +2
*This pull request uses carry forward flags. Click here to find out more. ☔ View full report in Codecov by Sentry. |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
LGTM
… parking on the shoulder (#6517) * fix stopping in front of a no stopping area in ego vehicle parking on the shoulder * style(pre-commit): autofix --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Kotaro Yoshimoto <pythagora.yoshimoto@gmail.com>
… parking on the shoulder (autowarefoundation#6517) * fix stopping in front of a no stopping area in ego vehicle parking on the shoulder * style(pre-commit): autofix --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
… parking on the shoulder (autowarefoundation#6517) * fix stopping in front of a no stopping area in ego vehicle parking on the shoulder * style(pre-commit): autofix --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
… area in parking on the shoulder (autowarefoundation#6517)" This reverts commit 144b9c7.
… area in parking on the shoulder (autowarefoundation#6517)" This reverts commit 144b9c7.
… area in parking on the shoulder (autowarefoundation#6517)" This reverts commit 144b9c7.
… area in parking on the shoulder (autowarefoundation#6517)" This reverts commit 144b9c7.
… detected stop lines are goals (#7280) * Revert "fix(no_stopping_area): fix stopping in front of a no stopping area in parking on the shoulder (#6517)" This reverts commit 144b9c7. * if the stop point is near goal(distance < 1m), no stopping area module does not insert stop line * style(pre-commit): autofix * Update planning/behavior_velocity_no_stopping_area_module/src/scene_no_stopping_area.cpp --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Shumpei Wakabayashi <42209144+shmpwk@users.noreply.github.com> Co-authored-by: kosuke55 <kosuke.tnp@gmail.com>
… detected stop lines are goals (autowarefoundation#7280) * Revert "fix(no_stopping_area): fix stopping in front of a no stopping area in parking on the shoulder (autowarefoundation#6517)" This reverts commit 144b9c7. * if the stop point is near goal(distance < 1m), no stopping area module does not insert stop line * style(pre-commit): autofix * Update planning/behavior_velocity_no_stopping_area_module/src/scene_no_stopping_area.cpp --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Shumpei Wakabayashi <42209144+shmpwk@users.noreply.github.com> Co-authored-by: kosuke55 <kosuke.tnp@gmail.com>
… detected stop lines are goals (autowarefoundation#7280) * Revert "fix(no_stopping_area): fix stopping in front of a no stopping area in parking on the shoulder (autowarefoundation#6517)" This reverts commit 144b9c7. * if the stop point is near goal(distance < 1m), no stopping area module does not insert stop line * style(pre-commit): autofix * Update planning/behavior_velocity_no_stopping_area_module/src/scene_no_stopping_area.cpp --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Shumpei Wakabayashi <42209144+shmpwk@users.noreply.github.com> Co-authored-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Simon Eisenmann <simon.eisenmann@driveblocks.ai>
… detected stop lines are goals (#7280) * Revert "fix(no_stopping_area): fix stopping in front of a no stopping area in parking on the shoulder (#6517)" This reverts commit 144b9c7. * if the stop point is near goal(distance < 1m), no stopping area module does not insert stop line * style(pre-commit): autofix * Update planning/behavior_velocity_no_stopping_area_module/src/scene_no_stopping_area.cpp --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Shumpei Wakabayashi <42209144+shmpwk@users.noreply.github.com> Co-authored-by: kosuke55 <kosuke.tnp@gmail.com>
Description
In the current path planning and in the no stopping area module, there is a margin after a no stopping area so that the ego vehicle can’t stop right behind the no stopping areas.
For example, if the distance from the goal position to the end of the no stopping area is shorter than 2.6 m, in the case of the medium size car with the rear overhang about 0.85 m, the ego vehicle can not enter into the no stopping area, which is problematic.
The details of the problem are described in the JIRA Ticket : https://tier4.atlassian.net/browse/RT1-5039
To resolve this problem, I added the following 2 changes to the source file of the no stopping area module.
Deletion of the 3 lines ( L327-L329 of the old file ).
This sets the index value from which to start the search of
ego_area_end_idx
to beego_area_start_idx
. This is for the consistency with the second modification.Insertion of the 2 lines inside the if block ( L339-L343 of the new file).
This sets the
ego_area_end_idx
to be the last index of theinterpolated_path
whose corresponding point position is inside the no_stopping_area.Note: because of this change, the
dist_from_area_sum
variable is not used any more and also the related calculations are unnecessary. Please make sure that this code file situation will be resolved in the future refactoring, after a consideration on whether or not the margin after no stopping areas should be taken.Tests performed
I compared the movies of parking on the shoulder near the no stopping area by the cross walk before and after the changes.
The movies are shown in the JIRA Ticket : https://tier4.atlassian.net/browse/RT1-5039.
Effects on system behavior
After the changes, the ego vehicle passes through the no stopping area and stops at the goal right behind the no stopping area.
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.