精读笔记

Problem Setting

[Path planning for unmanned naval surface vehicles]（arXiv preprint / 2026-07-03）

这篇论文实际解决的是一个混合规划问题：已知静态障碍下先生成一条可执行的全局航路，运行时遇到移动障碍时再做局部重规划，并且局部避障目标不是“任何无碰路径”，而是尽量从移动障碍后方绕行。真正困难点在于，传统全局 planner 关心静态连通性和路径长度，动态 planner 关心在线避碰，但 USV 场景还需要把相对运动语义映射成航行决策。以前方法卡住的地方不是不能避障，而是很多方法将移动障碍退化为临时静态障碍，导致 D* 或势场类方法可能选择并行、等待机会、甚至在几何上穿到障碍前方。关键矛盾是：全局路径需要稳定、可达、平滑；局部行为又必须足够规则化，以便实时、可解释、符合“让路/从后方通过”的航行直觉。

Motivation

作者的核心观察是：动态避障中缺的不是又一个低层路径搜索器，而是一个高层几何决策层，用来判断障碍是从哪一侧接近全局路径、是否朝路径运动、交会点在 USV 前方还是后方。换言之，缺口在 state abstraction，而不是 search 本身。

全局部分的动机也类似：Grassfire 有连通性保证但路径折线多，MGF 可缩短路径但贴障风险更高，PRM 能平滑但采样空间大且没有确定性保证。论文试图把这些方法各自的 inductive bias 串起来：先用网格波前保证存在性，再用两条网格路径限定一个局部走廊，最后在走廊内采样求平滑路径。这个方向的直觉是合理的：不要在整个环境里随机找路，而是在一个已知可通的拓扑管道里做连续化修正。

Core Idea

论文真正的核心不是 r-PRM 本身，而是把路径规划拆成“拓扑保证 + 几何平滑 + 运动语义决策”。全局 planner 先用 GF/MGF 构造一个包含可行路径的 polygon corridor，再在该 corridor 内用采样图搜索。这改变了 PRM 的建模方式：PRM 不再负责从全局自由空间中发现拓扑连通性，而主要负责在已知通道内做路径去网格化和平滑化。

局部 planner 的本质差异是引入了一个非常强的航行先验：当移动障碍穿越 USV 路径时，默认将 USV 路由到障碍后方，而不是让低层 planner 自己从代价函数中“涌现”出该行为。这个 inductive bias 很硬，但在 USV 避碰中可能正是优势，因为它把含糊的动态避障问题压缩成若干几何谓词和绕行模板。它更 scalable 的地方不在最优性，而在决策空间被显式裁剪，减少了在线搜索负担。

Method

全局机制有三层。第一，GF 用 4-neighbor wavefront 提供保守可达路径，解决“至少找到路”的问题；它的必要性在于给后续采样一个拓扑锚点。第二，MGF 加入 8-neighbor 对角移动，解决 GF 过度曼哈顿化的问题；但它会贴近障碍，所以需要 obstacle buffer，这说明平滑性是用安全裕度换来的。第三，GF 与 MGF 路径围成 polygon 后只在其中采样 r-PRM，这本质上是 search-space restriction，而不是新的全局最优框架。

r-PRM 的机制是从起点递归扩展 k 近邻、写入 reachability matrix，直到连到目标，再由 Dijkstra 求图上最短路。它在解决传统 PRM 可能构造大量与 start-goal 连通无关边的问题，因此速度优势大概率来自少建图和提前停止，而不是采样规划理论上的根本突破。

局部机制是把动态障碍状态离散成若干几何情形：障碍在全局路径左/右/上，障碍是否靠近路径，预测交点在 USV 前/后，以及 USV 是否也朝障碍轨迹靠近。输出不是连续优化轨迹，而是固定的一步或两步绕行点，再从绕行点重新生成全局路径。这个设计牺牲最优性，换取行为可解释和实时性。

Key Insight / Why It Works

最可能有效的部分是 corridor-constrained sampling 与 explicit encounter geometry。前者让 PRM 不再承担全空间探索，降低随机采样失败概率和建图成本；后者把动态避障中的“从哪边绕”变成几何分类问题，避免 D* 这类局部重规划只看 occupancy/cost 而忽略障碍运动语义。

r-PRM 的贡献需要谨慎看。它与 PRM 在路径质量上基本等价，文中也承认如果采样足够形成连通图，两者结果本质相同。因此所谓“更快”很可能主要来自工程层面的 roadmap construction pruning：递归从起点可达区域向外扩展，连到 goal 后停止，而不是构建完整 roadmap。这里增益来源不清，因为没有严格控制 collision check 次数、生成边数、递归终止策略和 KD-tree 开销。

局部 planner 的核心不是 planning optimality，而是 better inductive bias。它把 COLREGS 中“避免从前方穿越”的模糊规则具体化为“优先绕后”的几何策略。这个 bias 在展示场景中会明显优于把移动障碍当静态障碍的 D*，但也意味着能力边界由规则覆盖决定。所谓 reasoning 更像 handcrafted geometric policy，不是学习到或搜索到的长期交互策略。

GF/MGF+r-PRM 的组合也有一个隐藏前提：GF 与 MGF 形成的 polygon 足以包含好路径。如果该走廊过窄或拓扑选择错误，后续 r-PRM 只能在被限制空间内优化，无法恢复被早期阶段排除的路径。因此该方法是在把全局难题转移为“先验走廊是否可靠”。

Relation To Prior Work

这篇最接近的是 classic hybrid planning：grid-based global planner + sampling-based smoother + local reactive planner。GF/MGF 对应 wavefront/A* 风格的离散拓扑搜索，PRM/r-PRM 属于 sampling-based roadmap，局部规则则接近 velocity obstacle / COLREGS decision logic 的手工几何版本。

真正不同点在于它没有试图用一个统一优化器处理静态和动态障碍，而是显式分层：静态障碍由全局路径和走廊采样解决，移动障碍由相对运动规则解决。这个区别比 r-PRM 的递归形式更重要。

看似新的部分中，r-PRM 更像 PRM 构图顺序和终止条件的重组，实质创新有限；GF+MGF 形成 polygon 再采样是有实用价值的工程组合，但不是新的理论范式。较实质的新增信息是局部 planner 把“route behind moving obstacle”作为一等目标，而不是期望 D*、势场或滚动窗口从局部代价自然给出该行为。

Dataset / Evaluation

评估完全是仿真，且场景规模较小、障碍形态和运动模式由作者构造。全局部分比较 PRM 与 r-PRM 的路径长度和 roadmap 生成时间，能支持“路径质量近似、r-PRM 在这些设置下更快”的经验 claim，但不足以证明概率完备性、复杂地图鲁棒性或真实 runtime 优势。

局部部分用若干移动障碍案例展示 proposed planner 会绕到障碍后方，而 D* 不一定会。这验证的是规则行为是否按预期触发，而不是系统级安全性。没有真实 USV、没有海流/风浪、没有传感噪声、没有执行器约束、没有多船交互压力测试，也没有与 MOOS-IvP/COLREGS 专门方法的强基线定量比较。

因此 evaluation 支持“该几何策略能在可控仿真中产生更符合作者偏好的避障轨迹”，但没有充分支持“complete on-board real-time obstacle avoidance”这一较强表述。

Limitation

最大限制是方法成立依赖一组很强的结构化前提：环境是 2D 网格，静态障碍预先已知，移动障碍位置与方向可可靠估计，局部一次只处理一个主要障碍，USV 可近似沿几何线段运动。真实海上部署中，速度、转弯半径、惯性、海流、风浪、传感延迟和 COLREGS 多规则都会破坏这些简化。

全局 planner 的上限来自 corridor restriction。GF/MGF 先验一旦选错拓扑或在窄通道中形成不合适 polygon，r-PRM 没有机制跳出该走廊寻找更优路径。所谓平滑路径也只是相对网格折线路径更平滑，并不等价于动力学可执行或曲率受限。

r-PRM 的理论地位文中未充分说明。它是否保持 PRM 的概率完备性、递归访问顺序是否引入 bias、提前遇到 goal 后停止是否损失更优 roadmap，文中没有严谨分析。速度增益可能主要是少做 collision checking / 少建边，而不是算法范式上的优势。

局部 planner 的泛化也有限。它是 handcrafted rule table，不是可扩展的 multi-agent interaction planner。遇到多个移动障碍、障碍突然变速、交会点估计不稳定、或从后方绕行反而增加风险的场景，规则可能冲突或产生振荡。文中也承认相对速度尚未纳入，这对“该不该从前方通过”是核心变量，不是边缘扩展。

Takeaway

• 1. 最值得迁移的 insight 是：动态避障不要只更新 occupancy map，还要显式建模障碍相对全局意图/路径的运动语义；否则 planner 可能无碰但行为不符合航行策略。
• 2. GF/MGF 先生成拓扑走廊、再在走廊内采样平滑，是一个实用的 search-space shaping 技巧；它的价值在工程可靠性，而不是全局最优性。
• 3. r-PRM 的递归形式不是这篇最重要的贡献，未来若要成立，需要把“少建图带来的效率”与“采样连通性/最优性损失”讲清楚。
• 4. 这个方向真正值得做的是把几何规则、相对速度、COLREGS、动力学约束和多障碍预测统一到一个可验证的 decision layer，而不是继续堆叠更多单点 path planner。

一句话总结

这篇论文在 USV 规划谱系中更像一个强规则先验的 hybrid planner：用网格搜索保证静态可达、用受限 PRM 做路径平滑、用显式相对运动几何把动态避障从低层重规划提升为“绕后”决策。