this is a test project , use rgbd camera build a 3D Dense pointcloud map then make use of octomap to get a compressed 3D map we can project to 2d costmap to navigation for robot, and for further, I have extend this project to naviagation without ros, The code i will upload soon. example:
