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(goal_planner): prioritize goals before objects to avoid #5137

Merged
merged 1 commit into from
Sep 28, 2023

Conversation

kosuke55
Copy link
Contributor

@kosuke55 kosuke55 commented Sep 26, 2023

Description

prioritize goals before objects to avoid.
gray numbers are the number of objects to avoid

object not to avoid

image

object to avoid

image

image

image

goal_search_avoidance_objects-2023-09-26_16.12.00.mp4

Related links

none

Tests performed

psim

2023/09/27 https://evaluation.tier4.jp/evaluation/reports/d7c68b5d-3232-5881-8f18-71c2203f11b3/?project_id=prd_jt

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.

@github-actions github-actions bot added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Sep 26, 2023
@kosuke55 kosuke55 added the run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Sep 26, 2023
@kosuke55 kosuke55 force-pushed the feat/goal_priority_behind_objects branch from a863a00 to d8e27da Compare September 26, 2023 07:23
@kosuke55
Copy link
Contributor Author

kosuke55 commented Sep 26, 2023

need to update path priority too.

  const auto pull_over_path_candidates = pull_over_path_candidates_;
  const auto goal_candidates = goal_candidates_;

image

@codecov
Copy link

codecov bot commented Sep 26, 2023

Codecov Report

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

Comparison is base (3731fd0) 14.87% compared to head (8e85385) 14.86%.
Report is 7 commits behind head on main.

Additional details and impacted files
@@            Coverage Diff             @@
##             main    #5137      +/-   ##
==========================================
- Coverage   14.87%   14.86%   -0.01%     
==========================================
  Files        1627     1627              
  Lines      112557   112632      +75     
  Branches    34744    34784      +40     
==========================================
+ Hits        16743    16744       +1     
- Misses      77064    77133      +69     
- Partials    18750    18755       +5     
Flag Coverage Δ *Carryforward flag
differential 12.48% <2.56%> (?)
total 14.87% <ø> (+<0.01%) ⬆️ Carriedforward from 3731fd0

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

Files Coverage Δ
...clude/autoware_auto_tf2/tf2_autoware_auto_msgs.hpp 100.00% <ø> (ø)
...clude/trajectory_follower_node/controller_node.hpp 100.00% <ø> (ø)
...l/trajectory_follower_node/src/controller_node.cpp 38.18% <ø> (ø)
control/vehicle_cmd_gate/src/vehicle_cmd_gate.cpp 24.47% <ø> (ø)
control/vehicle_cmd_gate/src/vehicle_cmd_gate.hpp 0.00% <ø> (ø)
...ion/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp 0.00% <ø> (ø)
.../scene_module/goal_planner/goal_planner_module.hpp 0.00% <ø> (ø)
...vior_velocity_out_of_lane_module/src/decisions.cpp 1.13% <ø> (+0.03%) ⬆️
...ut_of_lane_module/src/filter_predicted_objects.hpp 10.00% <ø> (+0.47%) ⬆️
planning/behavior_velocity_planner/src/node.cpp 26.69% <ø> (ø)
... and 27 more

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

@kosuke55 kosuke55 force-pushed the feat/goal_priority_behind_objects branch from d8e27da to 4d67fdf Compare September 27, 2023 04:30
@github-actions github-actions bot added the type:documentation Creating or refining documentation. (auto-assigned) label Sep 27, 2023
@kosuke55
Copy link
Contributor Author

#5137 (comment)
fixed
image

@kosuke55 kosuke55 force-pushed the feat/goal_priority_behind_objects branch 2 times, most recently from 60ad986 to e2612f8 Compare September 27, 2023 08:43
Signed-off-by: kosuke55 <[email protected]>

sort path priority

Signed-off-by: kosuke55 <[email protected]>

update docs

Signed-off-by: kosuke55 <[email protected]>

typo

Signed-off-by: kosuke55 <[email protected]>
@kosuke55 kosuke55 force-pushed the feat/goal_priority_behind_objects branch from e2612f8 to 8e85385 Compare September 27, 2023 08:56
void update(GoalCandidates & goal_candidates) const override;

private:
void countObjectsToAvoid(
Copy link
Contributor

Choose a reason for hiding this comment

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

[NITS] countObjectsToPass is more intuitive for me.

@kyoichi-sugahara
Copy link
Contributor

smart!

Copy link
Contributor

@kyoichi-sugahara kyoichi-sugahara left a comment

Choose a reason for hiding this comment

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

LGTM!
launch change is not necessary?

@kosuke55
Copy link
Contributor Author

@kosuke55 kosuke55 merged commit 639d5c0 into main Sep 28, 2023
@kosuke55 kosuke55 deleted the feat/goal_priority_behind_objects branch September 28, 2023 00:14
kosuke55 added a commit to tier4/autoware.universe that referenced this pull request Oct 3, 2023
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) type:documentation Creating or refining documentation. (auto-assigned)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants