A stereo vision based mapping algorithm for detecting inclines, drop-offs, and obstacles for safe local navigation