fix(planning_validator): improve curvature calculation for less noise #5049
+58
−23
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
When driving autonomously, occasionally an error message stating "Lateral acceleration is too high" appears on the terminal.
This issue arises because the
planning_validator
calculates curvature based on three consecutive points. These closely spaced points can produce extremely high curvature results due to noise. We are not interested in the curvature of a path separated by only 1mm; what we really want to know is the curvature over a few meters. I've now modified it to compute the curvature based on three points that are 1m apart.Note: Parameterizing this distance is on our to-do list for future updates.
Related links
TIERIV Internal ticket
Tests performed
run psim
Notes for reviewers
None
Interface changes
None
Effects on system behavior
planning validation for the lateral acceleration will get less sensitive to noises.
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.