用一种搜索算法寻找最优路径