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): copy z in dynamic drivable area expansion #4120

Conversation

maxime-clem
Copy link
Contributor

@maxime-clem maxime-clem commented Jun 29, 2023

Description

When the drivable area is dynamically expanded, the z values were set to 0.
This PR fixes this issue by copying the z values from the original drivable area.

Tests performed

Tested in Psim

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.

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.

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 Jun 29, 2023
@maxime-clem maxime-clem marked this pull request as ready for review June 29, 2023 12:17
@codecov
Copy link

codecov bot commented Jun 29, 2023

Codecov Report

Patch coverage: 44.44% and project coverage change: +0.03 🎉

Comparison is base (9c30691) 14.35% compared to head (31d72bd) 14.38%.

Additional details and impacted files
@@            Coverage Diff             @@
##             main    #4120      +/-   ##
==========================================
+ Coverage   14.35%   14.38%   +0.03%     
==========================================
  Files        1569     1569              
  Lines      107999   107815     -184     
  Branches    31243    31257      +14     
==========================================
+ Hits        15501    15510       +9     
+ Misses      75645    75445     -200     
- Partials    16853    16860       +7     
Flag Coverage Δ *Carryforward flag
differential 13.67% <44.44%> (?)
total 14.37% <ø> (+0.02%) ⬆️ Carriedforward from 9c30691

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

Impacted Files Coverage Δ
...ion/crosswalk_traffic_light_estimator/src/node.cpp 0.00% <ø> (ø)
...nclude/traffic_light_classifier/cnn_classifier.hpp 0.00% <ø> (ø)
...lude/traffic_light_classifier/color_classifier.hpp 0.00% <ø> (ø)
...on/traffic_light_classifier/src/cnn_classifier.cpp 0.00% <ø> (ø)
.../traffic_light_classifier/src/color_classifier.cpp 0.00% <ø> (ø)
...erception/traffic_light_classifier/src/nodelet.cpp 0.00% <ø> (ø)
...assifier/src/single_image_debug_inference_node.cpp 0.00% <ø> (ø)
.../include/traffic_light_map_based_detector/node.hpp 0.00% <ø> (ø)
...tion/traffic_light_map_based_detector/src/node.cpp 0.00% <ø> (ø)
...fic_light_selector/src/traffic_light_converter.cpp 0.00% <ø> (ø)
... and 7 more

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

Comment on lines 149 to 150
const auto ratio = (s_to - s_from_prev) / (s_from - s_from_prev);
to[i_to].z = from[i_from - 1].z + ratio * (from[i_from].z - from[i_from - 1].z);
Copy link
Contributor

Choose a reason for hiding this comment

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

You can use linear interpolation library from interpolation package
https://github.com/autowarefoundation/autoware.universe/tree/main/common/interpolation

Also, I guess you have to add a guard when s_from=s_from_prev

Copy link
Contributor Author

Choose a reason for hiding this comment

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

Done: 31d72bd

Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
@maxime-clem maxime-clem force-pushed the fix/behavior_path_planner-dyn_expansion_copy_z_axis branch from 653a713 to 31d72bd Compare June 30, 2023 03:10
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

@maxime-clem maxime-clem merged commit 6744206 into autowarefoundation:main Jun 30, 2023
18 of 21 checks passed
@maxime-clem maxime-clem deleted the fix/behavior_path_planner-dyn_expansion_copy_z_axis branch June 30, 2023 09:00
mkuri pushed a commit to tier4/autoware.universe that referenced this pull request Aug 10, 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)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants