想象一下,你正试图引导一条长而灵活的蛇(即机械臂)穿过一个堆满移动家具的拥挤房间。你的目标是让蛇头到达特定位置,同时确保它不会撞到任何东西。这正是本文要解决的挑战,只不过针对的是仓库等场景中高科技机械臂的应用。
以下是他们解决方案的简明拆解,采用日常类比:
1. 问题:“蒙眼”规划器
传统机器人规划器的工作方式,就像一个人试图在黑暗的房间中行走,通过迈出一小步、谨慎地试探。它们不断停下检查:“这里有墙吗?那里有椅子吗?”
- 问题所在:在充满移动障碍物的房间里,检查每一步都耗时过长。等到机器人完成检查时,家具可能已经移动,或者机器人可能早已发生碰撞。这就像开车时不断停下,为每一寸道路查看地图。
2. 创新:“安全气泡”
作者没有检查每一个微小步骤,而是教会机器人一项新技巧:构型空间距离函数(CDFs)。
- 类比:想象机械臂是一个人,而“构型空间”是这个人所有可能姿态的地图。
- 神奇之处:机器人学会在这张地图上为自己绘制无形的“安全气泡”。在气泡内部,机器人可以确信自己不会撞到任何东西。
- 优势:机器人无需检查每一步,只需从一个气泡跳到下一个气泡。这就像在河中踩着石头跳跃,而不是涉水而行。这使得规划变得极其迅速,因为机器人无需频繁检查碰撞。
3. 隐患:“不完美的水晶球”
这些气泡存在一个问题:机器人是通过神经网络(一种人工智能)和传感器(摄像头)学习它们的。
- 问题所在:人工智能会犯错,摄像头会产生噪声。机器人可能认为某个气泡是安全的,但实际上它离墙壁太近。如果机器人盲目信任气泡,就可能会发生碰撞。
- 现实情况:障碍物(家具)也在移动,而机器人对它们的观测并不完美。
4. 解决方案:“偏执的安全过滤器”
为了解决这种不确定性,作者创建了一个分布鲁棒控制屏障函数(DR-CBF)。
- 类比:想象机器人拥有一个“安全过滤器”,它就像一个偏执的保镖。
- 保镖知道人工智能绘制的地图可能略有偏差。
- 保镖知道摄像头图像可能模糊不清。
- 保镖知道家具的移动速度可能超出预期。
- 工作原理:当机器人试图移动时,保镖不会只看“完美”的地图,而是查看“最坏情况”版本的地图(在合理的误差范围内)。如果气泡可能太小,或者障碍物可能比看起来更近,哪怕只有一丝可能,保镖就会说:“停下!减速!远离!”
- 结果:机器人可能会选择一条稍微不那么直接的路径,或者移动得更加谨慎,但它能保证不会发生碰撞,即使其传感器存在噪声或环境混乱不堪。
5. 验证:现实世界测试
团队在充满移动障碍物的杂乱房间中,对真实的机械臂(UFactory xArm6)进行了测试。
- 规划:“气泡”方法比传统方法快得多,因为它采取的是巨大而安全的跳跃,而非微小而谨慎的试探。
- 控制:当障碍物向机器人移动时,“偏执保镖”过滤器使机器人进行防御性躲避,然后平滑地回到原定路径,成功到达目标而未发生碰撞。传统方法在这些动态情境中往往失败。
总结
本文赋予机器人一张超快地图(气泡)用于规划路线,并配备一位极度谨慎的安全卫士(鲁棒过滤器)来处理地图和传感器不完美的事实。其结果是,机器人能够在混乱多变的环境中快速且安全地移动,而无需停下来思考每一毫米。
技术摘要:用于操作规划与控制的神经配置空间屏障
问题陈述
在杂乱、动态环境中运行的高自由度(DoF)机器人机械臂面临双重挑战:既要确保运动规划的计算效率,又要在执行过程中维持鲁棒的安全保障。传统的基于采样的规划器(如 RRT、PRM)依赖频繁且昂贵的碰撞检测,在高维配置空间中形成了瓶颈。此外,在存在传感器噪声和不可预测障碍物的动态环境中,仅靠规划是不够的;实时控制策略必须考虑建模误差和观测不确定性,以防止碰撞。现有方法往往难以在精确的、可微的安全表示需求与实时运行的计算约束之间取得平衡。
方法论
作者提出了一个统一的框架,利用**神经配置空间距离函数(CDFs)**将运动规划与控制集成在一起。该方法包含三个主要组成部分:
1. 神经 CDF 表示
该方法学习两个不同的神经网络模型来表示配置空间(Q)中的安全性:
- 环境 CDF(fc): 估计从配置 q 到工作空间障碍物点 p 的最小关节空间距离。
- 自碰撞 CDF(fsc): 估计从 q 到自碰撞配置集合的最小关节空间距离。
这些函数被训练为多层感知机(MLP),以提供快速、可微的距离和梯度查询,从而近似局部自由配置空间。
2. 气泡-CDF 规划器
为了提高规划效率,作者引入了一种**快速探索气泡图(RBG)**算法。该规划器不再将节点视为单一配置,而是在配置空间中构建“气泡”(球形区域)。
- 气泡构建: 以安全配置 q 为中心的气泡半径由神经 CDF 屏障值动态确定:r(q)=h^(q,t)−η,其中 η 是安全裕度。
- 效率: 气泡内的任何配置都保证是无碰撞的(受限于屏障近似)。这使得规划器可以通过连接重叠的气泡来探索空间,与基于边的 RRT 相比,大幅减少了所需的显式碰撞检测次数。
- 轨迹优化: 一旦找到气泡路径,便通过优化一系列贝塞尔曲线生成连续轨迹。这些曲线的控制点被约束在各自的气泡内,利用凸包性质确保整个轨迹无碰撞,该问题被表述为凸二次约束二次规划(QCQP)。
3. 分布鲁棒控制屏障函数(DR-CBF)
对于实时执行,系统采用**分布鲁棒控制屏障函数(DR-CBF)**来跟踪规划轨迹,同时确保在不确定性下的安全性。
- 不确定性建模: 该方法承认由神经网络近似误差、点云传感器噪声和动态障碍物运动引起的不确定性。
- Wasserstein 模糊集: 该方法不假设这些误差具有已知的概率分布,而是围绕不确定性样本的经验分布(通过蒙特卡洛 Dropout 和点云速度估计生成)构建 Wasserstein-1 模糊集。
- 安全滤波器: 控制器在线求解一个二次规划(QP),在最小化与标称 PD 控制器偏差的同时,满足分布鲁棒安全约束。这确保了即使在模糊集内的最坏情况分布下,违反安全集的概率仍保持在用户指定的风险容忍度(ϵ)以下。
主要贡献
- 统一的神经 CDF 屏障: 一种学习到的表示,能够估计到外部障碍物和自碰撞的距离,支持从点云观测中快速进行距离和梯度查询。
- 分布鲁棒控制: 一种新颖的 DR-CBF 公式,用于机械臂控制,明确考虑了建模误差、传感器噪声和动态障碍物,而无需显式了解底层不确定性分布。
- 基于气泡的规划: 一种基于采样的规划器,利用神经 CDF 查询构建安全配置空间气泡图,显著降低了高维空间中的碰撞检测开销。
- 实验验证: 在 6 自由度 UFactory xArm6 机械臂的仿真和真实世界动态环境中进行了全面评估,展示了规划器与控制器的集成效果。
结果
论文提出了广泛的评估,将所提出的方法与基线方法进行了比较,包括 RRT 变体(CDF-RRT、SDF-RRT、Lazy-RRT)、MPPI 和标准 CBF 控制器。
- 规划效率: 在 2 自由度和 6 自由度仿真中,气泡-CDF 规划器将碰撞检测次数降低了一个数量级(例如,在 2 自由度中,Lazy-RRT 约为 1,759 次,而该方法约为 154 次;在 6 自由度中,约为 2,741 次对比 279 次),同时保持了可比的路径长度。其包括后处理在内的总体运行时间也最低。
- 控制鲁棒性: 在具有移动障碍物的动态环境中:
- 标准 PD 控制器频繁失败(成功率约为 11-18%)。
- 标准 CBF-QP 控制器表现有所改善,但在动态设置中显著下降(成功率约为 64-70%),这是由于未建模的不确定性所致。
- 提出的PD + DR-CBF-QP在静态和动态仿真以及真实世界实验中均实现了100% 的成功率。
- 真实世界性能: 在物理 xArm6 上的实验证实了仿真结果,显示机器人成功穿越杂乱环境,并执行防御性机动以避免动态障碍物,同时跟踪规划轨迹。
意义与主张
论文声称,该方法为在缺乏准确模型且障碍物运动不可预测的环境中进行机器人操作提供了实用解决方案。通过将学到的 CDF 集成到规划和控制中,该方法实现了:
- 计算效率: 通过利用配置空间气泡,大幅减少了碰撞检测操作。
- 鲁棒安全性: 通过分布鲁棒优化而非保守的离线裕度,实现了在神经网络近似误差和传感器噪声下仍能维持安全保证的能力。
- 实时适用性: 该框架能有效利用机载传感器(点云)运行,并支持实时控制频率(50 Hz),使其适用于需要动态重规划的工业环境,如仓库和装配线。
作者强调,他们的方法不依赖于详细的环境模型,并且可以扩展到其他在动态环境中运行的机械臂,旨在提高工业应用中的生产率和安全性。
每周获取最佳 electrical engineering 论文。
受到斯坦福、剑桥和法国科学院研究人员的信赖。
请查收邮箱确认订阅。
出了点问题,再试一次?
无垃圾邮件,随时退订。