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): move collision check to plan method #6564

Conversation

danielsanchezaran
Copy link
Contributor

@danielsanchezaran danielsanchezaran commented Mar 7, 2024

Description

Currently, collision checking is done AFTER the geometric and shift pull out planners have decided on a candidate output path. The result is that, a path that is collided might be chosen as an output path and then eliminated by the collision checking.

With this PR, the collision checking is moved inside the planners themselves, so, especially in the case of shift pull out, if a candidate path has a collision with a target object, it might generate a different path that is inside lanes and not collided.

Further description here: TIER IV INTERNAL LINK
Related ticket: TIER IV INTERNAL LINK

Related links

Further description here: TIER IV INTERNAL LINK
Related ticket: TIER IV INTERNAL LINK

Tests performed

PSim
Evaluator tests: TIER IV INTERNAL LINK

Notes for reviewers

Interface changes

Effects on system behavior

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.

  • The PR follows the pull request guidelines.
  • The PR has been properly tested.
  • The PR has been reviewed by the code owners.

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.
  • The PR is ready for merge.

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

@github-actions github-actions bot added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Mar 7, 2024
@danielsanchezaran danielsanchezaran force-pushed the feat/move-collision-check-to-plan-method branch from b0906dd to 3e9e09b Compare March 7, 2024 09:18
@danielsanchezaran danielsanchezaran marked this pull request as ready for review March 7, 2024 09:23
@danielsanchezaran danielsanchezaran force-pushed the feat/move-collision-check-to-plan-method branch 2 times, most recently from 24cf39c to 1ffc675 Compare March 10, 2024 23:43
@github-actions github-actions bot added the component:control Vehicle control algorithms and mechanisms. (auto-assigned) label Mar 10, 2024
@danielsanchezaran danielsanchezaran force-pushed the feat/move-collision-check-to-plan-method branch from 1ffc675 to 19875b6 Compare March 12, 2024 02:26
@github-actions github-actions bot removed the component:control Vehicle control algorithms and mechanisms. (auto-assigned) label Mar 12, 2024
@danielsanchezaran danielsanchezaran force-pushed the feat/move-collision-check-to-plan-method branch 2 times, most recently from 38a37c9 to f4b97c1 Compare March 14, 2024 03:20
Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>
Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>
Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>
@danielsanchezaran danielsanchezaran force-pushed the feat/move-collision-check-to-plan-method branch from f4b97c1 to 7b13db6 Compare March 14, 2024 23:31
Copy link
Contributor

@kyoichi-sugahara kyoichi-sugahara left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

LGTM!
Thanks!

@danielsanchezaran danielsanchezaran added the run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Mar 15, 2024
@danielsanchezaran danielsanchezaran enabled auto-merge (squash) March 15, 2024 23:13
Copy link

codecov bot commented Mar 15, 2024

Codecov Report

Attention: Patch coverage is 0% with 34 lines in your changes are missing coverage. Please review.

Project coverage is 14.78%. Comparing base (6ee9627) to head (7b13db6).
Report is 9 commits behind head on main.

Files Patch % Lines
...ath_start_planner_module/pull_out_planner_base.hpp 0.00% 14 Missing ⚠️
...ng/behavior_path_start_planner_module/src/util.cpp 0.00% 14 Missing ⚠️
...r_path_start_planner_module/src/shift_pull_out.cpp 0.00% 2 Missing ⚠️
...r_path_start_planner_module/freespace_pull_out.hpp 0.00% 1 Missing ⚠️
...r_path_start_planner_module/geometric_pull_out.hpp 0.00% 1 Missing ⚠️
...avior_path_start_planner_module/shift_pull_out.hpp 0.00% 1 Missing ⚠️
...th_start_planner_module/src/geometric_pull_out.cpp 0.00% 1 Missing ⚠️
Additional details and impacted files
@@            Coverage Diff             @@
##             main    #6564      +/-   ##
==========================================
- Coverage   14.79%   14.78%   -0.01%     
==========================================
  Files        1920     1920              
  Lines      132398   132405       +7     
  Branches    39345    39345              
==========================================
  Hits        19582    19582              
- Misses      90970    90977       +7     
  Partials    21846    21846              
Flag Coverage Δ *Carryforward flag
differential 0.00% <0.00%> (?)
total 14.79% <ø> (+<0.01%) ⬆️ Carriedforward from 6ee9627

*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.

@danielsanchezaran danielsanchezaran merged commit e1d19d6 into autowarefoundation:main Mar 15, 2024
34 of 37 checks passed
@danielsanchezaran danielsanchezaran deleted the feat/move-collision-check-to-plan-method branch March 15, 2024 23:50
kaigohirao pushed a commit to kaigohirao/autoware.universe that referenced this pull request Mar 22, 2024
…ndation#6564)

* move collision check to a member function of planner base

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>

* refactor

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>

* add empty polygon and point checks

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>

---------

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>
Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request Jun 3, 2024
…ndation#6564)

* move collision check to a member function of planner base

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>

* refactor

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>

* add empty polygon and point checks

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>

---------

Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>
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) 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