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): pull over remove overlapping points #2246

Merged

Conversation

kosuke55
Copy link
Contributor

@kosuke55 kosuke55 commented Nov 8, 2022

Description

If giving a path point without lane id to removeOverlappingPoints, node dies by accessing lane_ids in https://github.com/autowarefoundation/autoware.universe/blob/feat/shift_pull_over_on_curve/planning/behavior_path_planner/src/utilities.cpp#L894
In this PR, I stoppped using this function, insert point by checking it is not overlapped.

Related links

Tests performed

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>
@codecov
Copy link

codecov bot commented Nov 8, 2022

Codecov Report

Base: 11.12% // Head: 11.17% // Increases project coverage by +0.04% 🎉

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

Additional details and impacted files
@@            Coverage Diff             @@
##             main    #2246      +/-   ##
==========================================
+ Coverage   11.12%   11.17%   +0.04%     
==========================================
  Files        1200     1199       -1     
  Lines       86198    85845     -353     
  Branches    20793    20793              
==========================================
  Hits         9593     9593              
+ Misses      66479    66126     -353     
  Partials    10126    10126              
Flag Coverage Δ *Carryforward flag
differential 3.58% <0.00%> (?)
total 11.15% <0.00%> (+0.04%) ⬆️ Carriedforward from 15e7071

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

Impacted Files Coverage Δ
.../scene_module/utils/geometric_parallel_parking.cpp 0.00% <0.00%> (ø)
perception/tensorrt_yolo/src/nodelet.cpp 0.00% <0.00%> (ø)
perception/lidar_centerpoint/src/node.cpp 0.00% <0.00%> (ø)
planning/rtc_interface/src/rtc_interface.cpp 0.00% <0.00%> (ø)
perception/tensorrt_yolo/lib/src/trt_yolo.cpp 0.00% <0.00%> (ø)
...erception/tensorrt_yolo/lib/include/calibrator.hpp 0.00% <0.00%> (ø)
...erception/tensorrt_yolo/lib/include/cuda_utils.hpp 0.00% <0.00%> (ø)
...erception/traffic_light_classifier/src/nodelet.cpp 0.00% <0.00%> (ø)
...tion/traffic_light_classifier/utils/trt_common.cpp 0.00% <0.00%> (ø)
...on/lidar_apollo_instance_segmentation/src/node.cpp 0.00% <0.00%> (ø)
... and 44 more

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.

@@ -482,9 +482,12 @@ PathWithLaneId GeometricParallelParking::generateArcPath(

// insert the last point exactly
const auto p = generateArcPathPoint(center, radius, end_yaw, is_left_turn, is_forward);
path.points.push_back(p);
constexpr double min_dist = 0.01;
if (calcDistance2d(path.points.back(), p) > min_dist) {
Copy link
Contributor

Choose a reason for hiding this comment

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

Do path.points.empty() check before using the path.points.back()

Copy link
Contributor Author

Choose a reason for hiding this comment

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

thaks, fixed in 7ad01a0

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

@purewater0901 purewater0901 left a comment

Choose a reason for hiding this comment

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

LGTM

@kosuke55 kosuke55 merged commit f1efcc2 into autowarefoundation:main Nov 9, 2022
@kosuke55 kosuke55 deleted the fix/pull_over_remove_overlapping_point branch November 9, 2022 05:09
HansRobo pushed a commit to HansRobo/autoware.universe that referenced this pull request Dec 16, 2022
…warefoundation#2246)

* fix(behavior_path_planner): pull over remove overlapping points

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

* check empty

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

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
Signed-off-by: Kotaro Yoshimoto <pythagora.yoshimoto@gmail.com>
YoshiRi pushed a commit to YoshiRi/autoware.universe that referenced this pull request Jan 11, 2023
…warefoundation#2246)

* fix(behavior_path_planner): pull over remove overlapping points

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

* check empty

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

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants