该程序是A*算法寻最短路径的实例