loop closure

Integration von Schleifenschl├╝ssen in HATSDF-SLAM