自己编的最短路径实现算法,来自于数据结构课程