用安全终止机制让机器人在人身边避障,又快又稳。
COSMIK-MPPI: Scaling Constrained Model Predictive Control to Collision Avoidance in Close-Proximity Dynamic Human Environments

- 将约束违反视为终止单元,避免依赖惩罚项
- 仿真与实机测试中成功率100%,计算时间恒定22毫秒
- 适合低成本无标记人体追踪的实用化人机协作场景
确保扭矩控制机械臂与人类在日常环境中安全交互至关重要。模型预测控制(MPC)因其处理硬约束、提供强保障及通过预测推理实现零样本适应的能力而成为理想框架。然而,基于梯度的MPC(GB-MPC)在复杂环境中的避障表现有限。基于采样的方法如模型预测路径积分(MPPI)通过随机模拟提供替代方案,但通过附加惩罚来保证安全本质上脆弱,无法提供形式化的约束满足保证。本文提出一种名为COSMIK-MPPI的避障框架,结合人体运动估计工具RT-COSMIK和约束即终止(Constraints-as-Terminations)转换方法,通过将约束违反视为终止事件来强制安全,无需依赖大惩罚项或显式人体运动预测。该方法在仿真与真实机械臂上与先进GB-MPC和原始MPPI对比评估。结果表明,COSMIK-MPPI在所有测试中实现100%任务成功率,计算时间恒定为22毫秒,显著优于GB-MPC;在模拟不可行场景中,始终生成无碰撞轨迹,而原始MPPI则失败。该特性使得使用低成本无标记人体运动估计算法,在共享工作空间中安全执行复杂人机交互任务成为可能,展示了鲁棒、柔顺且实用的预测避障解决方案(详见:https://exquisite-parfait-ffa925.netlify.app)
原文摘要 · Abstract (English)
Ensuring safe physical interaction between torque-controlled manipulators and humans is essential for deploying robots in everyday environments. Model Predictive Control (MPC) has emerged as a suitable framework thanks to its capacity to handle hard constraints, provide strong guarantees and zero-shot adaptability through predictive reasoning. However, Gradient-Based MPC (GB-MPC) solvers have demonstrated limited performance for collision avoidance in complex environments. Sampling-based approaches such as Model Predictive Path Integral (MPPI) control offer an alternative via stochastic rollouts, but enforcing safety via additive penalties is inherently fragile, as it provides no formal constraint satisfaction guarantees. We propose a collision avoidance framework called COSMIK-MPPI combining MPPI with the toolbox for human motion estimation RT-COSMIK and the Constraints-as-Terminations transcription, which enforces safety by treating constraint violations as terminal events, without relying on large penalty terms or explicit human motion prediction. The proposed approach is evaluated against state-of-the-art GB-MPC and vanilla MPPI in simulation and on a real manipulator arm. Results show that COSMIK-MPPI achieves a 100% task success rate with a constant computation time (22 ms), largely outperforming GB-MPC. In simulated infeasible scenarios, COSMIK-MPPI consistently generates collision-free trajectories, contrary to vanilla MPPI. These properties enabled safe execution of complex real-world human-robot interaction tasks in shared workspaces using an affordable markerless human motion estimator, demonstrating a robust, compliant, and practical solution for predictive collision avoidance (cf. results showcased at https://exquisite-parfait-ffa925.netlify.app)
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。