nano-pgo
A tutorial on graph-based SLAM
Initialization techniques for 3D SLAM
pose graph optimizer in 500 LOCs