精读笔记

Problem Setting

论文标题：Motion Planning with Model-Based Diffusion via Constraint Optimization and Adaptive Scheduling（arXiv preprint / 2026）。

这篇论文实际处理的是 single-robot motion planning 中一个很具体但重要的问题：如何让 model-based diffusion 在强非凸障碍约束下既保持随机采样的多模态探索，又输出 collision-free、dynamically feasible 的轨迹。这里的困难不是动力学 rollout 本身，而是约束信号如何进入 diffusion denoising：hard feasibility indicator 会让不可行样本权重塌缩，soft penalty 又只能改变偏好，不能把轨迹真正拉回可行域。

关键矛盾是 exploration vs. certification。MBD 的优势来自大量 rollout samples 形成的 posterior-like search；但安全规划要求在 tight passage 和非凸障碍中做局部精确 correction。以前方法要么用 soft barrier 维持 score signal，但最终安全不稳；要么用 projection/CBF-QP 强行过滤，但容易变局部、保守、昂贵，并且破坏扩散过程中的多样性。

Motivation

已有路线缺的是一个统一的约束调度视角。MBD 本身有 dynamics-aware sampling，但没有强安全机制；EB-MBD 之类 soft prior 避免 dead samples，却不能保证 strict feasibility；CBF/QP projection 类方法能硬纠正，但如果固定每步执行，会在 early noisy stage 过度约束探索，在 late clean stage 又可能计算浪费。

作者真正的观察是：reverse diffusion 不是一个静态 optimization step，而是一个从 noisy 到 clean 的 annealing process。约束违反的形态、需要的 correction 强度、以及值得投入的 compute 都应随 denoising 阶段变化。因此缺口不是“没有 penalty”或“没有 QP”，而是没有把 feasibility pressure 和 projection compute 放进同一个 adaptive scheduling loop。

Core Idea

MD-COAS 的核心思想是把 safety enforcement 变成 diffusion-time constrained optimization。它用 iALM 构造 soft feasibility prior，使不可行但接近可行的样本仍然能通过连续权重影响 Monte Carlo score；再用 CFS trajectory-level projection 对部分 proposal 做硬纠正，避免 soft prior 在 tight non-convex region 中只会降低权重却不能产生可行轨迹。

本质区别在于信息流被重新组织了：prior work 往往在 sample scoring 或 sample correction 中二选一，而这里是先用 violation residual 估计当前 batch 的约束状态，再同时调节 soft density 和 hard projection budget。这个 inductive bias 很明确：扩散采样负责全局多模态 proposal，CFS 负责局部可行化，primal-dual schedule 负责决定当前阶段安全约束该有多强。这比固定 filter 更可能 scalable，因为它把 expensive projection 当作 test-time compute resource，而不是每步无条件执行。

Method

第一，iALM soft prior 解决 hard indicator 导致的 sample starvation。它把 horizon-normalized constraint violation 加到 Boltzmann target 中，通过 λ 和 ρ 让 violation 越大的轨迹权重越低，但不会直接把所有 infeasible samples 置零。核心变化是 MCSA score 仍能从“接近可行”的样本中得到方向，而不是在高约束环境中权重退化。

第二，CFS hard projection 解决 soft prior 缺乏 strict correction 的问题。它不是 per-time-step CBF filter，而是在 stacked control sequence 上做 trajectory-level convex feasible set projection，用局部 half-space 近似障碍约束并最小扰动控制序列。核心变化是 correction 发生在整条轨迹层面，因此比逐步安全过滤更能保留路径形状和动态一致性。

第三，adaptive scheduling 解决固定安全强度与 diffusion annealing 不匹配的问题。batch violation residual 驱动 λ、ρ 更新，projection probability、active-set size 和 CFS iteration 由 violation 与 compute dual 共同调节。这里真正有用的是把安全约束看成随 denoising 变化的资源分配，而不是一组固定 penalty/QP hyperparameters。

Key Insight / Why It Works

最关键的有效性来源大概率是 soft signal 与 hard correction 的互补，而不是 diffusion 本身的新建模。MBD 已经提供了 training-free stochastic trajectory optimization；MD-COAS 的贡献是让约束信息以两种尺度进入：soft iALM 影响 sample weighting 的全局方向，CFS projection 在局部几何上修复高价值 proposal。这避免了两个典型失败模式：纯 soft 方法在 tight passage 附近只会惩罚而不修复；纯 hard 方法会把所有样本投到局部安全壳里，牺牲多模态和 compute。

adaptive scheduling 更像 test-time compute allocation / curriculum，而不是新的 planner reasoning。早期允许更多探索，后期强化可行性，这是一个合理的 denoising curriculum。它的收益主要应来自减少无效 projection 和避免固定强约束破坏采样分布；但文中增益归因仍不完全清楚，因为 MD-COAS-F 已经很强，说明 CFS trajectory projection 本身可能是主要贡献，adaptive scheduling 可能更多是 efficiency gain。

理论上成立的部分是局部的：iALM weight 对 violation 单调，CFS-QP 对 convexified selected constraints 可行，Bernoulli gate 带来 expected residual contraction。这个理论支持“为什么 batch residual 会下降”，但不支持全局非凸规划保证。换句话说，它不是证明 diffusion 学会了复杂 planning，而是说明在局部 correction 可行、projection 频率足够时，residual 可以被压下去。

这篇更像 better inductive bias + test-time compute，而不是 data coverage 或 retrieval。它不依赖 demonstration dataset，这是优点；但也意味着性能高度依赖 hand-designed objective、SDF、dynamics rollout 和 QP solver 的质量。所谓 generalization 主要是 optimization procedure 的跨环境复用，不是 learned representation 的泛化。

Relation To Prior Work

最接近的谱系有三条：MBD/MPPI/CEM-style stochastic trajectory optimization，safe diffusion planning，和 sequential convex optimization/CFS/CBF-QP。MD-COAS 的位置是在 MBD 上 graft 一个约束优化层，而不是提出新的 diffusion model。

相对 MBD，它新增的是 constraint-aware target density 和 local feasibility projection；相对 EB-MBD，它不只用 barrier/soft prior，而是加入能实际修复轨迹的 CFS operator；相对 MDOC/CBF-QP，它把 correction 从 per-step safety filter 提升为 trajectory-level projection，并且不是固定每步执行；相对 SafeDiffuser/DPCC-C，它避免了离线训练数据依赖，但代价是强依赖已知模型与可解 projection。

看似新的部分里，iALM、CFS、primal-dual budget update 都是已有思想；实质创新在于把它们嵌进 MBD 的 reverse diffusion loop，并用 batch residual 统一调节 soft weighting 与 hard projection。真正新增的信息不是某个优化器，而是“扩散 denoising 的安全机制也应该 anneal”。

Dataset / Evaluation

评估主要覆盖两个层级：随机 2D obstacle maps 和 D3IL 7-DoF arm avoidance。2D benchmark 对非凸障碍密度和 tightness 有一定压力，适合验证 soft-only 与 hard projection 的差异；7-DoF 任务增加了非线性 kinematics 和 joint-space projection，但 end-effector 仍主要在 2D plane 上避障，不能代表一般高维机器人避障。

实验支持的 claim 是有限但清楚的：在这些已知模型、已知 SDF、可并行 rollout、可解 QP 的设置中，adaptive iALM+CFS 比单纯 MBD、soft barrier 或固定 hard filter 更稳。它没有证明真实世界部署能力，没有真机结果，也没有验证复杂接触、动态障碍、partial observability 或高维全身碰撞。

另一个 evaluation limitation 是对比中 model-free pretrained baselines 与 model-based online optimization 的资源和假设不完全对齐。DPCC-C 很慢、SafeDiffuser 受 horizon 和 data prior 限制，这些结果能说明 MD-COAS 在该设置下强，但不能简单外推为 safe diffusion planning 的通用 superiority。

Limitation

方法成立依赖几个强前提：dynamics 已知且 rollout 可微，workspace signed distance 和梯度可得，障碍可被 CFS 局部 half-space 有效近似，QP 在 active set 上可行，并且 batch violation statistic 能代表真实约束难度。这些前提在工业机器人静态避障中合理，在复杂接触、未知环境、非光滑动力学或 perception-in-the-loop planning 中会明显变弱。

所谓 hard safety 不是全局 safety guarantee。CFS 保证的是局部凸化和选中约束集合内的 feasibility；active-set truncation、linearization error、finite QP tolerance 都可能留下未覆盖碰撞。文中也承认理论是 local residual contraction。对高度非凸、多窄通道场景，planner 仍可能被局部 feasible basin 限制。

scalability 上限主要在 projection cost 和约束规模。每个 reverse step 有 M 个样本，每个样本可能做多次 CFS-QP；高维机器人、复杂 mesh collision、长 horizon、多障碍时，projection 会成为主瓶颈。adaptive scheduling 能省 compute，但没有消除 projection 本身的复杂度。

增益归因不完全清楚。MD-COAS-F 已经在许多场景表现很强，说明主要能力可能来自 CFS projection 的强局部 optimizer，而 adaptive scheduling 更偏工程效率。文中未充分说明 scheduler 对不同任务是否需要重新调参，也未展示足够系统的 compute-performance frontier。

泛化也要谨慎理解。这里没有 learned data prior，所以不存在 demonstration memorization；但也没有语义级泛化能力。它的“泛化”来自同一优化机制可迁移到类似模型和几何约束，只要 SDF、dynamics 和 QP solver 都能工作。

Takeaway

• 1. 在 model-based diffusion planning 中，安全约束最好不要只作为 terminal penalty 或 post-hoc filter；更有效的做法是同时影响 sample weighting 和 sample correction。
• 2. 对 constrained diffusion，denoising schedule 和 constraint schedule 应该耦合。
• 早期探索、后期可行化，本质上是一个 test-time curriculum，这个 insight 可迁移到 constrained generation、robot control 和 constrained design optimization。
• 3. 这篇真正推动的是把 classical constrained optimization 嵌入 diffusion sampler 的方式，而不是 diffusion model 本身。

一句话总结

MD-COAS 是一篇把 model-based diffusion planning 从“带安全 penalty 的随机优化”推进到“由 primal-dual 约束调度驱动的 test-time safe trajectory optimization”的工作，核心贡献是软可行性信号、局部硬投影和扩散退火过程的统一组织。