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(route_handler): query shoulder lane in getLaneletSequence() if only_route_lanes is false and the arg is shoulder type #6567

Conversation

soblin
Copy link
Contributor

@soblin soblin commented Mar 7, 2024

Description

if the rough goal is specified on driving lane, then the leftmost shoulder lane is chosen in getLaneletSequence() function as the outermost_lane, and the shoulder lanelets before/after that shoulder lane are collected after this PR. But before this PR, since only_route_lanes is false in this case and the shoulder lanes are not included in the default RoutingGraph, the call to getLaneletSequneceAfter/getLaneletSequneceUpTo does not yield any shoulder lanes, which is the reason why the result contains only the single shoulder lane. And if the shoulder is associated with no_parking_area, then goal_planner cannot find any valid road shoulder to park.

Related links

https://tier4.atlassian.net/browse/RT1-5528

Tests performed

In the following video the goal is on the driving lane whose left side lane is a shoulder lane with no_parking_area. The goal planner successfully finds the modified goal.

RT1-5582-2024-03-07_21.20.35.mp4

Before this PR, getPullOverLanes returns only single shoulder lane, and since it is associated with no_parking_area, the goal planner could not find the modified goal.

RT1-5582-2024-03-07_21.31.52.mp4

Notes for reviewers

Interface changes

none

Effects on system behavior

none

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.

…y_route_lanes is false and the arg is shoulder

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
@github-actions github-actions bot added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Mar 7, 2024
@soblin soblin changed the title fix(route_handle): query shoulder lane in getLaneletSequence() if only_route_lanes is false and the arg is shoulder fix(route_handle): query shoulder lane in getLaneletSequence() if only_route_lanes is false and the arg is shoulder type Mar 7, 2024
@soblin soblin changed the title fix(route_handle): query shoulder lane in getLaneletSequence() if only_route_lanes is false and the arg is shoulder type fix(route_handler): query shoulder lane in getLaneletSequence() if only_route_lanes is false and the arg is shoulder type Mar 7, 2024
@soblin soblin marked this pull request as ready for review March 7, 2024 12:48
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.

nice!!! LGTM!

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

codecov bot commented Mar 7, 2024

Codecov Report

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

Project coverage is 14.79%. Comparing base (a15a37a) to head (a6508cc).
Report is 3 commits behind head on main.

Files Patch % Lines
planning/route_handler/src/route_handler.cpp 9.09% 7 Missing and 3 partials ⚠️
Additional details and impacted files
@@            Coverage Diff             @@
##             main    #6567      +/-   ##
==========================================
- Coverage   14.79%   14.79%   -0.01%     
==========================================
  Files        1917     1917              
  Lines      132145   132157      +12     
  Branches    39262    39272      +10     
==========================================
  Hits        19553    19553              
- Misses      90774    90783       +9     
- Partials    21818    21821       +3     
Flag Coverage Δ *Carryforward flag
differential 15.03% <9.09%> (?)
total 14.79% <ø> (-0.01%) ⬇️ Carriedforward from a15a37a

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

@soblin soblin merged commit edc6ef0 into autowarefoundation:main Mar 7, 2024
38 of 41 checks passed
@soblin soblin deleted the fix/route-handler/query-shoulder-if-not-only-route-lanes branch March 7, 2024 15:35
soblin added a commit to tier4/autoware.universe that referenced this pull request Mar 8, 2024
…ly_route_lanes is false and the arg is shoulder type (autowarefoundation#6567)

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
soblin added a commit to tier4/autoware.universe that referenced this pull request Mar 8, 2024
fix(route_handler): query shoulder lane in getLaneletSequence() if only_route_lanes is false and the arg is shoulder type (autowarefoundation#6567)
HansRobo pushed a commit that referenced this pull request Mar 12, 2024
…ly_route_lanes is false and the arg is shoulder type (#6567)

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
Signed-off-by: Kotaro Yoshimoto <pythagora.yoshimoto@gmail.com>
kaigohirao pushed a commit to kaigohirao/autoware.universe that referenced this pull request Mar 22, 2024
…ly_route_lanes is false and the arg is shoulder type (autowarefoundation#6567)

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
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
…ly_route_lanes is false and the arg is shoulder type (autowarefoundation#6567)

Signed-off-by: Mamoru Sobue <mamoru.sobue@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