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): apply offset colission check section #5982

Conversation

kyoichi-sugahara
Copy link
Contributor

@kyoichi-sugahara kyoichi-sugahara commented Dec 27, 2023

Description

this PR should be merged first

offset the collision check section based on shift end pose.
collision check against static objects are executed in the collision check section.

image

ignore section's lenght is controlled by parameter of
collision_check_distance_from_end

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>
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
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 Dec 27, 2023
@kyoichi-sugahara kyoichi-sugahara marked this pull request as ready for review December 27, 2023 10:40
@kyoichi-sugahara kyoichi-sugahara added the tag:run-build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Dec 28, 2023
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
@kyoichi-sugahara kyoichi-sugahara force-pushed the feat/apply_offset_colission_check_segment branch from 50ee603 to 3708271 Compare December 28, 2023 10:42
Comment on lines 951 to 954
PredictedObjects StartPlannerModule::filterStopObjectsInShoulderLanes(
const lanelet::ConstLanelets & shoulder_lanes, const geometry_msgs::msg::Point & current_point,
const double velocity_threshold, const double object_check_forward_distance,
const double object_check_backward_distance) const
Copy link
Contributor

Choose a reason for hiding this comment

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

pull out lanes will be road lanes not just shoulder lanes.

Copy link
Contributor

Choose a reason for hiding this comment

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

so, better to change function and args name

Copy link
Contributor Author

Choose a reason for hiding this comment

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

changed in 365b4f9

return motion_utils::findNearestIndex(
combined_path.points, collision_check_end_pose->position);
} else {
return combined_path.points.size() - 1;
Copy link
Contributor

Choose a reason for hiding this comment

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

Suggested change
return combined_path.points.size() - 1;
return 0;

is reasonable?

Copy link
Contributor

Choose a reason for hiding this comment

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

or nullopt?

Copy link
Contributor Author

Choose a reason for hiding this comment

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

changed in 6839191

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
…module.cpp

Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
Copy link
Contributor

@kosuke55 kosuke55 left a comment

Choose a reason for hiding this comment

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

LGTM!!

@kyoichi-sugahara kyoichi-sugahara enabled auto-merge (squash) December 28, 2023 12:52
Copy link

codecov bot commented Dec 28, 2023

Codecov Report

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

Comparison is base (a188ee6) 15.24% compared to head (04b5312) 15.24%.

Files Patch % Lines
..._start_planner_module/src/start_planner_module.cpp 0.00% 15 Missing ⚠️
Additional details and impacted files
@@            Coverage Diff             @@
##             main    #5982      +/-   ##
==========================================
- Coverage   15.24%   15.24%   -0.01%     
==========================================
  Files        1750     1750              
  Lines      120675   120681       +6     
  Branches    36715    36715              
==========================================
  Hits        18394    18394              
- Misses      81640    81646       +6     
  Partials    20641    20641              
Flag Coverage Δ *Carryforward flag
differential 0.00% <0.00%> (?)
total 15.24% <ø> (+<0.01%) ⬆️ Carriedforward from a188ee6

*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 dd1579e into autowarefoundation:main Dec 28, 2023
23 of 26 checks passed
@kyoichi-sugahara kyoichi-sugahara deleted the feat/apply_offset_colission_check_segment branch December 28, 2023 15:34
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request May 26, 2024
…undation#5982)

refactor collision check in GeometricPullOut::plan()

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request May 28, 2024
…undation#5982)

refactor collision check in GeometricPullOut::plan()

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request May 28, 2024
…undation#5982)

refactor collision check in GeometricPullOut::plan()

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request Jun 3, 2024
…undation#5982)

refactor collision check in GeometricPullOut::plan()

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@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) 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