让机器人在硬约束下实时规划,轨迹更准更稳。
Manifold-Constrained MPPI: Real-Time Sampling-Based Control Under Hard Constraints

- 用变分自编码器学习约束流形的低维表示,实现高效规划
- 实测14自由度双臂系统稳定运行在100Hz,轨迹跟踪更精确
- 适合需要严格满足物理约束的机器人控制场景
基于采样的模型预测控制方法(如模型预测路径积分,MPPI)具有无梯度优化和对复杂机器人系统鲁棒的优点。然而,标准MPPI依赖基于代价的软惩罚,无法保证硬约束的满足,严重限制其在闭链操作等高约束任务中的应用。为此,本文提出流形约束型MPPI(MC-MPPI),一种实时采样控制框架,在保持MPPI计算优势的同时强制执行基于流形的等式约束。核心思想是将约束最优控制问题解耦为隐空间规划与执行层校正:规划阶段,通过变分自编码器(VAE)学习约束流形的低维隐表示,使MPPI能高效生成近可行候选轨迹,无需逐样本修改;由于该参考可实现等式约束的准确线性化,执行层通过单次二次规划(QP)求解即可修正残差流形偏差,而非迭代投影。在14自由度闭链双臂系统上的仿真与真实环境实验表明,MC-MPPI以100Hz稳定运行,能可靠应对动态环境并有效维持硬约束,显著优于基线方法的轨迹跟踪精度。补充视频与实现细节见https://rcilab.github.io/mcmppi。
原文摘要 · Abstract (English)
Sampling-based model predictive control methods, such as Model Predictive Path Integral (MPPI), offer derivative-free optimization and robustness in complex robotic systems. However, standard MPPI relies on cost-based soft penalties that cannot guarantee hard-constraint satisfaction, severely limiting its applicability to highly constrained tasks such as closed-chain manipulation. To address this, we propose Manifold-Constrained MPPI (MC-MPPI), a real-time sampling-based control framework that enforces manifold-based equality constraints while preserving the computational advantages of MPPI. The key idea is to decouple the constrained optimal control problem into latent-space planning and execution-level correction. At the planning stage, a Variational Autoencoder (VAE) learns a low-dimensional latent representation of the constraint manifold, enabling MPPI to efficiently generate near-feasible candidate trajectories without per-sample modification. Since this reference enables accurate linearization of the equality constraints, an execution-level Quadratic Programming (QP) controller resolves the residual manifold mismatch in a single solve rather than through iterative projection. Experiments on a 14-DoF closed-chain dual-arm system in both simulation and real-world settings demonstrate that MC-MPPI operates stably at 100 Hz, reliably navigates dynamic environments while effectively maintaining hard equality constraints, and significantly outperforms baseline methods in tracking accuracy. Supplementary videos and implementation details are available at https://rcilab.github.io/mcmppi.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。