精读笔记
Problem Setting
《Waypoints Matter: A Systematic Study for Sampling-Based Trajectory Planning》（arXiv preprint / 2026）讨论的是 sampling-based trajectory planner 中一个长期被低估的变量：沿 road centerline 的 target waypoint 如何布置。
这不是在重新定义轨迹规划任务，也不是提出一个新 planner。它真正处理的是一个更底层的问题：在候选轨迹预算固定时，waypoint placement 如何改变 planner 实际看到的搜索空间。困难点在于 waypoint density 同时承担两个相互冲突的角色：一方面它决定几何覆盖与局部可达目标的丰富度；另一方面，在固定 N_cand 下，waypoint 越多，每个目标点可获得的采样越少，valid trajectory 的概率反而下降。
以前相关工作的问题不是没有 waypoint 策略，而是这些策略通常和 primitive、optimizer、cost function、scenario setting 一起被调，导致 placement 的独立贡献不可辨识。RDP、uniform grid、curvature-aware、learned bias 都存在，但大多作为 planner architecture 的一部分，而不是被系统 sweep 的一阶变量。
这篇论文抓住的关键矛盾是：更细的空间离散化不等于更强的 planner；在固定计算预算下，离散化密度其实是在 coverage 和 per-target sampling effort 之间重新分配资源。
Motivation
作者的动机来自一个相当实际的观察：sampling-based planner 的候选集质量不只由 trajectory primitive 决定，还强烈依赖 candidate endpoint 的组织方式。很多论文默认 waypoint 是 map preprocessing 或 implementation detail，但实际 deployment 中，target 点分布可能直接决定有没有 valid trajectory。
已有路线不够的地方在于缺少隔离变量。Artuñedo 等早期工作比较过 waypoint selection、primitive 和 optimizer，但这些因素 co-vary，无法回答“如果 primitive 不变，仅 waypoint placement 会怎样”。reachable-set 或 learned sampling bias 也暗示 target distribution 很重要，但没有给出系统的 placement parameter landscape。
因此本文缺的不是一个更 fancy 的采样公式，而是一个 controlled evaluation：固定生成器和预算，把 placement strategy、spacing、simplification tolerance、curvature sensitivity 作为主变量扫一遍。这个方向的价值在于把 planner tuning 中经常被经验化处理的参数变成可归因对象。
Core Idea
核心思想是把 waypoint placement 当成 sampling-based planner 的搜索空间建模，而不是地图采样细节。每个 waypoint 都是 candidate trajectory 的终点锚点；因此 waypoint set 的分布决定了 planner 能尝试哪些 boundary condition，也决定了固定候选预算如何在这些 boundary condition 上分摊。
论文比较三类 inductive bias：uniform spacing 假设道路几何不需要额外先验，只要控制目标点间距即可；RDP/RDP* 假设 centerline 几何压缩能保留重要形状点；curvature-adaptive 假设高曲率区域更容易导致 primitive infeasibility，因此应该提高目标点密度，尤其 forward-window 把密度提前到曲率变化之前。
本质区别在于：prior 通常把 waypoint rule 作为 planner 的附属模块，而本文重新建模为 resource allocation problem。d_s 不只是空间分辨率，而是控制 waypoint count、per-waypoint candidate budget、trajectory feasibility probability 的主旋钮。这个视角比单纯提出曲率采样公式更重要。
Method
方法上真正必要的机制有四个。
第一，固定 trajectory primitive 和 candidate budget。作者使用 degree-5 Bézier primitive，并让每个配置使用同样的 N_cand。这一步是论文的因果控制：否则任何 placement 效果都会被 primitive 表达能力或计算预算吞掉。
第二，把 waypoint strategy 放在同一 nominal spacing 坐标系下比较。Uniform 直接按 d_s 等距放点；RDP* 在 RDP 简化后补点以限制最大间距；curvature-adaptive 用 d_local = d_s / (1 + α|κ|) 改变局部 spacing。这里 d_s 是统一比较轴，也正是最后被证明最重要的变量。
第三，curvature-forward 的关键不是“曲率自适应”本身，而是密度提前。Centered window 把高密度对齐在弯道中部；forward window 把 waypoint 加密提前到弯道入口，使 planner 在进入高 rejection 区域前已经拥有更密的目标集。这是少数真正带有规划意义的 inductive bias。
第四，评价不是只看最优轨迹，而是看 candidate set 的可靠性、valid 数量、长度和长度分布。这个选择合理，因为 placement 首先改变的是候选集合结构，而不是单条最优轨迹质量。不过 weighted score J 是人为 scalarization，不能完全替代 Pareto 分析。
Key Insight / Why It Works
最重要的 insight 是：在固定候选预算下，waypoint spacing 的预算分摊效应主导了几何采样策略本身。大 d_s 通常意味着更少 waypoint，每个 waypoint 获得更多候选尝试，因此 valid candidate count 和 success rate 上升。小 d_s 提供更细的几何覆盖和更高长度多样性，但会把预算打散，导致每个 boundary condition 的采样不足。这解释了为什么 uniform 在调好 spacing 后可以接近甚至超过更复杂策略。
曲率-forward 的收益不是因为它“理解道路”，而是因为它把采样密度放在 primitive 最容易失效的区域之前。对于 Bézier primitive，弯道入口处的 heading/curvature mismatch 更容易导致出界或不可行，提前加密 waypoint 可以增加可行 boundary condition 的命中率。这是一个有效的 inductive bias，但其增益很小，说明主要性能来源仍是 d_s，而不是曲率公式本身。
RDP* 不强也很合理。高 tolerance 下，RDP 会丢掉大量中心线点，gap filling 又把它拉回近似 uniform；低 tolerance 下，它保留太多点，等价于小 spacing 下的预算稀释。也就是说 RDP* 在这个设定中没有引入新的有效信息，只是在 uniform 和 over-dense sampling 之间摆动。RDP 的所谓几何压缩优势在固定 primitive/预算后消失，说明 prior 中 RDP 的收益可能来自与其他模块 co-tuning，而不是 placement 本身。
我认为本文最核心贡献不是 curvature-conditioned allocation，而是把 waypoint selection 的“计算预算分配”本质讲清楚。曲率策略是辅助；RDP* 基本是负结果；真正可迁移的是：在 sampling-based planning 里，离散化密度不能脱离 per-target compute 来谈。
Relation To Prior Work
最接近的是 classical sampling-based trajectory planning、Frenet / Bézier / lattice-style local planners 中的 target sampling 设计，以及 Artuñedo 等对 path primitive 和 waypoint method 的比较。本文与这些工作的本质差异不是引入了一个新 primitive，而是把 placement 从 planner architecture 中拆出来单独评估。
和 RDP/Opheim/line simplification 类方法相比，本文显示几何压缩不自动等价于更好的 planning target set。RDP 对地图表示是合理的，但对固定预算下的轨迹终点采样未必合理，因为它没有显式考虑 per-target feasibility。
和 reachable-set guided sampling 或 learned biased sampling 相比，本文更弱也更干净。它没有学习，也没有显式可达集推理，但因此能说明一个基础事实：即使没有动态障碍和学习模块，placement 本身已经足以显著改变 planner reliability。
实质创新主要是实验归因框架和 curvature-forward 的小型 inductive bias。后者并不算大的算法创新，更像是把道路曲率作为可行性风险 proxy 提前注入 waypoint density。真正新增的信息是负结果和调参规律：uniform + well-tuned d_s 是非常强的 baseline，RDP* 在隔离评估下没有优势。
Dataset / Evaluation
评估使用五个 CommonRoad 地图，从直路高速到复杂城市 corridor，并在每张图上生成大量 ego launch states。作为验证“waypoint placement alone matters”的 benchmark，这个设计是足够有说服力的：地图几何有变化，启动状态有扰动，primitive 和预算固定，参数 sweep 密集。
但它验证的是静态几何可行性，不是完整 autonomous driving deployment。没有动态障碍、交通交互、闭环控制误差、实时 replanning feedback，也没有真实车辆或真实 log replay。候选轨迹只经过几何/运动学意义上的 validity 评估，不能说明在障碍密集场景中同样的 spacing 规律成立。
另一个 evaluation bias 是候选预算被均匀分配到 waypoint。这个设定正是 d_s 成为主导因素的关键原因之一。如果 planner 使用非均匀 allocation，例如按 curvature、reachable set、obstacle proximity 或 learned value 分配 samples，那么 spacing 与 valid count 的关系可能明显改变。因此实验强力支持“在均匀预算分配下 d_s matters”，但不足以支持“所有 sampling-based planner 中 d_s 都是第一因素”。
总体上，evaluation 对核心 claim 是支持的；对泛化 claim 要保守。
Limitation
第一，结论依赖固定 primitive。degree-5 Bézier 的 boundary condition 可行域和曲率响应会影响 waypoint spacing 的最优区间。换成 clothoid、polynomial spiral、Frenet lattice 或 optimization-based smoothing 后，d_s 的主导性可能变化。文中未充分说明这种 primitive dependence。
第二，结论依赖 fixed N_cand 且 uniform allocation。论文实际上揭示的是 density 与 per-target sampling budget 的耦合；如果使用 adaptive candidate allocation，就可能把这个耦合部分解开。也就是说问题可能不是 waypoint placement 本身，而是 placement 和 sample allocation 被绑定在一起。
第三，静态地图评估没有覆盖 collision avoidance 的主要难点。动态障碍会改变目标点价值：有些稀疏 waypoint 可能刚好落在被障碍阻塞的区域，而密集 waypoint 可能提供绕行机会。当前结果不能推出动态场景下 large d_s 仍然最优。
第四，weighted score J 有人为偏好。作者用 balanced、reliability-first、coverage-first 做了 sanity check，但仍然没有给 Pareto frontier。不同下游 planner 可能对 diversity、trajectory length、comfort、clearance 的权重完全不同。
第五，曲率-forward 的增益来源不清。它可能确实来自提前覆盖高曲率可行域，也可能只是产生了某种等效 spacing shift。论文没有把“提前性”和“密度增加量”严格解耦。
Takeaway
- 1. 对 sampling-based trajectory planner，waypoint spacing 应该被当作核心 tuning knob，而不是 map sampling 的默认参数；在固定预算下，它本质上控制 compute allocation。
- 2. Uniform sampling 是强 baseline。
- 任何 geometry-aware 或 learned waypoint strategy 都必须先证明它超过 tuned-uniform，而不是只超过某个随意 spacing 的 uniform。
- 3. 曲率信息有用，但更有用的是“提前把采样资源放到可行性即将恶化的位置”。
一句话总结
这篇论文在 sampling-based 轨迹规划中把 waypoint placement 从工程细节提升为可归因的资源分配问题，证明 tuned spacing 往往比复杂几何采样更关键，而曲率前视加密只是一个小但合理的 inductive bias。