https://5dok.org/document/y4wxp0vk-autonomous-localization-in-unknown-environments.html