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

feat: add tools to collect TP values of PCD map segments #211

Open
wants to merge 9 commits into
base: main
Choose a base branch
from

Conversation

anhnv3991
Copy link
Contributor

Description

  • The TPs resulting from NDT localization may vary on map, i.e. matching on different maps may yield very different TPs. This PR adds some tools to collects maps TPs. Those 'standard' TPs are used to verify localization results in other rosbags, and if some 'standard' TPs differ from the rosbags' TPs significantly, there may be a chance that the corresponding map segments have changed.
  • Add scripts to collect TP values of PCD map segments and show the TPs on rviz
  • Add a script to check compare TPs of a rosbag with the TPs of map segments and visualize the map areas where rosbag TPs differ from segment TPs significantly

How was this PR tested?

  • Tested on rinkai odaiba
  • Visualization of segments TPs. The cyan parts are the segments with high TPs. The red parts are segments with low TPs (< 3.0)or no TPs.

Screenshot from 2025-01-28 10-27-34

  • Results of checking rosbag TPs. Cyan parts are segments where rosbag TPs are not much different from map TPs.

Screenshot from 2025-01-28 10-39-10

Notes for reviewers

This is a baseline implementation and the tools are still prototypes. TPs are collected by a super simple manner - segments will keep the max TP near them. We can compute the expected TP of a pose by querying the segments near the pose (search radius 20m), and averaging the segments' TPs. In general, this is not correct, as the scan may not be able to reach some segments. This should be fixed in future.

Effects on system behavior

None.

Copy link

github-actions bot commented Feb 6, 2025

Thank you for contributing to the Autoware project!

🚧 If your pull request is in progress, switch it to draft mode.

Please ensure:

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Projects
None yet
Development

Successfully merging this pull request may close these issues.

1 participant