- Keyframes
- 0
- Loop edges
- 0
- ATE (RMS)
- –
- χ² · iter
- – · –
Close the loop
Drive a robot with biased odometry, close a loop, and watch pose-graph optimisation pull the drift back.
- 2D pose graph
- Levenberg–Marquardt
- live ATE
From my work State estimation in uw-vio-dvl and uw-vslam-bench.
How it works · numbers
Wheel odometry has a small heading bias, so the estimate (coral) drifts away from the truth (dashed). Drive back to the start: a loop-closure edge (lime) appears. Optimise runs Levenberg–Marquardt on the full 2D pose graph.