精读笔记

Problem Setting

论文标题：Multi-Rate Nonlinear Model Predictive Control for Wall-Supported Bipedal Locomotion of Quadrupedal Robots（arXiv preprint / 2026-07-03）。这篇论文解决的不是一般 quadruped locomotion，也不是普通 rear-leg bipedal walking，而是一个更窄但更难的模式：四足机器人以后腿双足推进、前腿与墙面接触提供支撑，在狭窄走廊和不平地形中保持动态稳定。关键矛盾是：ERF/姿态/CoM 需要高频连续调节，而 foothold/contact-point 只在步态切换时更新；如果把两者拆开，力控会追一个已经不合适的支撑几何，如果把两者完全统一成高维混合优化，又很难实时。以前方法卡在两个端点：Raibert 类 heuristic 反应快但不看未来约束，传统 MPC 往往优化力或状态而把落脚作为外部变量，contact-implicit 或 whole-body NMPC 虽更 general 但计算和工程复杂度高。

Motivation

作者真正想补的缺口是：wall-supported bipedal locomotion 中，落脚点不是低层 swing-leg tracking 的细节，而是决定可产生恢复力矩和墙面支撑效果的核心状态。尤其在前腿靠墙、后腿踩地的非标准支撑结构里，前后腿 step length 的非对称性会直接改变 CoM 相对支撑点的位置和可用力矩臂；用一个速度误差公式去放脚，本质上丢掉了未来接触相位、关节可达性和摩擦约束。论文的动机不是“NMPC 比 heuristic 高级”，而是指出该任务天然是 multi-rate：力是 fast input，足端位置/步长是 slow input；正确的建模应该尊重这个时间尺度差异，而不是把 slow variable 当成外部 reference。

Core Idea

核心思想是把 contact-point evolution 变成预测动力学的一部分。作者把原来只描述 CoM/姿态的 SRB state 扩展为包含足端位置的 augmented state，并把 step-length increment 作为 slow input；然后用 indicator function 只在预定义 switching instants 更新 slow input。这样优化器每 10 ms 求一次，但 foothold 只在 gait boundary 发生实际变化，避免了把多速率系统硬塞进 uniform-rate NMPC。直觉上它有效，是因为 optimizer 不再只问“当前该施加什么力”，而是同时问“未来几个接触相位里支撑几何应该怎样演化，才能让这些力可行且有恢复力矩”。

和 prior 的本质区别在于信息流重组：Raibert heuristic 是状态误差到落脚点的局部反馈，传统 MPC+footstep planner 是力/状态优化与足端规划的弱耦合；这里 foothold 被放进同一个 horizon 内，由未来 CoM、姿态、contact availability 和 feasibility constraints 共同决定。新增的 inductive bias 是“接触几何随 gait domain 分段常值演化”，这比任意 contact-implicit 更受限，但也更实时、更稳定。

Method

方法上应抓住机制而不是模块名。第一，SRB NMPC 用 reduced-order dynamics 承担高层 coupling：它不试图在 full-order 空间里优化所有关节，而是只保留 CoM、姿态、ERF 和足端位置这些决定整体平衡的变量，解决实时性与动态一致性的折中。第二，multi-rate augmentation 解决 slow foothold 与 fast force 的采样率冲突：通过 v(t+1)=v(t)+delta_T Delta v(t)，优化变量可以每步存在，但只有接触切换时生效；这相当于把 hybrid timing 的一部分硬编码进连续 NLP。第三，接触相位矩阵 E_u 和 E_Delta_v 约束哪些 limb 当前能施力、哪些 limb 当前能更新位置，避免 optimizer 产生物理上不存在的力或落脚更新。第四，低层 WBC/QP 负责 full-order consistency：它用 virtual constraints 追踪 MR-NMPC 给出的 CoM、姿态、足端和 ERF reference，同时加入 torque/friction/no-slip 约束；这部分更像 anchoring layer，核心作用是把 reduced-order plan 落到机器人动力学上。

Key Insight / Why It Works

最关键的 insight 是：在 wall-supported bipedal quadruped 中，稳定性很大程度来自“未来支撑几何”的可调性，而不是单纯更好的瞬时力分配。前腿墙接触和后腿地面接触形成的力矩臂高度依赖足端相对 CoM 的位置；当粗糙地形或扰动改变 CoM 速度/姿态时，允许前后腿非对称地调整 step length，会产生 Raibert 对称/局部规则无法提供的恢复力矩。换句话说，论文把 foothold 从 reactive policy 变成了 predictive state，增益主要来自 better inductive bias + test-time optimization，而不是 scaling 或 data coverage。

真正的贡献很可能是 slow-input dynamics 的 formulation，而不是 WBC 或 SRB 本身。SRB+QP WBC 是 legged robotics 里成熟套路；Raibert reference 甚至仍被用作 Delta v_ref，因此它没有完全抛弃 heuristic，而是把 heuristic 变成 soft prior，再由 constrained NMPC 修正。辅助部分包括高频 WBC、Bezier swing interpolation、权重调参等，它们保证系统跑起来，但不解释主要性能差异。需要警惕的是，实验增益可能同时来自“前后腿步长解耦”和“约束感知优化”，而不一定专属于 multi-rate indicator formulation；文中未做 ablation 来隔离这两点。

Relation To Prior Work

这篇属于 reduced-order NMPC + full-order WBC 的技术谱系，接近 MIT Cheetah 系 SRB MPC、centroidal NMPC、virtual-constraint QP tracking，以及一些 foothold-aware MPC。它和 RL-based bipedal quadruped 的区别不是能力上更 general，而是约束透明、可解释、可直接处理 ERF/friction/torque feasibility。和 contact-implicit MPC 相比，它牺牲了接触发现自由度，换取固定 gait schedule 下的实时性和更简单 NLP。

看似新的“jointly optimizing contact points and continuous trajectories”并不是从零开始的新范式；已有 MPC 也优化 foothold 或把 foothold 作为 horizon 变量。实质差异在于作者不把未来 foothold 当独立静态变量，而是把它作为跨 gait domain 传播的 slow state，用 step-length input 驱动。这一建模细节让 foothold evolution 有了动态一致性，也让 multi-contact locomotion 中的 front/rear foot asymmetry 更自然地进入优化。

Dataset / Evaluation

评估集中在 RaiSim 仿真：Unitree A1、45 cm 窄走廊、随机木块障碍、速度 ramp、外力扰动。任务设置和 claim 是匹配的，因为它确实测试了 wall-supported、rough terrain、disturbance rejection 下的 foothold adaptation。实验最有说服力的部分是 nominal flat terrain 下两个方法表现接近，随后在障碍和扰动下分化，这降低了“只是 tracking gain 不同”的解释。

但 evaluation 的覆盖仍偏窄：没有真实墙面不确定性，没有 perception-aware foothold selection，没有多种墙宽/摩擦/高度条件系统 sweep，也没有与更强 optimization baseline 比较。Raibert 是合理但偏弱的 baseline；如果 claim 是“multi-rate foothold dynamics 优于 heuristic”，证据足够；如果 claim 是“统一 MR-NMPC 是该问题的优选框架”，证据还不够。真机部分仅是 preliminary，不能支撑 robust deployment claim。

Limitation

最大隐含前提是 contact schedule 已知且可信。方法并不解决何时接触、接触哪面墙、遇到几何突变如何改步态的问题；它是在预设 gait domain 内优化 foot placement 和 ERF。因此 scalability 上限不是 NLP 变量数本身，而是手工 contact mode design 和环境结构假设。狭窄平行墙走廊是很强的 structural prior，一旦墙面间断、法向估计错误或前足接触面积不足，MR-NMPC 的可行域会迅速变差。

第二个限制是 reduced-order/full-order gap。SRB 忽略腿部惯量、冲击、局部接触几何和执行器带宽，WBC/QP 能补一部分但不能消除模型偏差。文中已经承认真机速度估计噪声会导致 forward pitching，说明仿真中的稳定 limit cycle 对 state estimation 很敏感。第三，增益归因不清：没有 ablation 说明是 multi-rate gating、foothold-as-state、asymmetric front/rear step、constraint awareness 还是 horizon lookahead 起主导作用。最后，所谓未知地形主要是仿真随机木块，不等于感知闭环下的 terrain uncertainty。

Takeaway

• 第一，非标准腿式运动中，contact geometry 应该被视为慢状态，而不是低层落脚命令；这点可迁移到攀爬、支撑式 manipulation、窄空间 locomotion。
• 第二，multi-rate optimal control 是比 contact-implicit 更工程可落地的折中：固定接触时序，优化接触点演化。
• 第三，未来真正值得做的是把该 formulation 和 perception/contact uncertainty 结合，而不是继续和 Raibert 比；更强的问题是：在不可靠墙面和不确定 terrain 下，slow contact state 如何保持递归可行。
• 第四，这篇论文推动的是建模组织方式，而不是新的求解器或控制架构。

一句话总结

这篇论文把 wall-supported bipedal quadruped locomotion 从“SRB MPC + 启发式落脚”的松耦合控制，推进到“多速率接触几何作为预测状态”的约束优化框架，真正贡献在于 foothold evolution 的时间尺度建模。