Stereo vision obstacle avoidance using depth and elevation maps