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

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

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

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

图搜索定义:

图搜索主要逻辑:

深度优先搜索DFS:像堆栈

广度优先搜索BFS:像队列

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

贪婪BFS:

有障碍后不一定最优:

Dijkstra 算法:

A*算法:

算法是否取到最优性:

权重对A*算法的影响:

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

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

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

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

跳跃规则:

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

相关推荐
深邃-5 分钟前
【数据结构与算法】-二叉树(2):实现顺序结构二叉树(堆的实现),向上调整算法,向下调整算法,堆排序,TOP-K问题
数据结构·算法·二叉树·排序算法·堆排序··top-k
We་ct3 小时前
LeetCode 5. 最长回文子串:DP + 中心扩展
前端·javascript·算法·leetcode·typescript
工业机器人生命周期管理7 小时前
赢胜智能:五一劳动节快乐
机器人
王老师青少年编程7 小时前
csp信奥赛C++高频考点专项训练之贪心算法 --【哈夫曼贪心】:合并果子
c++·算法·贪心·csp·信奥赛·哈夫曼贪心·合并果子
叼烟扛炮8 小时前
C++第二讲:类和对象(上)
数据结构·c++·算法·类和对象·struct·实例化
天疆说8 小时前
【哈密顿力学】深入解读航天器交会最优控制中的Hamilton函数
人工智能·算法·机器学习
wuweijianlove8 小时前
关于算法设计中的代价函数优化与约束求解的技术7
算法
xwz小王子9 小时前
Science Robotics最新研究:检索增强操作(RAM)——让机器人真正理解“放在哪儿、怎么放”
机器人
leoufung9 小时前
LeetCode 149: Max Points on a Line - 解题思路详解
算法·leetcode·职场和发展
样例过了就是过了9 小时前
LeetCode热题100 最长公共子序列
c++·算法·leetcode·动态规划