Vision-Based Robust Path Reconstruction for Robot Control