Detect 3D obstacle by sensor fusion of 2D laser and RGB-D camera,then 3D obstacle obstacle of not included in 2D gridmap, added into 2D gridmap - View it on GitHub