https://123dok.org/document/1y99m8jy-robust-selective-stereo-slam-loop-closure-bundle-adjustment.html