精读笔记

Problem Setting

这篇论文不是在泛泛做“机器人 MPC”，而是在解决 pHRI 里一个很具体的控制矛盾：机器人需要在外力接触时保持低等效刚度/安全顺应，但又不能因为持续人力产生几十毫米的静态偏移。经典阻抗的稳态误差是结构性的，等于外力除以刚度；提高刚度会牺牲安全，加入积分会碰到稳定裕度和输入饱和。以前的 impedance MPC 多数卡在两个地方：一是把完整非线性机器人放进预测，实时性差；二是优化了瞬态行为，但没有 offset-free 的严格机制。这里真正的问题是：如何在 torque-controlled manipulator 上把“安全受限的预测控制”和“常值扰动零偏差”同时做成实时可运行的结构。

Motivation

作者的动机来自一个很控制论的观察：pHRI 中 sustained push 的本质不是需要更复杂的阻抗参数调度，而是一个常值/慢变输入扰动；只要系统里有正确的 disturbance internal model，零稳态误差是标准 offset-free MPC 能解决的问题。缺口在于机器人动力学太非线性，直接套 offset-free MPC 会变成配置依赖、计算重、难证明的东西。论文的关键想法是先把 operational-space 动力学中已知部分解析消掉，使剩余模型足够接近固定结构线性系统，然后把已有 saturated linear systems / offset-free MPC 理论搬到 pHRI 场景里。

Core Idea

核心思想可以概括为：不要让 MPC 学会或优化完整机器人动力学，而是先用 model-based feedforward 把机器人“变成”一个任务空间双积分器，再在这个简化对象上做预测和扰动估计。这样建模方式从“非线性机器人预测”变成“固定 A、配置依赖 B 的 LPV 残差控制”。这改变了信息流：快速内环负责动力学消元，低维 QP 只负责 corrective Cartesian force，Kalman 增广状态负责把持续扰动作为可估计的输入偏置进入 free response。

这个 inductive bias 很强：它假设 pHRI 中最重要的不确定性不是复杂高频交互，而是作用在任务空间输入通道上的慢变力偏置。若这个假设成立，方法自然比优化阻抗参数或非线性 MPC 更 scalable，因为预测矩阵大部分可复用，QP 维度固定，与关节数弱相关。和 prior 的本质区别不在“用了 MPC”，而在于通过解析补偿把 MPC 的对象换成了一个理论上可控、可观、可 offset-free 的残差系统。

Method

方法中真正必要的机制有以下几项。

1. Feedforward nonlinear inversion：解决的是机器人动力学导致预测模型随 q、qdot 强烈变化的问题。通过补偿 bias force、任务空间惯量和期望加速度，误差动力学被整理为 e_ddot = -Lambda^{-1} F_mpc + d。核心变化是 MPC 不再承担重力/科氏/惯量补偿，而只产生任务空间 corrective force。

2. Constant-A LPV prediction：解决的是实时 MPC 的结构复用问题。A_d 是固定双积分器，只有 B_d 通过 Lambda^{-1}(q) 调度。这让 free-response matrix 可预计算，QP 保持 30 变量量级。这里的贡献更偏结构化建模，而不是 solver trick。

3. Box-constrained QP：解决的是 corrective force 的幅值约束和接触瞬态 deflection。它的作用是有限时域内分配可用控制力，避免简单高增益阻抗的无约束反应。若约束不活跃，论文证明它退化为某个 LQR-induced impedance，因此 MPC 的新增价值主要出现在约束边界和扰动预测中。

4. Kalman disturbance augmentation：解决的是 sustained force 下的静态偏差。扰动以 force form 建模为 random walk，并通过与控制相同的输入通道进入增广系统。核心变化是外力不再只是误差反馈后的被动响应，而是被估计并在 free response 中预补偿。零稳态误差主要来自这里。

5. Null-space barrier + workspace projection：解决关节限位。null-space barrier 处理冗余自由度，workspace projection 处理任务本身把关节推向极限的情况。它是实用安全层，但论文只给经验验证，不是严格 safety filter。

Key Insight / Why It Works

最关键的 insight 是：这篇论文的性能不是因为 MPC “更聪明”，而是因为作者把问题变成了 offset-free linear MPC 最擅长的形式。经典阻抗的稳态误差来自没有 internal model；Kalman 增广给了常值扰动内模，所以持续外力会被估计成一个输入通道偏置，最终由 F_mpc 抵消。预测层解决的是峰值和过渡过程，估计层解决的是稳态偏差，两者分工清楚。

真正核心贡献是 constant-A residualization。它使得方法既能计算快，又能借用线性系统理论给出解释。如果没有 Layer 1 的动力学消元，后面的 offset-free MPC 仍然可以写，但实时性和证明都会弱很多。如果没有 Kalman 增广，MPC 只能降低 transient deflection，不能消掉 sustained force 的 offset。实验中的 C4 vs C5 对比基本支持这个归因。

哪些可能只是 engineering：OSQP warm-start、30-variable QP、100/500 Hz rate、ZOH 策略、barrier 参数等更多是实现层面的 scaling 和调参；它们提升实时性和峰值表现，但不是零稳态误差的本质来源。关节限位安全尤其像工程组合：null-space potential 是已有套路，workspace projection 也是实用修补，文中没有把它提升到 formal safety guarantee。

这不是 data scaling、retrieval 或 learned representation 的论文；它的 inductive bias 是 model-based residual linearization + internal model principle。增益主要来自“把正确的 disturbance channel 显式建模”，而不是更大的优化器。需要警惕的是，仿真中模型补偿、状态观测、force disturbance 的形态都比较理想，因此结果可能放大了这个结构的效果；真实 pHRI 中人手接触通常有非平稳、摩擦、延迟和柔性环境耦合，未必都能被慢变 force-form disturbance 吸收。

Relation To Prior Work

最接近的谱系不是 learning-based pHRI，而是 operational-space control、classical impedance、offset-free MPC、anti-windup saturated linear systems 的组合。与 Hogan/Khatib 阻抗的关系是：无约束无扰动时它等价于一个 realized impedance；区别是加入了约束处理和扰动内模。与 variable impedance / impedance MPC 的区别是：它不直接优化 M_d、D_d 或复杂阻抗参数，而是优化 corrective force，并把参数依赖压缩到 B_d(q)。

看似新的部分里，Kalman 增广、random-walk disturbance、offset-free MPC、null-space limit avoidance 都不是新思想；实质创新在于把这些老思想通过 Layer-1 cancellation 组织成一个固定结构的 pHRI 控制问题。也就是说，这篇论文的新增信息不是某个单独模块，而是问题重写方式：把 torque-controlled manipulator 下的持续接触偏差转写成 LPV 双积分器上的输入偏置补偿问题。这个重写如果在硬件上成立，就比单纯“又一个 MPC impedance controller”更有价值。

Dataset / Evaluation

评估在 MuJoCo FR3 仿真上完成，任务包括轨迹跟踪、持续 step push、waypoint hold、多方向外力、边界 joint-limit stress test、位置噪声和惯量 mismatch。覆盖的控制现象比较对口：它确实检验了 transient deflection、steady-state offset、QP rate、Kalman augmentation 和模型误差吸收。实验设计中 C4/C5、100/500 Hz、Kalman on/off 的消融比较有信息量，能支持“prediction 和 estimation 分工不同”的 claim。

但 evaluation 还不足以支持强 deployment 结论。没有真实硬件接触，没有真实人手力/环境交互，没有 torque interface 的延迟和饱和细节，也没有 passivity/energy safety 验证。joint-limit safety 只是在测试 workspace 内经验成立，不是对所有参考轨迹或所有人力扰动的保证。噪声和惯量 mismatch 测试是有用的，但仍是受控仿真扰动；真实系统中摩擦、柔性、传感器偏置和 kinematic singularity 附近的退化会更复杂。

Limitation

方法的理论上限很清楚：它依赖残差动力学能被近似为任务空间双积分器，且扰动能被看作同一输入通道上的常值或渐近常值 force bias。若人类施力快速变化、接触环境是动态柔顺体、存在强摩擦/碰撞非光滑性，Kalman random-walk 只能滞后跟踪，不保证零误差。

零稳态误差定理有关键前提：observer-controller loop 稳定、稳态输入约束不活跃、扰动收敛。如果 sustained force 大到 corrective force 饱和，论文没有完整 anti-windup invariant-set 证明；这恰好是 pHRI 安全里很重要的情况。所谓 joint-limit safety 也不是 formal safety，它通过 null-space barrier 和 workspace projection 把问题部分转移为参考点修改，因此在任务语义和人类意图上可能产生副作用。

另一个限制是增益设计。论文承认 Q/R 只是 penalty，realized stiffness/damping 是 Riccati 映射结果；如果应用需要指定物理阻抗，如何系统反求权重文中未充分说明。增益来源不清会影响方法可迁移性。再者，方法自称 robot-agnostic，但实际要求 M、bias、J_v、Lambda^{-1} 可靠且实时，接近奇异或模型误差大时这种 generality 会打折。

Takeaway

• 1. pHRI 中 sustained-force offset 不应该主要靠提高 stiffness 或调 variable impedance，而应该显式引入 disturbance internal model；这是最可迁移的 insight。
• 2. 对机器人 MPC 来说，最有价值的 scaling 往往不是更快 solver，而是先通过解析结构把预测模型变成固定低维残差系统。
• constant-A residualization 是这篇最值得记住的工程-理论结合点。
• 3. MPC 在这里的角色应被准确理解：它主要管约束和 transient peak，零稳态误差来自 Kalman/offset-free augmentation。

一句话总结

这篇论文把 pHRI 阻抗控制从“高刚度抗扰”重写为“operational-space 残差线性化上的 offset-free 受限 MPC”，实质贡献是结构化建模和扰动内模的组合，而不是一个全新的 MPC 算法。