路径规划算法:Dijkstra算法 - 附代码
原理部分请参见他人博客(个人认为讲得比较透彻):
https://blog.csdn.net/heroacool/article/details/51014824
https://zhuanlan.zhihu.com/p/40338107
Matlab代码
https://mianbaoduo.com/o/bread/aZWZlpg=
该代码可以用户自己设计地图。定义起点和终点利用Dijkstra算法进行路径规划
Step1.人机交互设计栅格地图
Step2. Dijkstra算法算法进行路径规划