实现两点之间最优路径的算法。注:相邻点距离是固定