Detecting and modeling staircases with stereo vision for fire-fighting robots