-
Notifications
You must be signed in to change notification settings - Fork 658
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
feat(start_planner): disable safety check against dynamic objects when ego polygon overlap with centerline #6236
Conversation
Signed-off-by: kyoichi-sugahara <[email protected]>
Signed-off-by: kyoichi-sugahara <[email protected]>
…terLane() function Signed-off-by: kyoichi-sugahara <[email protected]>
Signed-off-by: kyoichi-sugahara <[email protected]>
planning/behavior_path_start_planner_module/src/start_planner_module.cpp
Outdated
Show resolved
Hide resolved
planning/behavior_path_start_planner_module/src/start_planner_module.cpp
Outdated
Show resolved
Hide resolved
for (size_t j = 0; j < vehicle_footprint.size() - 1; ++j) { | ||
const auto & p3 = tier4_autoware_utils::toMsg(vehicle_footprint[j].to_3d()); | ||
const auto & p4 = tier4_autoware_utils::toMsg(vehicle_footprint[j + 1].to_3d()); | ||
const auto intersection = tier4_autoware_utils::intersect(p1, p2, p3, p4); |
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.
how abount just check intersection of polygon and lines not giving 4 points
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.
maybe it is possible with boost geometry
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.
@kyoichi-sugahara said tier4 utils is fater
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.
@kosuke55
I'm using it because this computational cost is low
…module.cpp Co-authored-by: Kosuke Takeuchi <[email protected]>
…module.cpp Co-authored-by: Kosuke Takeuchi <[email protected]>
Codecov ReportAttention:
Additional details and impacted files@@ Coverage Diff @@
## main #6236 +/- ##
==========================================
+ Coverage 14.39% 14.54% +0.15%
==========================================
Files 1906 1874 -32
Lines 129847 127616 -2231
Branches 37572 37070 -502
==========================================
- Hits 18697 18568 -129
+ Misses 90155 88180 -1975
+ Partials 20995 20868 -127
*This pull request uses carry forward flags. Click here to find out more. ☔ View full report in Codecov by Sentry. |
74d106e
into
autowarefoundation:main
…n ego polygon overlap with centerline (autowarefoundation#6236) * disable safety check against dynamic objects when ego polygon overlap with centerline Signed-off-by: kyoichi-sugahara <[email protected]> --------- Signed-off-by: kyoichi-sugahara <[email protected]>
…n ego polygon overlap with centerline (autowarefoundation#6236) * disable safety check against dynamic objects when ego polygon overlap with centerline Signed-off-by: kyoichi-sugahara <[email protected]> --------- Signed-off-by: kyoichi-sugahara <[email protected]>
Description
The issue was
ego vehicle stops on the middle of the road when the vehicle comes from the behind.
safety check against dynamic objects after departure was enabled.
In this PR,
disabled safety check against dynamic objects when ego polygon overlap with centerline
Before change
Screencast from 2024年01月30日 20時17分28秒.webm
Ego stops against behind vehicle...
After change
Screencast from 2024年01月30日 19時51分02秒.webm
Ego doesn't stop against behind vehicle
Tests performed
Effects on system behavior
Not applicable.
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.