精读笔记
Problem Setting
[论文标题] Real-Time Rulebook-Aware Nonlinear MPC for Autonomous Driving with Priority-Biased Tiered Slacks（arXiv preprint / 2026）
这篇论文实际处理的是自动驾驶 planner/controller 中一个长期被工程系统绕开的矛盾：规则有优先级，但在线控制器需要在有限时间内输出一个可执行控制；规则冲突不可避免，但系统又必须能解释到底牺牲了什么。真正困难点不是写出更多 rule constraint，而是如何在非凸、实时、闭环、需要 warm start 的 NMPC 中表达“安全 > 法规 > 舒适 > 效率”这种优先级结构。
以前方法卡在两个端点：严格 lexicographic / hierarchical optimization 语义干净，但在驾驶 NMPC 里计算代价和 warm-start 代价高；普通 weighted penalty 能跑，但优先级语义弱，也很难审计。论文选择中间路线：承认没有词典序保证，用强分离 slack penalty 给出可运行的 priority bias。这个判断是工程取向的，不是理论突破。
Motivation
作者的动机不只是“让 MPC 加规则”，而是指出两个缺口。第一，自动驾驶控制器需要在控制周期内处理规则冲突，并留下可审计残差；现有 learning planner 通常不给清晰 per-rule trade-off，传统 penalty MPC 又无法表达优先级解释。第二，闭环评测常把 log tracking / route adherence 这类依赖人类 log 的指标混进安全法规指标，导致非模仿式 planner 被系统性惩罚。
核心观察是：一个 planner 如果从 executed state 重新规划，它自然可能选择不同于 recorded human 的合法轨迹；这时用 logged pose 作为评测参考，本质是在测 imitation，不是在测 driving quality。因此论文的真正缺口是“双重可解释性”：控制侧要解释规则违反，评测侧要解释分数来源。
Core Idea
论文的核心思想是把 rulebook 编译成一个 tiered-slack NMPC，而不是为每条规则单独做硬约束或单独 penalty。每个时间步、每个优先级 tier 共享一个 slack，同一 tier 内所有规则通过这个 slack 被软化；不同 tier 的 slack penalty 相差多个数量级。这样，优化器在无法同时满足所有规则时，会被强烈偏置为先牺牲低优先级规则。
这个建模改变的不是车辆模型，而是冲突解决的信息结构：规则不再只是 cost terms，而是带有层级语义的可审计 residual channel。它引入的 inductive bias 是“违反应集中在低优先级 tier”，而不是“所有约束按调参权重平滑折中”。和 prior 的本质区别在于，它没有追求严格词典序，而是为了实时闭环把优先级折成一个数值稳定的单次 NLP。这个选择牺牲理论语义，换取 online viability。
Method
关键机制可以压缩成四个。
第一，tiered shared slack。它解决的是规则数多、冲突多、在线求解变量膨胀的问题。共享 slack 降低维度，并让违反量按优先级层记录；核心变化是从 per-rule independent relaxation 变成 per-tier coupled relaxation。
第二，强分离二次 slack penalty。它解决的是优先级偏置和数值稳定之间的折中。二次 penalty 不具备 exact penalty 的严格性质，但对 IPOPT 更友好；核心变化是把 hard hierarchy 改成 smooth scalarized hierarchy。
第三，actuation bounds hard、rule constraints soft。这个区分很重要：车辆物理可执行性不被 slack 放松，但碰撞、道路边界等最高优先级规则仍是软约束。也就是说，它保证的是控制输入边界，不保证安全规则不可违反。
第四，anytime solve + dynamics projection。它解决的是非凸 NLP 尾延迟。IPOPT 超时返回 best iterate，再用车辆动力学传播第一步控制，确保 executed next pose 模型一致。这个机制是实时工程补丁，不是规划质量提升本身。
Key Insight / Why It Works
最重要的 insight 是：在实时 NMPC 里，优先级不一定要被实现成严格 lexicographic order；只要违反分布在统计上稳定地落到低优先级规则，并且 residual 可被审计，很多工程需求已经被满足。W-SQP 有效的主要原因不是新优化理论，而是一个更合适的 inductive bias：把冲突处理的自由度显式放在 tier slack 上，并用数量级分离的 penalty 改变优化器的违反偏好。
最可能的核心贡献有两个。控制侧是 tiered shared slack + residual audit 的系统化组合；评测侧是 log-coupled vs log-independent 的拆分。后者的概念贡献更干净，也更容易迁移，因为它直接指出许多 benchmark aggregate 的 Goodhart 问题：只要某个指标引用 human log，expert replay 就天然占优，非模仿式 planner 就会被扣 imitation premium。
哪些可能只是 engineering / scaling：CasADi + IPOPT + MUMPS、RK4 bicycle model、warm start、CPU time cap、projection，都主要是把系统跑起来的工程组合。它们重要，但不是方法论新意。NLP 尺寸控制和 sparse structure 是 real-time 的关键，但也属于成熟 MPC 工程。
增益来源有一部分清楚：no-tiering ablation 和 priority-ratio sweep 支持“ordering 比单纯 stiffness 更重要”。但仍有不清楚的部分：低权重 log reference、route surrogate、scenario complexity selection、evaluator rule design 都可能影响 W-SQP 看起来接近 expert 的程度。文中未充分说明 surrogate 尺度不一致如何影响不同 tier 之间的真实 trade-off，尤其 m、m^2、速度、加速度残差混在统一 slack penalty 下，所谓 priority bias 可能部分是单位尺度和阈值工程的产物。
Relation To Prior Work
这篇最接近三条路线：rulebook / rule-aware planning，soft-constrained MPC，closed-loop benchmark metric analysis。它不是在发明新 MPC，也不是在提出严格 rulebook semantics。它更像把已有 weighted slack NMPC、priority penalty、audit logging 和 closed-loop evaluation taxonomy 组合成一个完整实验系统。
和 lexicographic / hierarchical optimization 的差异是：后者追求优先级语义正确，W-SQP 追求单次在线求解可用。和 CBF/RSS/formal methods 的差异是：后者试图提供 safety feasibility 或 formal envelope，W-SQP 只是 soft rule trade-off，没有 safety certificate。和 learning-based planner 的差异是：W-SQP 的规则结构外显、可审计，但扩展到复杂交互的表达力更弱。
看似新的部分，如多层 penalty、soft constraints、MPC warm start，本身都不是新思想。实质创新在于把它们放进自动驾驶 rulebook 场景，并明确承认“priority-biased but not lexicographic”。这比很多声称 rule-compliant 的方法更诚实。
Dataset / Evaluation
评测使用 WOMD/Waymax 的闭环模拟，覆盖 150 个复杂场景，并与 expert replay、reactive baseline、PDM-Closed-style baseline 以及 no-tiering ablation 比较。它足以支持两个中等强度 claim：W-SQP 在该模拟设置中能实时近似运行；naive aggregate 中的主要劣势来自 log-coupled imitation metrics。
但它不能支持部署级 claim。没有真实车、没有 HIL、没有感知/估计误差、没有 actuation latency，也没有 learned reactive agents 的主实验。IDM agent 和 constant-velocity prediction 会显著简化交互难度。评测的强项是 paired decomposition：同一场景下拆开 log-independent 与 log-coupled rules，这确实验证了 metric confound。弱项是控制器能力的外推：group-level parity 不等于真实道路安全，也不等于长尾场景鲁棒。
另一个值得注意的问题是 evaluator 本身并非完全外部标准，部分规则很少触发，部分规则没有 controller surrogate。论文对此比较诚实，但这意味着一些高 compliance 不能解释为 planner 真正学会或规划了对应规则，只能解释为在这些场景和这个 evaluator 下没有显著暴露问题。
Limitation
第一，方法成立依赖 penalty separation 足够大且尺度合适，但不同约束单位和量纲不一致。文中承认未 nondimensionalize，这会让 priority tuning 混入大量手工尺度工程。所谓 tier priority 不是纯语义结构，而是语义、单位、阈值、权重共同作用的数值产物。
第二，soft Tier-1 是根本上限。碰撞和 road edge 仍可被 slack 放松，所以它不能作为 safety layer。若部署，需要 CBF、reachability、RSS 或独立 safety monitor 兜底。否则“规则最高优先级”只是高 penalty，不是不可违反。
第三，交互建模很弱。constant-velocity prediction 和 center-to-center headway proxy 不足以表达复杂多车博弈。planner 看起来有规则权衡，但不等于具备长期交互 reasoning；更像在短 horizon 内用 soft potential 做局部优化。
第四，评测结论依赖 benchmark 和 metric taxonomy。log-coupling confound 是结构性成立的，但 -10pp 这种量级是数据、阈值和 planner 行为共同决定的。泛化到其他 benchmark 时方向大概率成立，幅度不应照搬。
第五，实时性还没有过硬。90ms CPU limit 不是 wall-clock hard deadline，IPOPT 也不是硬实时优化器。projection 可以修复 executed dynamics consistency，但不能保证 returned decision sequence 的约束语义。
Takeaway
- 最值得记住的不是 W-SQP 这个具体控制器，而是两个可迁移判断。
- 第一，自动驾驶 rule-aware planning 中，严格词典序和实时 NMPC 之间存在实际张力；priority-biased soft hierarchy 是一个务实中间点，但必须明确它不是 safety guarantee。
- 第二，per-rule residual logging 应该成为 rulebook-aware planner 的基本接口。
- 没有 audit channel 的 planner 很难解释冲突解决过程，即使它 benchmark 分数高。
一句话总结
这篇论文是一次务实的 rulebook-aware NMPC 系统化重组：它用 tiered soft slacks 把优先级冲突变成可实时求解、可审计的数值偏置，并更重要地指出闭环评测中 log-coupled imitation 指标不应被当作驾驶质量。