精读笔记

Problem Setting

论文处理的是单个可动刚体在静态刚体障碍中的 tight assembly / disassembly planning，配置空间取 SE(3)。真正困难点不是一般意义上的高维规划，而是可行路径在关键阶段几乎贴着接触集合走；这些区域在 6D 体积测度下极小，但又决定全局连通性。

以前方法的瓶颈可以概括为两类失配。普通 RRT/PRM/BIT/RRTConnect 假设足够 clearance 下均匀采样能覆盖连通结构，但 tight assembly 中关键 tunnel 的采样概率近似消失。TR-RRT 这类 contact-aware 方法改善了局部 extension：一旦进入近接触区域，可以沿局部 contact critical manifold 滑动/滚动。但它的 sampling 仍然是全 SE(3) 均匀的，因此大量扩展目标仍落在无关自由空间或死胡同。

这个任务的关键矛盾是：全局搜索需要探索 SE(3)，但有效推进信号集中在低维、未知、不断切换的接触流形附近。CMG-RRT 的问题设定正是要解决这个 sampling 与 contact-aware exploration 之间的信息断裂。

Motivation

已有 narrow-passage sampling 多依赖 bridge test、obstacle-based sampling、medial-axis heuristic 或局部几何特征。这些方法在某些通道形态上有效，但对 Elk 这类没有明显 per-piece tunnel feature、且存在多个 disjoint contact point 共同约束的 puzzle 不稳定。constraint-manifold planning 方向也相近，但它通常假设约束函数已知且固定；assembly 中 active contact 是路径依赖的，约束流形会出现、消失、切换。

作者的核心观察是：tight assembly 的解路径并不是任意穿过自由空间，而是大量关键转移位于 critical manifold 的邻域，即至少一个接触点存在的配置集合。缺口因此很明确：不是缺一个更复杂的 local contact integrator，而是缺一个能把采样预算主动投向这些 critical manifold neighborhood 的机制。

这也解释了为什么会想到 subdivision。SDF 给了一个从配置到“离接触多远”的 oracle；如果能在 SE(3) 中逐层剔除明显远离零集的 boxes，就能把原来对全空间的 blind sampling 转成对隐式接触集合邻域的 adaptive sampling。

Core Idea

CMG-RRT 的核心思想是把 tight assembly 的搜索空间从“整个 SE(3) free space”重新组织为“接触临界流形附近的可细化覆盖”。它不直接显式构造 contact manifold，也不预先枚举 contact modes，而是用 SDF 在配置空间中检测哪些区域可能接近 signed-distance zero set。随着 boxes 细化，采样分布逐渐收缩到 critical manifold 的 D-neighborhood。

这个 inductive bias 很强：它假设 tight transition 的有效信息主要在 near-contact set，而宽自由空间只是连接这些关键段的中间区域。相比 TR-RRT，新增的信息不是 extension dynamics，而是 target distribution；相比 tunnel-feature 方法，它不依赖人工可识别的几何通道特征，而是直接在 C-space 中用 contact proximity 做筛选。

理论直觉上它可能有效，是因为 narrow passage 的“难”来自体积测度太小；如果采样支持集从 6D volume 收缩到一个接触流形邻域，那么采到有用目标的概率会显著提高。它的 scalable 部分来自 avoided volume：不是更聪明地在全空间中找 needle，而是先把 haystack 大幅剪掉。

Method

CMG-RRT 保留 RRT 的全局树结构，但改变采样入口。它维护一组 SE(3) 中的 axis-aligned boxes，每次 refinement 沿最长轴二分，并用中心点的 F_{M2->M1}(q) 与 box diagonal 比较，保留可能接触或近接触的子 box。这个机制解决的是“在哪里采样”的问题，核心变化是把采样支持集从全空间改为 SDF 零集邻域。

SDF oracle 是方法成立的关键接口。它把几何碰撞问题变成 configuration-level distance-to-contact 查询，使得 planner 不需要显式构造所有 contact modes。这里的核心变化不是 SDF 本身，而是 SDF 被用来定义采样分布，而不只是做 collision checking 或 local retraction。

TR-RRT 风格的 extension 仍然重要。仅采到 near-contact target 不够，因为 tight tunnel 内的可行运动需要沿局部接触约束推进；contact-aware extension 负责把采样信号转成可行边。也就是说，CMG-RRT 的贡献不是替代 TR-RRT，而是修复 TR-RRT 的 sampling/exploration mismatch。

随机旋转主要服务两个目的：缓解 Euler angle 参数化导致的 gimbal lock / wrap-around 问题，并让概率完整性证明中的局部 ball 更容易落在凸的欧氏表示区域。它是理论和参数化层面的辅助机制，不像 subdivision bias 那样是主要性能来源。

Key Insight / Why It Works

最重要的 insight 是：tight assembly 中 sampling 的目标不应是 free space，而应是 contact-critical set 的邻域。传统 sampling-based planning 的默认先验是“可行路径有正 clearance，采样体积最终会覆盖”；这里作者反过来利用 near-zero clearance，把接触从障碍变成导航信号。

方法有效的核心贡献大概率是 manifold-guided sampling，而不是新的 contact propagation。TR-RRT 已经说明局部沿接触切空间推进有效，但失败在无法频繁到达正确接触段。CMG-RRT 把采样预算从 6D 均匀分布转移到近 5D 或更低维的接触邻域，本质上是 better inductive bias + test-time adaptive search，不是 learning，也不是 retrieval。

这不是纯 scaling。更多 CPU 并行、grid SDF、更快查询确实可能贡献显著速度增益，尤其表格中的运行时间差距很大，增益来源不清。但 Elk 能从 TR-RRT 的 partial tunnel traversal 走到完整解，说明至少有一部分能力来自 sampling distribution 的结构性改变，而不只是实现优化。

完整性证明的技术意义在于把 subdivision sampler 与 RRT 的经典 ball-covering 论证接起来，同时处理 SE(3) 的 Euler 参数化拓扑问题。这里的 proof 更像为算法设计选择背书：pseudo-metric、random rotation、box refinement 都被组织成能支持 probabilistic completeness 的形式。不过证明依赖标准正 clearance，而论文要解决的实际场景又强调 near-zero clearance，这之间存在概念张力。实际成功更多依赖 allowance δ 和 SDF 容差把 near-contact motion 数值上变成可通行。

Relation To Prior Work

最接近的路线是 TR-RRT、constraint-manifold planning、narrow-passage biased sampling、以及 C-space tunnel discovery。与 TR-RRT 的本质差异是采样分布：TR-RRT 只有 extension 是 contact-aware，CMG-RRT 让 sampling 也 contact-aware。与 CBiRRT/AtlasRRT 的差异是约束不是固定任务 manifold，而是由几何接触隐式诱导、active set 可变的 critical manifold。

与 bridge test、obstacle-based sampling、medial-axis 方法相比，CMG-RRT 的 novelty 不在“非均匀采样”这个概念，而在非均匀性的来源：它用 SDF 零集附近的 subdivision 作为可证明、可收缩的 sampling support。与 Zhang et al. 的 tunnel discovery 相比，它不依赖局部 feature 或 per-piece cue，而是直接在配置空间过滤。

看似新的部分里，层级 subdivision、SDF、RRT、contact-aware extension 都不是新组件；实质创新是把这些组件的信息流重新接起来：SDF 不只判断碰撞，还是 sampler 的结构化先验；contact manifold 不只用于局部投影，而是全局采样的目标集合。它属于 sampling-based planning 中“用隐式几何结构重塑采样分布”的谱系。

Dataset / Evaluation

evaluation 主要验证了 rotational assembly 中 mixed wide-tight 任务，而不是一般机器人操作。Tian et al. 的 rotational puzzle/other 子集加 Elk puzzle 对论文 claim 是相关的：这些任务确实需要 translation-rotation coupling、near-contact traversal、多个 tunnel 和死胡同搜索。

结果支持两个核心点：第一，普通 sampling-based planner 在这些任务上不可靠；第二，相比 TR-RRT，改变 sampling distribution 后成功率和时间都有明显改善。Elk 的完整自动求解尤其能说明 manifold-guided sampling 对多 tunnel 串联任务有价值。

但 benchmark 覆盖仍窄。作者明确没有评估 screws，因为方法假设有限点接触，而 screw 类 sustained surface contact 正是 assembly 中重要类别。真实机器人实验只是把一个 CMG-RRT 生成的 free-flying trajectory 通过另一个 IK pipeline 执行，不能证明在真实接触力、夹持误差、摩擦和闭环控制下 planner 仍然可靠。

实验也缺少关键 ablation。文中未充分说明性能提升中有多少来自 subdivision sampling，多少来自 grid SDF 替代 neural SDF、CPU 并行、参数调度、contact point clustering 或实现差异。因此 evaluation 强支持“这个系统有效”，但对“哪个机制贡献多少”的归因不够干净。

Limitation

最大前提是 SDF oracle 必须足够可靠。Subdivision pruning 使用 box center 和 diagonal 判断是否保留区域，但实际 SDF 是 grid approximation，且 F_{M2->M1} 由有限表面采样点近似。若 SDF 误差或表面采样漏掉关键接触，可能直接剪掉有用区域；文中未充分说明这类 false negative 如何控制。

方法把难点从“在全 SE(3) 中采到 tunnel”转移为“维护 contact manifold 邻域的 box cover”。在两刚体、点接触、6D 空间中这可行；多物体、多接触、多自由度机械臂下，box 数量和 contact consistency 可能快速爆炸。footnote 中 O(1/δ^k), k<=5 的说法依赖临界流形维度，但实际复杂接触图的常数和分支数可能很大。

它对 contact 类型有明显选择性。有限点接触适配它的 manifold bias；持续面接触、螺旋配合、柔顺装配、摩擦约束和力闭合操作都不在当前能力边界内。所谓 general-purpose motion planner 的 generality 主要限于刚体几何 disassembly，而不是完整 assembly manipulation。

概率完整性与实际 tight assembly 的关系也需要谨慎看。证明要求存在 δ-free path 和正 clearance ball cover；实际论文动机强调 near-zero clearance。这里的桥梁是 allowance / penetration tolerance，而不是严格无碰撞几何可行性。因此 planner 的成功部分依赖数值容差把物理上接触的路径变成规划上可扩展的通道。

增益来源不清。grid SDF、parallelization、contact clustering、refinement schedule 都可能贡献运行时间提升。没有 ablation 时，不能把全部提升归因给 manifold-guided sampling。

Takeaway

• 1. 对 tight planning，真正该迁移的 insight 是：当解路径集中在低维临界集合附近时，先改采样支持集，再谈局部 steering。
• 只增强 extension 而不改 sampling，信息流仍然断。
• 2. SDF 的角色可以从 collision oracle 升级为 sampling prior。
• 这个思想可迁移到其他隐式约束规划问题：只要能定义 distance-to-useful-structure，就可以用 subdivision / adaptive support selection 压缩搜索空间。

一句话总结

CMG-RRT 是把 TR-RRT 的接触流形思想从局部 extension 推进到全局采样分布的一步，用 SDF-guided subdivision 将 tight assembly planning 从全 SE(3) 盲采样转为 near-contact manifold 上的结构化搜索。