arXiv:2609.03222cs.RO2026-09

提出快速验证机器人位姿估计最优解的新方法,解决传统方法在异常值下失效的问题。

Following a Unique Path: A Fast Certifier Applied to Outlier-Robust Pose Registration

论文配图:Following a Unique Path: A Fast Certifier Applied to Outlier-Robust Pose Registration
图 1 · 摘自论文原文
  • 基于候选解沿中心路径搜索可验证区域,避免求解复杂松弛问题。
  • 在模拟数据上速度比最先进直接求解器快三个数量级。
  • 适用于带异常值的点云配准,适合需要高可靠性定位的机器人系统。

可验证方法通过凸半定规划(SDP)松弛,保证非凸问题全局最优解。现有高性能方法先用局部求解器获得候选解,再通过高效线性代数技术验证其最优性。但在机器人领域诸多问题中,该方法受松弛退化影响,导致必须耗费大量计算求解松弛问题。本文提出中央路径验证器(CP-Cert),专为处理此类退化问题设计。以候选解为起点,方法寻找可行域内的一条称为“中心路径”的邻近区域,从而快速获取有效验证证书。通过间接线性代数、问题稀疏性与并行计算保持效率。将该方法应用于加权矩阵位姿配准与点云数据关联,其新颖的SDP松弛具有独立研究价值。在模拟实验中,验证了该松弛性质,并表明CP-Cert运行速度快,可达最先进直接求解器的三阶量级提升。最终,构建出一个可验证且抗异常值的位姿估计算法流程,并应用于真实数据。

原文摘要 · Abstract (English)

Certifiable methods have arisen as a means to guarantee global optimality of solutions to non-convex problems using convex semidefinite programming (SDP) relaxations. The most performant of these methods use a local solver to obtain the candidate solution, and then certify its optimality using efficient linear algebra techniques. However, for many problems of interest in robotics, this local-solve-then-certify approach is impeded by a form of degeneracy in the relaxation, leaving a costly optimization of the relaxation as the only recourse. In this paper, we introduce our Central-Path Certifier (CP-Cert), a certifiable method explicitly tailored to certify candidate optima to problems that exhibit this form of degeneracy. Using a candidate as a starting point, our approach seeks a nearby region of the feasible space -- known as the central path -- where a valid certificate can be readily obtained. The approach is kept efficient by exploiting indirect linear algebra techniques, problem sparsity, and parallelism. We apply CP-Cert to both matrix-weighted pose registration and pointcloud data association, whose novel SDP relaxation is of independent interest. On simulated examples, we explore the properties of this novel relaxation and show that CP-Cert is fast and scalable, achieving runtimes that are up to three orders of magnitude faster than state-of-the-art direct solvers. Finally, we combine these contributions into a certifiable, outlier-robust pose-estimation pipeline, which we apply to real-world data.

位姿估计可验证性机器人优化

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。