https://robotsbeat.com/guides/slam-robot-mapping-localization-practical-guide/