https://123dok.net/document/rz3pw77y-scene-structure-registration-for-localization-and-mapping.html