Vision-based Terrain Segmentation and Roughness Estimation