将A星算法和D星算法结合,实现到了途径最短规划功能,代码测试通过。输入地图数组通过算法计算,输出了最短线路列表。导航中异常也可以知道最新路径。在QT5上写的代码,可以直接编译。