Segmentation of color and depth data based on surface fitting