Fast and robust stereo matching algorithm for obstacle detection in robotic vision systems