Create optimal_path.py