introlab / rtabmap_ros

RTAB-Map's ROS package.
http://wiki.ros.org/rtabmap_ros
BSD 3-Clause "New" or "Revised" License
1.01k stars 558 forks source link

Localization does not improve and messes up move_base trajectories #766

Open prasheelBB8 opened 2 years ago

prasheelBB8 commented 2 years ago

Setup:

Issue: Now, when trying to localize in this map (even with the post processing mentioned above), the localization is really poor. I have tried the parameters mentioned in issues #300, #350, #719, etc. The /rtabmap/localization_pose are too less and at times there is a mismatch between the local costmap and the /rtabmap/grid_map in runtime that the difference does not let move_base to complete its trajectory.

image

I would like to understand

Added our launch file - git_rgbd_slam_dual_camera_localize_launch.txt

matlabbe commented 2 years ago

If local costmap is using odom frame and global costmap is using map, if there is a difference between both is that the robot drifted against the map, the robot did not relocalize for a while.

Loop closures can help to track re-localization hypotheses during localization-only mode. The Bayes filter propagates re-localization hypotheses to linked nodes of the current best hypothesis. If /localization_pose topic is not published often, it is because the robot doesn't localize often.

If you are using rolling shutter cameras, there would be likely motion blur in image, which is bad for localization. You can browse images in your database using rtabmap-databaseViewer and see for yourself.