Real-time path-planning from 3D reconstruction and depth estimation: an algorithm for calibrated stereo cameras.