RGB-D fusion enhancement by mode filter for surfel cloud segmentation