Stereo based Obstacle Detection with Uncertainty in Rough Terrain