系列篇 | 移动机器人路径规划之全局路径规划

最新推荐文章于 2025-02-28 11:00:57 发布

3Ｄ视觉工坊

最新推荐文章于 2025-02-28 11:00:57 发布

阅读量1k

点赞数 5

原文链接：https://mp.weixin.qq.com/s?__biz=MzU1MjY4MTA1MQ==&mid=2247681535&idx=3&sn=28d5da0aca4e40fac15d6191c7596762&chksm=fa5f073bc3305ad2c3989403a849206262dd4e09b610dc2b5d66d4a3ae344aff37b8bebb625a&scene=126&sessionid=0

版权

点击下方卡片，关注「3D视觉工坊」公众号
选择星标，干货第一时间送达

来源：计算机视觉工坊 | 编辑：3D视觉工坊

添加小助理：dddvision，备注：方向+学校/公司+昵称，拉你入群。文末附行业细分群

扫描下方二维码，加入3D视觉知识星球，星球内凝聚了众多3D视觉实战问题，以及各个模块的学习资料：近20门视频课程（星球成员免费学习）、最新顶会论文、计算机视觉书籍、优质3D视觉算法源码等。想要入门3D视觉、做项目、搞科研，欢迎扫码加入！

0. 背景

机器人路径规划是一个重要的研究领域，涉及到如何让机器人安全、有效地在环境中导航和移动。这个领域的历史可以追溯到几十年前，随着如今机器人技术的进步和应用的扩展，路径规划算法在机械臂、移动机器人以及人形机器人等领域的重要性日益凸显。

1. 基于搜索的路径规划算法

基于搜索的路径规划算法是最早开始进行研究的。这类方法最开始主要用于迷宫求解问题中，在机器人导航时，往往将环境进行栅格化，生成栅格地图（Grid Map），然后在栅格地图中迭代搜索出从起点到终点的最短路径。

BFS（广度优先搜索）算法：通过探索相邻栅格来搜索最短路径。BFS算法通常使用队列数据结构来存储待搜索的节点，并按照层次，逐层进行遍历。

BFS算法Demo

Dijkstra算法：通过逐层搜索和更新最短路径树，找到从起点到终点的最短路径。算法的时间复杂度为O((V+E)logV)，其中V和E分别为图中顶点数和边的数量。Dijkstra算法在处理大规模环境和复杂障碍物时表现良好，具有较高的效率和鲁棒性。

Dijkstra算法Demo

A*算法：通过代价函数来估计从起点到终点的成本，并使用最佳优先搜索策略来寻找代价函数值最低的节点，最终找到最短路径。它是一种启发式的搜索方式，极大地减少了搜索节点的数量，提高了搜索算法的效率。

A*算法Demo

如果有兴趣的话，可以在这个路径规划Demo设计障碍物并对比不同算法的表现。

优缺点总结：

优点：基于搜索的路径规划算法往往能根据环境地图，找到从起点到终点的最短路径，可以极大提高机器人的移动效率。

缺点：针对高维空间或者大规模地图是，基于搜索的路径规划算法的搜索效率较低，需要迭代的搜索绝大多数单元格，时间消耗大。

2. 基于采样的路径规划算法

针对基于搜索的路径规划算法出现的在大型场景下搜索效率低的问题，基于采样的路径规划算法被提出并且进行了广泛的应用。基于采样的路径规划算法，通过在环境地图中进行不断地采样，并将采样点进行连接，直到算法发现从起点到终点的通路。基于采样的路径规划算法往往具有概率完备性，这是指当采样点的数量足够多的时候，所得到的路径就越接近最优路径。因此，基于采样的路径规划算法往往只能够得到渐进最优解。

概率路线图（Probabilistic Road Map，PRM）：该算法的核心思想是通过在地图上进行采样，将环境地图表示为一个概率图，其中节点表示环境中的各种可能位置，边表示从一个位置到另一个位置的概率转移。PRM算法通过随机采样和优化来生成最优路径，最终找到从起点到终点的可行路径。

PRM算法

快速搜索随机树（Rapidly-Exploring Random Trees，RRT）：通过不断随机采样和将采样点相连构建搜索树，逐步探索环境并找到了起点A到目标点B的一条路径。RRT算法适用于复杂的环境，因为它不需要预先了解环境的完整信息，并且可以有效地处理障碍物和未知区域。需要注意的是，RRT算法生成的路径可能不是最优路径，但通常可以找到一条可行且相对较好的路径。

RRT算法

Imformed RRT 算法

优缺点总结：

优点：基于采样的路径规划算法鲁棒性强，能够处理各种环境变化，如障碍物移动、地形变化等；不需要对所有可能的路径进行搜索，它通过采样局部区域来生成路径，从而减少了计算量。

缺点：基于采样的路径规划算法寻找的是可行解，而不是全局最优解，可能错过一些更好的路径，特别是在环境中有多个可行路径；对初始采样的依赖性强，如果初始采样选择的位置不合适，可能会导致算法陷入局部最优解或找不到可行路径。

3. 全局路径规划的最新进展

接下来将介绍并总结近两年发表在机器人顶刊（Science Robotics，IJRR）上的关于全局路径规划的两篇文章。

标题：Motion planning around obstacles with convex optimization

作者：Tobia Marcucci, Mark Petersen, David von Wrangel, Russ Tedrake

机构：MIT，Harvard

期刊：Science Robotics

原文链接：https://www.science.org/doi/10.1126/scirobotics.adf7843

场景：对于机器人，如机械臂、自动驾驶汽车等，在障碍物环境中，有效率的机器人路径规划是非常重要的。同时，在路径规划中，考虑机器人的dynamic和kinematic的限制，也是非常重要的。Dynamic限制主要是针对机器人系统的加速度约束，而kinematic限制主要是针对轨迹约束。基于搜索的路径规划算法难以实现在3维大场景下的实时路径规划，同时传统基于采样的方式只能得到路径的可行解，而无法得到最优解。因此，作者提出了一种基于凸优化的GCS算法用于实现在多维度上的路径规划的求解。

主要贡献：1）将环境中可通行安全区域分解成凸形状的图形，分解后的图形如下图B中至所示。这种分割可以保证，如果两点位于同一区域，那么他们的连线不会与障碍物产生碰撞。

2）提出了一种针对凸优化松弛方法的路径求解器。这个求解器可以有效应对路径规划中出现的多种约束并且可以应用到多种场景之中。

3）在实验中验证了该方法能够有效生成符合约束条件的全局最优解，并且在时间上远远少于基于采样的路径规划算法。

GCS算法示意图