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

fix(behavior_path_planner): fix path distortion of no back pull out #2829

Merged
merged 2 commits into from
Feb 7, 2023

Conversation

kosuke55
Copy link
Contributor

@kosuke55 kosuke55 commented Feb 7, 2023

Signed-off-by: kosuke55 kosuke.tnp@gmail.com

Description

Fix path distortion of pull out path when backward driving is disabled.
The geometric pull out assumes that the start pose and the end pose is in parallel, but when backward driving is disabled the raw current pose is used as start pose and is not refined. In this PR, the current pose is refined to the lane for the start pose.
And add a guard for discontinuity.

image

Related links

tier4 intenal link

Tests performed

psim

how to reproduce the problem

  • disable backward driving
  • disable shift pull out
  • put ego veicle not in parallel to the lane

image

Notes for reviewers

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.

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
@github-actions github-actions bot added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Feb 7, 2023
@codecov
Copy link

codecov bot commented Feb 7, 2023

Codecov Report

Base: 11.61% // Head: 11.60% // Decreases project coverage by -0.02% ⚠️

Coverage data is based on head (75ef89c) compared to base (c1c4ab5).
Patch coverage: 0.00% of modified lines in pull request are covered.

Additional details and impacted files
@@            Coverage Diff             @@
##             main    #2829      +/-   ##
==========================================
- Coverage   11.61%   11.60%   -0.02%     
==========================================
  Files        1319     1319              
  Lines       92107    92253     +146     
  Branches    24425    24544     +119     
==========================================
  Hits        10702    10702              
- Misses      70233    70378     +145     
- Partials    11172    11173       +1     
Flag Coverage Δ *Carryforward flag
differential 4.69% <0.00%> (?)
total 11.61% <0.00%> (ø) Carriedforward from 45687ad

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

Impacted Files Coverage Δ
..._planner/scene_module/pull_out/pull_out_module.hpp 0.00% <ø> (ø)
...nner/src/scene_module/pull_out/pull_out_module.cpp 0.00% <0.00%> (ø)
.../scene_module/utils/geometric_parallel_parking.cpp 0.00% <0.00%> (ø)

Help us with your feedback. Take ten seconds to tell us how you rate us. Have a feature suggestion? Share it here.

☔ View full report at Codecov.
📢 Do you have feedback about the report comment? Let us know in this issue.

Copy link
Contributor

@tkimura4 tkimura4 left a comment

Choose a reason for hiding this comment

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

LGTM

@tkimura4 tkimura4 merged commit eb782af into autowarefoundation:main Feb 7, 2023
@tkimura4 tkimura4 deleted the fix/pull_out_no_back branch February 7, 2023 17:26
tkimura4 pushed a commit to tier4/autoware.universe that referenced this pull request Feb 7, 2023
…utowarefoundation#2829)

* fix(behavior_path_planner): fix path distortion of no back pull out

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Update planning/behavior_path_planner/src/scene_module/utils/geometric_parallel_parking.cpp

---------

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>
tkimura4 added a commit to tier4/autoware.universe that referenced this pull request Feb 8, 2023
…utowarefoundation#2829) (#273)

* fix(behavior_path_planner): fix path distortion of no back pull out



* Update planning/behavior_path_planner/src/scene_module/utils/geometric_parallel_parking.cpp

---------

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
Signed-off-by: tomoya.kimura <tomoya.kimura@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)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants