Efficient stereo vision for obstacle detection and AGV navigation