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(route_handler): use start pose yaw and not lanelet length to select start lanelet #6550

Conversation

danielsanchezaran
Copy link
Contributor

@danielsanchezaran danielsanchezaran commented Mar 6, 2024

Description

Solves this issue: #6271
Currently, if the start pose of the ego overlaps several lanelets, the route handler chooses the shortest route, which might bring problem like the above linked issue. With this PR, the yaw difference between ego and lanelet is used instead.

Now with this PR, the selected start lanelet aligns better with the ego starting pose.

Examples:
image

image

Related links

#6271

Tests performed

PSim
Automated tests: TIER IV INTERNAL LINK [No degradation]

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 6, 2024
@danielsanchezaran danielsanchezaran marked this pull request as ready for review March 6, 2024 07:21
@danielsanchezaran danielsanchezaran self-assigned this Mar 6, 2024
@takayuki5168
Copy link
Contributor

Cool!

@zulfaqar-azmi-t4
Copy link
Contributor

Check the behavior and it looks good

pr_review.mp4

Copy link
Contributor

@zulfaqar-azmi-t4 zulfaqar-azmi-t4 left a comment

Choose a reason for hiding this comment

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

LGTM!

@zulfaqar-azmi-t4 zulfaqar-azmi-t4 added the run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Mar 6, 2024
@danielsanchezaran danielsanchezaran force-pushed the feat/use-yaw-to-choose-start-lanelet branch from aae6be2 to 4d45fcd Compare March 6, 2024 09:10
@danielsanchezaran danielsanchezaran enabled auto-merge (squash) March 6, 2024 09:14
Copy link

codecov bot commented Mar 6, 2024

Codecov Report

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

Project coverage is 14.79%. Comparing base (888fec6) to head (4d45fcd).
Report is 4 commits behind head on main.

Files Patch % Lines
planning/route_handler/src/route_handler.cpp 18.18% 5 Missing and 4 partials ⚠️
Additional details and impacted files
@@           Coverage Diff           @@
##             main    #6550   +/-   ##
=======================================
  Coverage   14.78%   14.79%           
=======================================
  Files        1917     1917           
  Lines      132012   132000   -12     
  Branches    39228    39226    -2     
=======================================
  Hits        19523    19523           
+ Misses      90699    90688   -11     
+ Partials    21790    21789    -1     
Flag Coverage Δ *Carryforward flag
differential 15.06% <18.18%> (?)
total 14.78% <ø> (+<0.01%) ⬆️ Carriedforward from 888fec6

*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 81d5374 into autowarefoundation:main Mar 6, 2024
24 checks passed
@danielsanchezaran danielsanchezaran deleted the feat/use-yaw-to-choose-start-lanelet branch March 6, 2024 11:22
zulfaqar-azmi-t4 added a commit to zulfaqar-azmi-t4/autoware.universe that referenced this pull request Mar 7, 2024
HansRobo pushed a commit that referenced this pull request Mar 12, 2024
…ect start lanelet (#6550)

use start pose yaw  and not lanelet length to select start lanelet

Signed-off-by: Daniel Sanchez <[email protected]>
Signed-off-by: Kotaro Yoshimoto <[email protected]>
kaigohirao pushed a commit to kaigohirao/autoware.universe that referenced this pull request Mar 22, 2024
…ect start lanelet (autowarefoundation#6550)

use start pose yaw  and not lanelet length to select start lanelet

Signed-off-by: Daniel Sanchez <[email protected]>
Signed-off-by: kaigohirao <[email protected]>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request Jun 3, 2024
…ect start lanelet (autowarefoundation#6550)

use start pose yaw  and not lanelet length to select start lanelet

Signed-off-by: Daniel Sanchez <[email protected]>
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.

3 participants