https://www.robotsforroboticists.com/realsense-usage-robotics-slam/