深蓝学院第二章路径规划——ROS图搜索算法(二)

从工作空间->配置空间映射:

将具有一定范围大小的robot映射为质点,让障碍物进行膨胀。

将无人机看成圆盘或者圆球,以半径大小将障碍物进行膨胀,然后将无人机看成质点。

图搜索定义:

图搜索主要逻辑:

深度优先搜索DFS:像堆栈

广度优先搜索BFS:像队列

BFS相比DFS是想找到最优的,而DFS不是为了找最优:

贪婪BFS:

有障碍后不一定最优:

Dijkstra 算法:

A*算法:

算法是否取到最优性:

权重对A*算法的影响:

C++中有利于A*算法的std数据结构参考:

最佳的启发函数:对角启发

Jump Point Search(跳点搜索算法):

当前节点x与父节点到达下一个节点进行比较:

跳跃规则:

[注意]:但是JPS会将没有障碍物的区域全部进行查询,不太节省时间,空旷的地方太多的时候,该算法会比A*算法更慢。

相关推荐
Magic--2 分钟前
选择排序:原理、实现与优化
数据结构·算法·排序算法
qq_417695054 分钟前
基于C++的区块链实现
开发语言·c++·算法
biubiuibiu7 分钟前
工业机器人编程语言详解:多样化选择与应用
fpga开发·机器人
We་ct7 分钟前
LeetCode 74. 搜索二维矩阵:两种高效解题思路
前端·算法·leetcode·矩阵·typescript·二分查找
2401_894241928 分钟前
基于C++的反射机制探索
开发语言·c++·算法
cui_ruicheng10 分钟前
C++ 数据结构进阶:unordered_map 与 unordered_set源码分析与实现
数据结构·c++·算法·哈希算法
C蔡博士15 分钟前
最小生成树(MST)详解:定义、算法与核心性质
算法·贪心算法·图论·时间复杂度
sxtyjty17 分钟前
AtCoder Beginner Contest 450 G题题解
数学·算法·期望
ccLianLian21 分钟前
数论·快速幂和逆元
数据结构·算法
没头脑的男大22 分钟前
华为题目152乘积最大子数组
算法·华为