精读笔记
Problem Setting
Shield-Loco: Shielding Locomotion Policies with Predictive Safety Filtering（arXiv preprint / 2026）。这篇论文不是在重新训练一个更安全的 locomotion policy，而是在解决一个更实际的问题：已有 contact-conditioned RL locomotion policy 部署到带障碍的环境后，如何在不改策略、不牺牲太多 gait/task performance 的情况下，在线避免 foot contact 和 whole-body collision。
真正困难点是安全约束不在一个干净的低维状态空间里。四足机器人是否撞到障碍，取决于足端落点、swing trajectory、躯干姿态、policy tracking error、接触切换和全身几何。HJ/CBF 类方法想要 guarantee，就必须降维或手写 certificate；但降维后又不能解释真实全身碰撞。MPS 类方法能 forward simulate，但如果只是在危险时切到 recovery policy，就会变成保守的 task-agnostic fallback。
这篇的关键矛盾是：安全过滤需要高保真物理预测，但在线优化又不能在 torque/action space 里爆炸；需要 minimally invasive，但又必须足够强地改变未来几步运动几何。作者选择的切入点是 contact locations，因为它们正好处在 high-level geometry 和 low-level locomotion 之间。
Motivation
已有路线缺的是一个既能表达全身几何风险、又足够低维可在线优化的 intervention interface。低维安全模型的根本问题不是“不够复杂”，而是安全事件本身往往发生在低维模型看不见的链路上：脚碰物体、腿扫过障碍、身体侧向擦碰。直接用全身模型做 MPC 又通常太贵，尤其如果控制变量是 torque 或 joint target。
作者的核心观察是 contact-conditioned policy 已经提供了一个现成 abstraction：policy 接收期望足端接触位置，并把它转成关节目标和稳定 gait。也就是说，policy 本身可以被看成一个 learned whole-body tracking prior。安全层只需要修正 contact plan，而不是重新解决全身控制问题。
这个观察很重要：它把安全过滤从“替换控制器”变成“修补策略输入”。这避免了传统 shielding 的二元切换，也让 full-physics rollout 变得可承受，因为高层 contact sequence 可以低频、异步更新。
Core Idea
论文真正核心的方法思想是：把 safety filter 放在 contact target space，而不是 state/action/torque space。名义 planner 给出未来几步足端落点；filter 先用冻结的 RL policy 和全物理模型 rollout 这串落点，如果预测会发生安全违规，就在接触序列空间中做 sampling-based search，找一条不碰障碍、且尽量接近名义计划的替代 contact sequence。
这个建模方式改变了问题的结构。它不是试图学习一个全局 safe policy，也不是构造一个全局 barrier，而是在 test time 用高保真模拟做局部修补。contact locations 引入的 inductive bias 是：对于四足在平面杂物环境中的碰撞规避，主要决策自由度不是每个关节怎么动，而是脚往哪里落、身体被这些落点牵引到哪里去。
和 prior 的本质区别在于它不是 conservative recovery，也不是 reduced-order safe set，而是 task-preserving contact repair。它牺牲形式 guarantee，换取高保真预测和较低维优化；它的泛化不是来自训练覆盖所有障碍，而是来自 online optimization 对新几何的适配。
Method
方法的必要机制可以压缩成四点。
第一，预测式触发而非持续改写。filter 每步先 rollout nominal contact plan，只有预测到 violation 才启动优化。这解决的是 safety filter 常见的 invasiveness 问题：如果 nominal 行为安全，就不干预，从而保留原策略性能。
第二，closed-loop full-physics evaluation。候选 contact sequence 不是用 reduced-order dynamics 打分，而是通过 policy π(s,p) 和 MuJoCo/MJX full-physics rollout 得到实际状态轨迹。这里的关键变化是安全代价依赖实际模拟出的 foot position 和 whole-body contact，而不是 commanded contact target 本身。这一点是它区别于只做几何 footstep projection 的核心。
第三，有限 horizon 加 learned value bootstrap。在线 horizon 不可能太长，所以目标函数末端接一个离线 TD 学到的 value function。这个 value 更像 planner 的 long-horizon prior，不提供安全保证，但能减少短视 contact repair。文中结果显示 value 对 tracking cost 更有帮助，对 actual violations 的提升有限，说明它主要改善计划平滑性/长期任务一致性，而不是解决底层安全。
第四，sampling optimizer 的可用性增强。projection 把 sampled contacts 推到 SDF feasible set，直接注入几何可行性；momentum 让 MPPI/CEM reweighting 的均值更新更快；replica exchange 用多温度分布缓解局部最优。三者中 projection 最像核心安全机制，momentum 和 replica exchange 更像使 test-time optimization 在有限预算内更稳定的 engineering。
Key Insight / Why It Works
这篇最重要的 insight 是 representation alignment：contact-conditioned policy 的输入空间刚好也是安全规划应该修改的空间。很多安全方法失败，是因为 intervention variable 和风险生成机制不对齐：CBF/HJ 在低维状态里保证安全，但真实碰撞发生在全身几何；torque-level MPC 能表达全身行为，但搜索空间太大、在线不可用。contact target space 是一个折中点：它低维、语义明确、能通过 policy 影响全身运动。
方法有效主要来自三件事的组合：1）test-time compute：每次遇到障碍都在线采样搜索，而不是依赖离线 policy 见过类似场景；2）full-physics rollout：用更接近真实 closed-loop 行为的模型评估候选，而不是相信 reduced-order approximation；3）contact-space inductive bias：把搜索限制在足端落点序列，使优化问题比 torque-level 全身 MPC 小得多。
我认为最核心贡献是“在 contact-conditioned locomotion 上做 post-hoc contact repair”这个接口选择，而不是 MPPI、momentum 或 replica exchange 本身。MPPI/CEM/parallel tempering 都是已有思想，论文的新增价值在于把它们组织到一个合适的 locomotion safety interface 上。
projection 很可能是实际安全提升中最关键的工程组件。附录 ablation 也显示 projection 对 planner/actual violations 的影响最大。momentum 的收益更像优化加速，在低 iteration budget 下有用，但不改变问题本质。replica exchange 带来更低 tracking cost 和局部最优逃逸，但代价是显著计算开销；其增益是否在更复杂场景中稳定，文中未充分说明。
这不是一个有形式安全保证的方法。它本质是 model-based test-time repair。所谓 long-horizon reasoning 很大程度来自 finite-horizon rollout + learned terminal value + warm start，而不是显式构造 viability set。实际碰撞仍大量来自 swing-phase 中间姿态，说明 contact target 安全不等于 closed-loop trajectory 安全。
Relation To Prior Work
最接近的谱系是 predictive safety filtering / model predictive shielding + sampling-based MPC，而不是传统 safe RL。它把 MPS 的 forward simulation 思路保留下来，但不采用 task-agnostic recovery controller，而是在 nominal contact plan 附近搜索 minimally invasive alternative。
相对 HJ/CBF，它的本质差异是放弃全局 certificate，换取全身模型和在线适配。HJ/CBF 的优势是理论闭环安全，但在 legged whole-body contact 里通常只能通过 reduced-order 模型落地；Shield-Loco 直接承认 guarantee 不可得，用 full-physics rollout 做经验预测。
相对 torque-level sampling MPC，它的差异是 intervention abstraction。已有 full-order sampling MPC 可以在 joint/torque 空间规划，但计算预算和 horizon 很难满足安全过滤需求。这里 contact sequence 不是降维到 unicycle，而是利用 policy 作为 learned controller prior，把高维控制问题压缩成足端几何问题。
相对 prior contact-location safety/planning，它的新意在于不用 reduced-order model，而是用冻结 RL policy 的 closed-loop full-physics rollout 来评估全身碰撞。这是实质创新点。至于 MPPI、CEM、value bootstrap、replica exchange、momentum update，本身都不是新概念，更像已有优化工具在该接口下的重组。
Dataset / Evaluation
评估覆盖了仿真密集杂物环境、若干 qualitative 场景，以及 Unitree Go2 真机实验。任务设置与核心 claim 是匹配的：claim 是 contact-space full-physics safety filtering 可以在 cluttered locomotion 中减少碰撞且保持 nominal behavior，实验确实围绕 dense objects、large obstacle、dynamic obstacle 做了验证。
但 evaluation 的外推范围有限。仿真中障碍物几何和位置是已知的，且主要是平地 primitive obstacles；这正好适配 SDF projection 和 contact repair。没有真正验证 perception uncertainty、复杂地形、非凸大尺度导航、humanoid whole-body coordination 或需要主动 torso manipulation 的场景。
和 CBF/HJ baseline 的比较有参考价值，但这些 baseline 使用 unicycle approximation，本来就不擅长 dense clutter whole-body collision。因此结果更多说明 reduced-order safety 在该设定下不够，而不是证明 Shield-Loco 相对所有 strong model-based planner 都优越。
实验中一个很有信息量的现象是：增加 horizon/iteration/sample 不一定降低 actual violations，甚至会因为异步 stale planning 增加碰撞。这反而支持了作者对低频异步优化 trade-off 的讨论，也暴露出该框架的实际上限。
Limitation
最大限制是安全变量不完备。contact locations 可以影响身体轨迹，但不能直接约束 swing-leg path、躯干姿态、关节空间避障和瞬时 tracking error。论文自己也承认实际 violation 多来自 policy 在中间 swing-stance phase 产生的不安全构型。这说明方法把问题从“如何安全控制全身”转移成“如何给 policy 更好的 contact targets”，但 policy 是否安全执行这些 targets 仍然没有保证。
第二，环境假设偏强。filter 假设障碍几何和 pose 已知，且可用 SDF primitive 表示。真实部署中的 perception latency、false negative、动态障碍预测误差没有系统处理。若感知不可靠，full-physics rollout 的高保真意义会大幅下降。
第三，模型误差和 sim-real gap 没有被严肃处理。MuJoCo rollout 被当作高保真模型，但 real-world contact/friction/compliance、物体可移动性、机器人状态估计误差都会影响安全预测。真机实验说明可以跑，但不足以证明鲁棒安全。
第四，scaling 上限来自 online compute。该方法本质依赖大量 parallel rollout。更长 horizon、更复杂机器人、更多障碍、更高维 contact sequence 都会推高计算。异步设计避免低层失稳，但不能避免 planning stale；当场景快速变化时，这会成为硬瓶颈。
第五，增益归因仍有不清晰处。projection、value、replica exchange、momentum、sample budget、full-physics model 同时存在，虽然有 ablation，但缺少更强的 baseline 来判断到底是 contact interface 的贡献，还是主要来自 scaling / test-time compute。Replica Exchange 的收益尤其可能主要来自更大的有效搜索预算。
Takeaway
- 1）最值得迁移的不是某个 optimizer trick，而是安全过滤的接口选择：在 learned low-level controller 的结构化输入空间做 intervention，通常比直接改 action 更稳、更 scalable。
- 2）对于 legged locomotion，contact locations 是一个很强的 planning/safety bottleneck representation：足够低维、可解释、能影响全身，但又没有低维 centroidal/unicycle 那么失真。
- 3）这类方法代表 safe locomotion 的一种务实演化：从离线 guarantee 转向 test-time predictive repair，从全局 safe set 转向局部 high-fidelity rollout。
- 它不会给形式安全，但可能更接近真实部署可用。
一句话总结
Shield-Loco 是一篇把 legged locomotion safety filtering 从低维保证/保守恢复推进到 contact-space test-time predictive repair 的工作，真正贡献在于选对了可在线优化且与全身几何风险对齐的 intervention interface。