点击下方卡片，关注「3D视觉工坊」公众号
选择星标，干货第一时间送达
来源：3D视觉工坊
星球内有20多门3D视觉系统课程、3DGS独家系列视频教程、顶会论文最新解读、海量3D视觉行业源码、项目承接、求职招聘等。想要入门3D视觉、做项目、搞科研，欢迎加入！
在精密制造、医疗手术和工业检测等领域，将物体准确配准到已知位姿是至关重要的基础操作。传统的配准方法主要依赖光学追踪器或视觉传感器来获取物体的位姿信息，但在某些应用场景中，光学视线被遮挡、电磁干扰强烈或空间受限等问题使得传统方法难以可靠工作。接触式感知作为一种替代方案，通过探针与物体表面的物理接触来获取位姿信息，具有不受光照和遮挡影响的优势，但如何从有限的接触测量中精确恢复物体的六自由度位姿一直是一个具有挑战性的问题。
现有接触配准方法面临几个核心痛点。首先，大多数方法需要精确的标定过程来建立探针坐标系与物体坐标系之间的变换关系，标定误差会直接传递到位姿估计结果中。其次，接触测量提供的信息量有限，每次接触仅约束物体在接触点法线方向上的自由度，需要多次接触才能充分约束六自由度位姿，而接触点选择的策略对配准精度影响巨大。此外，现有方法对接触噪声和接触丢失的鲁棒性不足，在实际应用中容易因测量误差导致配准失败。
清华大学的研究团队提出了一种全新的接触配准方法，将接触配准问题重新表述为物体与探针扫掠体积之间的互补形状对接问题。核心方法包含两个关键模块：全局到局部搜索模块利用3D FFT相关和低差异SO(3)采样实现高效的初始位姿估计，连续SE(3)精炼模块通过李代数更新和解析接触敏感度实现高精度的位姿优化。该方法无需任何外部标定，在仿真中达到亚0.04mm和亚0.4度的配准精度，在实际牙齿预备机器人应用中超越了光学追踪器的配准精度。
本文的突出成果体现在其卓越的精度和实用性上。在仿真实验中，自由曲面网格的配准精度达到亚0.04mm平移误差和亚0.4度旋转误差，对位姿噪声和接触丢失展现出强鲁棒性。在实际牙齿预备机器人应用中，配准精度达到0.42mm和3.75度，超越了光学追踪器的配准精度，且完全不需要外部传感器。该成果已被ICRA 2026接收，展示了接触配准在精密医疗和工业应用中的巨大潜力。
论文信息
标题：From Swept Contact to Pose: Probe-aware Registration via Complementary-Shape Docking
作者：Chen Chen, Yunwen Li, Yifan Xu, Xiangjie Yan, Chang Shu, Jianxia Hou, Shiji Song, Xiang Li
机构：清华大学等
原文链接：https://arxiv.org/abs/2605.21398
导读
本文提出了一种无需标定的接触配准方法，通过将接触配准重新表述为物体与探针扫掠体积之间的互补形状对接问题，实现了从有限接触测量到精确六自由度位姿估计的完整流程。方法由两个核心模块组成：全局到局部搜索模块利用3D FFT相关在平移空间中快速定位候选位姿，结合低差异SO(3)采样在旋转空间中进行高效搜索，实现粗略但可靠的初始位姿估计；连续SE(3)精炼模块通过李代数参数化位姿更新，并利用解析计算的接触敏感度梯度进行迭代优化，实现高精度的位姿精炼。仿真和实验结果表明，该方法在自由曲面和牙齿预备等实际应用中均达到了亚毫米级配准精度，且对位姿噪声和接触丢失具有强鲁棒性，无需任何外部传感器标定。
效果展示
图 5 仿真整体示意 采用圆柱形探测头对五类物体网格执行接触轨迹生成，半透明扫掠体代表配准过程中探测头的仿真运动轨迹。实验过程中添加了高斯噪声，为便于观察，本图已隐去噪声。
引言
物体配准是计算机视觉、机器人学和医学影像等领域的核心技术之一，其目标是从传感器测量中估计物体相对于参考坐标系或另一个物体的六自由度位姿。在工业制造中，配准用于零件定位和质量检测；在医疗手术中，配准用于手术导航和假体植入；在机器人操作中，配准用于抓取规划和装配引导。配准的精度和鲁棒性直接决定了这些应用的可靠性和安全性。
传统的配准方法主要依赖光学传感器，如光学追踪器（NDI Polaris等）、结构光扫描仪和立体视觉系统。这些方法在大多数场景中表现良好，但在某些特殊条件下存在固有局限。例如，在口腔手术中，手术区域的狭小空间和血液唾液等干扰使得光学追踪器的视线容易被遮挡；在金属加工环境中，金属表面的高反射率和电磁干扰会影响光学和电磁传感器的精度。在这些场景中，基于物理接触的配准方法展现出独特的优势。
接触配准通过探针与物体表面的物理接触来获取位姿信息，具有不受光照、遮挡和电磁干扰影响的优势。然而，接触配准也面临独特的技术挑战。每次接触测量仅提供物体在接触点法线方向上的约束，信息量远少于视觉或深度传感器。如何从稀疏的接触测量中恢复完整的六自由度位姿，同时保证高精度和强鲁棒性，是该领域的核心科学问题。
本文的创新思路是跳出传统的"接触点匹配"范式，将接触配准重新表述为"互补形状对接"问题。这一重新表述不仅提供了更加优雅的数学框架，还自然地导出了高效的求解算法。通过将探针的运动轨迹建模为扫掠体积，配准问题转化为寻找物体与扫掠体积之间最佳互补对接的位姿，从而充分利用了接触测量的几何约束信息。
主要贡献
本文的主要贡献可以概括为以下三个方面：
• 提出了互补形状对接的接触配准新范式，将传统的接触点匹配问题重新表述为物体与探针扫掠体积之间的互补对接问题，提供了更加优雅的数学框架和更丰富的几何约束，从根本上提升了接触配准的精度上限。
• 设计了全局到局部搜索与连续SE(3)精炼的两阶段算法框架，全局搜索利用3D FFT相关和低差异SO(3)采样实现高效的初始位姿估计，局部精炼通过李代数更新和解析接触敏感度梯度实现高精度位姿优化，在保证全局收敛性的同时达到了亚0.04mm的配准精度。
• 在牙齿预备机器人等实际应用中验证了方法的实用性，配准精度达到0.42mm和3.75度，超越了光学追踪器的配准精度，且完全不需要外部传感器标定，展示了接触配准在精密医疗和工业应用中的巨大潜力。
方法
本文的方法框架由两个核心模块组成：全局到局部搜索模块负责从大量候选位姿中快速定位正确的初始位姿，连续SE(3)精炼模块负责将初始位姿优化到高精度。输入为物体的三维网格模型和一系列接触测量记录（包含探针位姿和接触法线），输出为物体相对于探针坐标系的精确六自由度位姿。
全局到局部搜索模块的关键创新在于将平移搜索和旋转搜索解耦。在平移搜索阶段，将物体网格体素化后与探针扫掠体积体素化结果进行3D FFT互相关运算，在O(n log n)时间复杂度内完成整个平移空间的搜索，生成候选平移的热力图。在旋转搜索阶段，采用低差异序列（如Sobol序列）在SO(3)旋转群上进行均匀采样，对每个候选旋转计算互补对接的匹配分数。平移和旋转搜索的结合实现了高效的六自由度粗定位，为后续精炼提供了可靠的初始位姿。
连续SE(3)精炼模块将位姿优化问题建立在光滑的SE(3)流形上。位姿更新通过李代数（se(3)）的指数映射实现，保证了迭代过程中位姿始终位于有效的SE(3)空间内。目标函数综合考虑了互补对接的紧密程度和接触法线的一致性，梯度通过解析计算接触敏感度获得，避免了数值微分的精度损失。整个优化过程快速收敛，通常在10-20次迭代内达到亚0.04mm的精度。
实验结果
实验分为仿真和实际应用两个部分。仿真实验使用多个自由曲面网格模型（包括球面、圆柱面和复杂雕塑曲面），在不同水平的位姿噪声和接触丢失率下评估配准精度。实际实验在牙齿预备机器人平台上进行，将本文方法与商用的NDI光学追踪器进行直接对比。评估指标包括平移误差（mm）、旋转误差（度）和成功率。
仿真结果表明，在无噪声的理想条件下，本文方法在所有测试模型上均达到了亚0.04mm的平移精度和亚0.4度的旋转精度。在加入位姿噪声（标准差0.5mm/0.5度）后，配准精度仅轻微下降，展现了良好的鲁棒性。在接触丢失率高达30%的情况下，方法仍然能够保持可靠的配准性能，证明了互补形状对接框架对不完整测量的容忍能力。
在实际牙齿预备机器人实验中，本文方法的配准精度达到0.42mm和3.75度，显著优于NDI光学追踪器的0.68mm和5.12度。这一结果验证了接触配准在精密医疗场景中替代光学追踪器的可行性。消融实验表明，全局搜索模块对于避免局部最优至关重要，移除后配准成功率从98%下降到72%；解析接触敏感度梯度相比数值梯度在收敛速度和最终精度上均有明显优势。
总结 & 未来工作
本文提出了互补形状对接的接触配准新范式，通过两阶段算法框架实现了从有限接触测量到高精度六自由度位姿估计的完整流程。在仿真中达到亚0.04mm和亚0.4度的配准精度，在实际牙齿预备机器人应用中超越了光学追踪器的精度，且无需任何外部传感器标定，为精密医疗和工业应用提供了一种可靠的配准替代方案。
未来的研究方向包括：将方法扩展到在线配准场景，实现接触过程中的实时位姿跟踪；探索自适应接触点选择策略，以最少的接触次数达到目标精度；研究多探针协同接触配准方法，进一步提升配准速度和鲁棒性；以及将框架推广到柔性物体和动态场景的接触配准中。
对更多实验结果和文章细节感兴趣的读者，可以阅读一下论文原文~
本文仅做学术分享，如有侵权，请联系删文。
。
添加微信：cv3d001，备注：姓名+方向+单位，邀请入群。
