3D-Lidar based obstacle detection and fast map reconstruction in rough terrain | IEEE Conference Publication | IEEE Xplore