当前位置:首页 > 编程笔记 > 正文
已解决

移动机器人运动规划 --- 基于图搜索的Dijkstra算法

来自网友在路上 152852提问 提问时间:2023-09-22 23:08:48阅读次数: 52

最佳答案 问答题库528位专家为你答疑解惑

移动机器人运动规划 --- 基于图搜索的Dijkstra算法

  • Dijkstra 算法
    • Dijkstra 算法 伪代码流程
    • Dijkstra 算法步骤示例
    • Dijkstra算法的优劣分析

Dijkstra 算法

Dijkstra 算法与BFS算法的区别就是 : 从容器中弹出接下来要访问的节点的规则不同

BFS 弹出: 层级最浅的原则,队列里最下方的元素

Dijkstra 弹出: 代价最小的节点g(n)

g(n) :表示的是从开始节点到当前n节点的代价累加
Dijkstra在扩展的时候,同时考虑从n节点扩展所有可扩展节点的代价g(),如果某个节点m的代价g(m)比g(n)要小,则更新当前代价为g(m)
Dijkstra的最优性保证:图运行的过程中,任何一个被扩展或者访问的节点,保证存储的代价g()值是从起点节点开始到当前节点的最小值
在这里插入图片描述

Dijkstra 算法 伪代码流程

维护一个优先级队列,存储所有被扩展的节点,且节点按g()值的大小自动按从小到大排列。

-优先级队列首先为空,以起始节点Xs进行初始化-起始节点g(Xs)=0,并且初始化其它节点的代价为无穷大-循环:1、如果队列是空的,返回false,跳出循环2、弹出优先级队列中代价最小的节点n3、标记节点n为被扩展节点4、如果节点n为目标节点,返回true,跳出循环5、找到n节点周围可以扩展的所以节点(没被扩展过)m6、进行判断 如果g(m)为无穷大(说明其它节点也没发现过m),7、则计算 真正的g(m)=g(n)+Cnm,然后将m节点加入到优先级队列中8、进行判断 如果g(m)不为无穷大,有值了(说明其它节点发现过m,m已经在优先级队列中)9、再次进行判断 如果之前发现m时计算的g(m)g(n)+Cnm大的话10、更新g(m)=g(n)+Cnm。11、重复循环至步骤1-结束循环

Dijkstra 算法步骤示例

在这里插入图片描述
以这个图将Dijkstra 算法运行的步骤进行一个示例:

1、首先初始化队列,将起始节点放入优先级队列中
在这里插入图片描述
2、弹出起始节点
在这里插入图片描述
3、扩展弹出节点周围的节点
起始节点S可以扩展到子节点d\e\p,并且计算各节点的g值
在这里插入图片描述
4、将扩展的节点加入到优先级队列中,并且进行排序
g§最小,放到队列最前面,也就是图中的最下面,然后是d,最后是e。
在这里插入图片描述
5、弹出最小的g值节点
也就是p节点
在这里插入图片描述
然后循环至步骤3,直至结束

Dijkstra算法的优劣分析

  • 优点:完备的(如果问题有解,一定能找到解);最优的(找到的解一定是最优的)
  • 缺点:没有目标终点方向的,只是比广度搜索多了一个代价值判断,如果每个边的代价都是1的话,那么就变成了广度搜索。

针对该缺点,与之对应的就是启发式搜索,例如贪心算法,根据到目标的进行一个启发式搜索。

如果Dijkstra的最优性与启发式搜索结合,使搜索具有方向性时,也就是 A*算法了。

查看全文

99%的人还看了

猜你感兴趣

版权申明

本文"移动机器人运动规划 --- 基于图搜索的Dijkstra算法":http://eshow365.cn/6-11719-0.html 内容来自互联网,请自行判断内容的正确性。如有侵权请联系我们,立即删除!