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

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

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

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

图搜索定义:

图搜索主要逻辑:

深度优先搜索DFS:像堆栈

广度优先搜索BFS:像队列

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

贪婪BFS:

有障碍后不一定最优:

Dijkstra 算法:

A*算法:

算法是否取到最优性:

权重对A*算法的影响:

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

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

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

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

跳跃规则:

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

相关推荐
东北洗浴王子讲AI19 小时前
GPT-5.4辅助算法设计与优化:从理论到实践的系统方法
人工智能·gpt·算法·chatgpt
Billlly20 小时前
ABC 453 个人题解
算法·题解·atcoder
玉树临风ives20 小时前
atcoder ABC 452 题解
数据结构·算法
feifeigo12320 小时前
基于马尔可夫随机场模型的SAR图像变化检测源码实现
算法
fengfuyao98521 小时前
基于STM32的4轴步进电机加减速控制工程源码(梯形加减速算法)
网络·stm32·算法
无敌昊哥战神1 天前
深入理解 C 语言:巧妙利用“0地址”手写 offsetof 宏与内存对齐机制
c语言·数据结构·算法
小白菜又菜1 天前
Leetcode 2075. Decode the Slanted Ciphertext
算法·leetcode·职场和发展
Proxy_ZZ01 天前
用Matlab绘制BER曲线对比SPA与Min-Sum性能
人工智能·算法·机器学习
黎阳之光1 天前
黎阳之光:以视频孪生领跑全球,赋能数字孪生水利智能监测新征程
大数据·人工智能·算法·安全·数字孪生
小李子呢02111 天前
前端八股6---v-model双向绑定
前端·javascript·算法