精读笔记
Problem Setting
这篇论文处理的是遮挡感知安全规划中的一个很具体但很关键的问题：ego 在当前时刻选择一个控制后，如果下一时刻从遮挡区观察到任意隐藏 adversary，是否仍有足够余量执行 backup policy 并在碰撞前进入不变安全集。它不是在做 probabilistic risk，也不是在预测最可能出现的人，而是在做 worst-case hidden-agent safety certification。
真正困难点在于三件事叠在一起：隐藏体初始状态是一个几何集合，未来行为是有界对抗控制，碰撞条件又是 ego braking rollout 与 adversary reachable occupancy 的交集。以前方法要么把这个问题投到道路拓扑上，使集合计算变成沿 lane 的一维/低维问题；要么用 HJ 直接解高维可达性，慢且有网格误差；要么用简单包络过近似，安全但会在窄空间直接失去可行性。AVP 的关键矛盾正是：停车场低速但空间紧、遮挡多、agent 不严格遵守车道；过保守和不安全都不可接受。
Motivation
作者的动机不是提出新的 occlusion safety 概念，而是认为已有 game-theoretic active perception 的集合条件已经足够正确，真正缺的是一个非道路拓扑、非网格、非过近似的计算载体。
现有 formal 路线的缺口很明确：set-based reachability 通常为了在线性/凸优化里可用而牺牲几何精度；HJ 路线理论表达力强，但实际高维网格和 PDE 数值误差会把 safety guarantee 变成实现层面的近似保证；road-structured 方法在 AVP 这类弱规则场景里先验错误。APRO 的核心观察是，若 adversary dynamics 是 affine、占用空间和 hidden set 可写成多面体族，那么 forward hidden set 和 danger zone 并不需要数值 reachability，它们可以被闭式编码为 AH-polyhedron union。
Core Idea
论文真正的核心思想是表示转换：把“隐藏 adversary 是否能在 ego 制动期间撞上 ego”的博弈安全条件，改写为两个 AH-polyhedron union 的精确相交性判定。forward hidden set 代表所有当前被遮挡状态经过一步 adversary 控制后的可能状态；danger zone 代表所有从下一时刻开始、存在 adversary 控制序列能在 ego backup rollout 某一步与 ego 几何体相交的 adversary 状态。当前控制安全，当且仅当这些集合不相交。
这改变了 prior 的建模方式：不再沿 lane 构造一维集合，也不再求连续值函数，而是把动态、控制约束、状态约束、占用空间交集全部堆进线性约束系统，再通过 AH-polyhedron 的投影表达保留精确性。它引入的 inductive bias 是“局部 worst-case reachability 在 affine/polyhedral 世界里应当作为线性可行性问题处理”，而不是通过几何包络或网格值函数近似。这也是它比 prior 更 scalable 的主要原因：复杂度从高维 PDE 网格转为若干 LP，虽然仍随分块和 horizon 增长，但没有指数网格灾难。
Method
方法层面最关键的是三步。
第一，隐藏区表示为 AH-polyhedron union。它解决的是遮挡几何通常非凸、来自传感器 raycasting/obstacle map 的问题。用 union 而非单个凸集避免了粗暴凸包带来的额外保守；用 AH-polyhedron 而非仅 H-polyhedron 则方便表达投影和仿射生成集合。
第二，forward hidden set 和 danger zone 的闭式构造。forward hidden set 是隐藏状态集合与 adversary 一步控制输入集合经过 affine dynamics 的像；danger zone 则把未来若干步 adversary 控制序列、状态域约束、与 ego backup trajectory 的占用空间相交条件同时编码。这里的关键不是公式本身，而是把“存在 adversary 控制导致碰撞”写成线性约束的可行性，从而避免显式枚举 adversary trajectory。
第三，安全验证是 LP infeasibility。每个 hidden component、每个 adversary type、每个 backup horizon step 都产生一个 forward-hidden 与 danger-zone 的交集检查；全部不可行则当前控制安全。为了生成控制，作者给了三种接口：bang-bang safety filter、基于 Farkas lemma 的优化嵌入、以及在 path-velocity decomposition 下的二分搜索。这里最实用的是二分搜索，因为停车/路径速度分解中“更慢更安全”的单调性通常成立；优化嵌入更 general，但代价明显更高。
Key Insight / Why It Works
这篇论文有效的根本原因是它抓住了 occlusion-aware safety 中最适合线性化的一层：不是学习 hidden agent 分布，不是求全局策略，而是验证“当前动作是否保留 backup 安全余量”。在这个问题上，若 dynamics 和几何都能 polyhedral 化，所有 worst-case quantifier 都可以转成 existential linear feasibility；安全则是这些 existential feasibility 的否定。Farkas lemma 进一步把“不可行”变成可优化约束，这是形式方法里很标准但很有用的一步。
最核心贡献是 danger zone 的 AH-polyhedron 化。forward hidden set 的构造相对直接，本质是 affine image of polyhedral set；真正有价值的是把多步 adversary 可控碰撞集合写成一个投影多面体，并保持精确。这样它避免了两类常见损失：set propagation 的 overapproximation，以及 HJ gridding 的 numerical leakage。论文中 HJ baseline 安全率不足并不意外；这更多暴露的是数值实现不能承载 formal guarantee，而不是理论 HJ 条件错误。
哪些是核心，哪些是辅助：AH-polyhedron 表示和 LP infeasibility 是核心；bisection/search 接口是实用工程；AVP/Hybrid A* 集成是 deployment demo；bang-bang baseline 只是说明证书可直接用。性能增益主要来自 better representation / exact symbolic set computation，而不是 scaling、data coverage 或 test-time compute。这里没有学习，也不存在数据记忆问题。若说 engineering 成分，主要在 hidden set 构造、obstacle merging、raycasting、与 planner 接口，这些决定了系统表现但不是理论贡献。
需要注意，“exact”只对建模内的集合计算成立。真实系统中 hidden set 不可能精确，dynamics 也很难完全 affine，ego braking 也有 tracking error。所以论文的 safety claim 是 model-based formal safety，不应被解读为 deployment-level absolute safety。
Relation To Prior Work
APRO 最接近的是 Zhang & Fisac 的 game-theoretic active perception，而不是传统 AVP planning。它基本沿用了“forward hidden set 与 danger zone disjoint implies safety”的理论骨架，新增的是把这两个集合从 road-topology/HJ computation 中解放出来，用 AH-polyhedron 精确表达。因此它的实质创新是计算表示，而不是安全定义。
相对 Kamm circle、OA-MPC、capsule FRS 这类 set-based 方法，APRO 的本质差异是拒绝为凸优化友好性牺牲集合精度；它不是先 overapproximate 再检查，而是把原始 existential constraints 保留为投影多面体。相对 HJ，它牺牲了非线性通用性，换来了 affine/polyhedral 场景下的速度、精度和可部署性。相对 POMDP/risk-field/phantom sampling，它完全站在 worst-case formal methods 一侧，不解决概率意义上的效率最优，只保证备份安全。
看似新的部分有些是已有思想重组：AH-polyhedron、Farkas infeasibility certificate、LP intersection check 都不是新数学；新意在于把它们准确嵌进 occlusion-aware active perception 的安全条件中，并证明 forward hidden/danger zone 在这个建模下闭合于 AH-polyhedron union。
Dataset / Evaluation
实验覆盖了三层：受控窄缝、真实停车场数据 replay、F1/10 真机。窄缝实验最能验证核心 claim，因为它直接对比 exact representation 与 overapproximation 在 tight geometry 下的差异；AVP replay 主要验证多类 adversary、动态障碍、hidden set 构造和 Hybrid A* 接入；真机实验验证在线计算链条可跑。
评价总体支持“在本文假设内，APRO 比 HJ 更实时、比过近似 set-based 更不保守，同时保持安全”。但它没有充分验证复杂真实世界泛化：DLP 是 replay，不是闭环真实交通；真机是简化窄缝，不是 full-scale AVP；hidden set 构造仍经过 obstacle merging 和几何预处理，误差模型没有系统评估。安全率指标也主要是在作者定义的 theoretical check 下成立，而不是通过大量真实 adversary 交互验证。benchmark 没有明显 data leakage 问题，因为不是学习方法；但 evaluation bias 在于场景和模型高度匹配 APRO 的 affine/polyhedral 假设。
Limitation
最大限制是前提强。APRO 的 guarantee 依赖：adversary dynamics affine、控制/状态域 polyhedral、占用空间可用半空间表达、hidden set 已知或保守、ego backup trajectory 可预测、ego policy 对 adversary 非反应式。任何一项在真实系统中松动，exact guarantee 都会变成建模近似。
第二个限制是 scalability 的上限不是没有，只是比 HJ 更好。LP 数量随 adversary type、hidden set component、backup horizon 相乘；每个 LP 变量维度随 adversary 未来控制序列长度增长。复杂停车场中如果遮挡区域碎片很多，或者需要多种 agent 行为模式/PWA regions，计算会迅速膨胀。文中说可以并行或 MILP 化，但未充分说明实际收益。
第三，方法把问题部分转移到了 hidden set 和 model construction。如何从噪声感知中构造既安全又不保守的 AH-polyhedron union，是 deployment 的关键；论文只给了工程 pipeline，没有形成完整不确定性感知证明。硬件实验中通过低估最大减速度来保守化模型，这说明真实系统 safety margin 仍靠人工建模。
第四，当前 backup policy 是简单 braking/passive safety 语义。对于需要主动避让、交互式避障、或在遮挡环境中保持任务效率的场景，非反应式 backup 的安全定义可能过弱或过保守。planner 实际没有长期交互推理，只是在每一步做局部 worst-case safety filtering。
Takeaway
- 1. 这篇真正推动的是 occlusion-aware formal safety 的表示层：把原本靠 HJ 或几何过近似实现的安全条件，改成 AH-polyhedron + LP 的精确判定。
- 2. 对 tight-space robotics，一个重要 insight 是：不要急着用保守包络换实时性；如果 dynamics/geometry 有 affine-polyhedral 结构，保留投影多面体反而可能同时更快、更不保守。
- 3. 未来值得做的不是再换一个 planner 接口，而是把 perception uncertainty、model mismatch、PWA/learned dynamics 的误差界系统接入这个 AH-polyhedron certificate，否则 deployment guarantee 仍停留在理想模型层。
- 4. 这个思路可迁移到其他“当前动作是否保留 backup safety”的问题：只要危险集合能写成 existential linear constraints，安全验证就可以从 reachability solver 转为 LP infeasibility certificate。
一句话总结
APRO 是把 game-theoretic occlusion safety 从道路/HJ/过近似实现推进到 affine-polyhedral 精确 LP 证书的一类表示驱动型 formal planning 方法，核心贡献在计算表达而非新的安全概念。