路径规划算法:A*算法 - 附代码
原理部分请参见他人博客(个人认为讲得比较透彻):
https://blog.csdn.net/hitwhylz/article/details/23089415
https://www.cnblogs.com/zhoug2020/p/3468167.html
Matlab代码
https://mianbaoduo.com/o/bread/aZWWm5Y=
该代码可以用户自己设定起点,终点,障碍物,然后利用A*算法得到最终路径。
Step1.设定终点
Step2.设置障碍物
Step3.设置起点
Step4. A*算法进行路径规划