feat(ndt_scan_matcher): added score diff to ndt diag #7227
Merged
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
Since ndt_scan_matcher performs score optimization, it is desirable for the score to increase with each run. Currently, we do not check how the score changes with each run of NDT, so we will first introduce a change to output score difference to
/diagnostics
.Relate PR
Tests performed
For now, I've confirmed that the correct values are being sent to
/diagnostics
.The results have been plotted for the AWSIM Nishi-Shinjuku data.
Transform Probability Diff
Nearest Voxel Transformation Likelihood Diff
In this data, there appears to be a small bump in the roll direction around the first intersection, which is likely to be the reason for the large Score Diff.
At around 18 seconds in the video below
awsim_nishishinjuku.mp4
In the future, we plan to check the indicators using larger amounts of data and set appropriate thresholds if they exist.
Effects on system behavior
There are no effects on system behavior.
Interface changes
Output is added to
/diagnostics
of ndt_scan_matcher.It is redundant to show both the diff and the before, so I can remove "before".
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.