Skip to content
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

kyoichi-sugahara
Copy link
Contributor

@kyoichi-sugahara kyoichi-sugahara commented Jan 30, 2024

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.

  • There are no open discussions or they are tracked via tickets.

After all checkboxes are checked, anyone who has write access can merge the PR.

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
…terLane() function

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
@github-actions github-actions bot added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Jan 30, 2024
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);
Copy link
Contributor

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

Copy link
Contributor

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

Copy link
Contributor

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

Copy link
Contributor Author

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

kyoichi-sugahara and others added 2 commits January 31, 2024 17:31
…module.cpp

Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
…module.cpp

Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
@kyoichi-sugahara kyoichi-sugahara added the tag:run-build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Jan 31, 2024
Copy link

codecov bot commented Feb 1, 2024

Codecov Report

Attention: 20 lines in your changes are missing coverage. Please review.

Comparison is base (25bc636) 14.39% compared to head (c0408f8) 14.54%.
Report is 19 commits behind head on main.

Files Patch % Lines
..._start_planner_module/src/start_planner_module.cpp 0.00% 20 Missing ⚠️
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     
Flag Coverage Δ *Carryforward flag
differential 0.00% <0.00%> (?)
total 14.58% <ø> (+0.18%) ⬆️ Carriedforward from db637bb

*This pull request uses carry forward flags. Click here to find out more.

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

@kyoichi-sugahara kyoichi-sugahara merged commit 74d106e into autowarefoundation:main Feb 1, 2024
38 of 41 checks passed
@kyoichi-sugahara kyoichi-sugahara deleted the feat/disable_safety_check_overlap_polygon branch February 1, 2024 03:27
kyoichi-sugahara added a commit to kyoichi-sugahara/autoware.universe that referenced this pull request Feb 1, 2024
…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 <kyoichi.sugahara@tier4.jp>

---------

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request Jun 3, 2024
…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 <kyoichi.sugahara@tier4.jp>

---------

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:planning Route planning, decision-making, and navigation. (auto-assigned) tag:run-build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants