3D mapping and navigation

Summary
Algorithms and software to reconstruct the geometry of the furniture and objects inside the rooms is provided to enable the robot with safe navigation.