Robust estimation for range image segmentation and fitting