https://123dok.net/document/qo5jok90-real-time-robust-slam-large-scale-outdoor-environments.html