fix(planning_validator): calculate max lateral acceleration after resampling trajectory #6679
Conversation
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
github-actions
bot
added
the
component:planning
Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com>
kaigohirao
force-pushed
the
fix-planning-validator
branch
from
eb2c7aa to
38b10ca
Compare
TakaHoribe
added
the
run:build-and-test-differential
4 tasks
kaigohirao
added a commit
to kaigohirao/autoware.universe
that referenced
this pull request
Mar 27, 2024
…ampling trajectory (autowarefoundation#6679) fix planning validator calc max lat acc after resampling Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com>
kaigohirao
added a commit
to kaigohirao/autoware.universe
that referenced
this pull request
Mar 27, 2024
…ampling trajectory (autowarefoundation#6679) fix planning validator calc max lat acc after resampling Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com>
TomohitoAndo
pushed a commit
to tier4/autoware.universe
that referenced
this pull request
Mar 27, 2024
…ampling trajectory (autowarefoundation#6679) fix planning validator calc max lat acc after resampling Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com>
4 tasks
TomohitoAndo
added a commit
to tier4/autoware.universe
that referenced
this pull request
Mar 28, 2024
…ampling trajectory (autowarefoundation#6679) (#1213) fix(planning_validator): calculate max lateral acceleration after resampling trajectory (autowarefoundation#6679) fix planning validator calc max lat acc after resampling Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com> Co-authored-by: kaigohirao <127086108+kaigohirao@users.noreply.github.com>
karishma1911
pushed a commit
to Interplai/autoware.universe
that referenced
this pull request
Jun 3, 2024
…ampling trajectory (autowarefoundation#6679) fix planning validator calc max lat acc after resampling Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com>
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Description
Related JIRA Ticket: https://tier4.atlassian.net/browse/RT0-29352
In the planning validator, among other checks, the max lateral acceleration is calculated and checked whether it is larger than 1G [m/s^2] or not from an input of trajectory. The lateral accelerations are calculated from longitudinal velocities and curvatures at every trajectory points.
The validation function in the planning validator includes two internal trajectory variables, namely
trajectory, an input from the motion velocity smoother which is densely sampled near the ego and sparsely sampled otherwise with the policy explained here , andresampled, representing the same path astrajectorybut wholly sparsely resampled with the interval of 1~2m.This PR puts the lateral acceleration check process after resampling of trajectory for the purpose of numerically safer calculations of curvatures.
Tests performed
I confirmed the normal operation with the latest version of Autoware in the planning simulation here.
Effects on system behavior
The plot on the upper right of the image blow is a comparison of max lateral acceleration calculated from
trajectory(before change, red) andresampled(after change, blue). The red one becomes larger than 1G [m/s^2] but blue one is smoother and safe from the MRM check.Note the above comparison is done with the version https://github.com/tier4/autoware.universe/tree/beta/v0.11.2 and commit ID 3e02320 .
Effects on the max lateral accelerations in the latest version of main would be small as the curvature calcuation is originally done after resampling the trajectory with the interval of about 1m.
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.