Upgrade odometry -> SLAM Rosbag and public dataset to measure drift in loops keyframe & pose-graph structure loop closure detection pose-graph optimization (PGO). scan context Correct fastlio backend frontend local global