![](https://img-blog.csdnimg.cn/20201014180756928.png?x-oss-process=image/resize,m_fixed,h_64,w_64)
路径规划与轨迹优化
文章平均质量分 65
wincent嘻嘻哈哈
菜狗求带
展开
-
路径规划与轨迹优化 —— A*算法
A*算法原创 2022-03-01 21:58:52 · 4881 阅读 · 0 评论 -
路径规划与轨迹优化 —— Dijkstra算法寻找最短路径
一、算法思路Dijkstra算法是一种用来寻找最短路径的算法,其中涉及的思想有贪心、动态规划二、代码源码来源于Github ,我自己做了一些注解。算法过程不难,主要注意几个细节:原始地图坐标和栅格地图坐标的转换需要对障碍物处做膨胀处理为了标记节点,又加了一个一维数组的索引表示每次找到一个节点时,都要记录上一个节点(通过上一条提到的索引),这样可以记录下完整的路径。import matplotlib.pyplot as p原创 2022-03-01 19:55:37 · 1530 阅读 · 3 评论