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

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

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

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

图搜索定义:

图搜索主要逻辑:

深度优先搜索DFS:像堆栈

广度优先搜索BFS:像队列

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

贪婪BFS:

有障碍后不一定最优:

Dijkstra 算法:

A*算法:

算法是否取到最优性:

权重对A*算法的影响:

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

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

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

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

跳跃规则:

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

相关推荐
binbinxyz20 分钟前
【算法系列】归并排序详解
java·算法·排序算法
techpupil1 小时前
LeetCode5最长回文字串
java·算法·leetcode·动态规划
ん贤1 小时前
模拟算法.
开发语言·算法
graceyun3 小时前
初阶数据结构(C语言实现)——2算法的时间复杂度和空间复杂度
c语言·数据结构·算法
慕容晓开3 小时前
c++,二叉树
数据结构·c++·算法
武乐乐~3 小时前
欢乐力扣:存在重复元素二
算法·leetcode·哈希算法
waves浪游3 小时前
string类详解(下)
linux·数据库·c++·算法
Unique_yt5 小时前
02.24 运算符重载函数和继承相关练习
算法
GssZF5 小时前
2.24作业
算法