全局路径规划算法Dijkstra（迪杰斯特拉算法）- matlab

最新推荐文章于 2025-07-11 15:56:32 发布

转载

最新推荐文章于 2025-07-11 15:56:32 发布 · 4.1k 阅读

6 ·

CC 4.0 BY-SA版权

原文链接：http://www.cnblogs.com/geyanwu/p/10400446.html

文章标签：

#matlab

本文介绍了如何使用MATLAB实现Dijkstra全局路径规划算法，该算法用于寻找最短路径。区别于其他教程，本文的MATLAB代码可以直接在控制器上实时运行，并能显示从起点到所有顶点的最短路径所经节点。提供了测试数据供读者验证程序效果。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

参考博客链接：https://www.cnblogs.com/kex1n/p/4178782.html

Dijkstra是常用的全局路径规划算法，其本质上是一个最短路径寻优算法。算法的详细介绍参考上述链接。

本文与参考博文相比，主要有如下两个不同：

1、开发语言换成了matlab，代码部分稍作改动就可以实时运行在控制器上；

2、求取了从起点开始到达每一个顶点的最短路径所经历的顶点。

matlab代码：包含测试数据

%参考链接https://www.cnblogs.com/kex1n/p/4178782.html
DefultMaxValue=1e3;
NodesMap=[0 1 12 DefultMaxValue DefultMaxValue DefultMaxValue;
          DefultMaxValue 0 9 3 DefultMaxValue DefultMaxValue;
          DefultMaxValue DefultMaxValue 0 DefultMaxValue 5 DefultMaxValue;
          DefultMaxValue DefultMaxValue 4 0 13 15;
          DefultMaxValue DefultMaxValue DefultMaxValue DefultMaxValue 0 4;
          DefultMaxValue DefultMaxValue DefultMaxValue DefultMaxValue DefultMaxValue 0];     

% NodesMap=[0 6 3 DefultMaxValue DefultMaxValue DefultMaxValue;
%           6 0 2 5 DefultMaxValue De