-
Notifications
You must be signed in to change notification settings - Fork 630
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
fix(behavior_path_planner): copy z in dynamic drivable area expansion #4120
Conversation
Codecov ReportPatch coverage:
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
*This pull request uses carry forward flags. Click here to find out more.
☔ View full report in Codecov by Sentry. |
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); |
There was a problem hiding this comment.
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
There was a problem hiding this comment.
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>
653a713
to
31d72bd
Compare
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
LGTM
…autowarefoundation#4120) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
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.
After all checkboxes are checked, anyone who has write access can merge the PR.