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

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

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

图搜索定义: 

图搜索主要逻辑: 

深度优先搜索DFS:像堆栈 

广度优先搜索BFS:像队列 

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

贪婪BFS: 

 有障碍后不一定最优:

Dijkstra 算法:

 A*算法:

 算法是否取到最优性:

 权重对A*算法的影响:

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

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

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

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

跳跃规则: 

 

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

Logo

北京人形旗下天工造物具身智能开源社区,聚焦具身天工与慧思开物两大平台

更多推荐