利用可分离性与稀疏性加速机器人感知中的非线性优化,提升35倍效率。
Sparse Variable Projection in Robotic Perception: Exploiting Separable Structure for Efficient Nonlinear Optimization
- 通过变量投影法消除线性变量,构建矩阵自由的舒尔补算子
- 在SLAM/SfM等任务中实现2至35倍提速,精度保持不变
- 适用于存在全局对称性的场景,适合需要高效优化的机器人系统
机器人感知常需求解大规模非线性最小二乘(NLS)问题。尽管稀疏性已被广泛利用以提升求解器性能,但另一种互补且未被充分挖掘的结构——可分离性——却较少关注:部分变量(如视觉特征点)在残差中呈线性,当其余变量(如位姿)确定后,其解有闭式表达。变量投影(VarPro)方法正是通过解析消去线性变量,将问题简化为仅含剩余变量的低维问题,具有更优性质。然而,标准VarPro在机器人感知中应用受限,主要因普遍存在的规范对称性(如全局平移/旋转不变性)引发特定计算挑战。本文提出一种专为具规范对称性问题设计的VarPro方案,同时利用可分离性与稀疏性。该方法作为一次预处理,生成一个矩阵自由的舒尔补算子,可高效计算约化问题的成本、梯度及海森-向量乘积,并可无缝集成至标准迭代非线性最小二乘求解器。我们给出了该方法适用的精确条件,并讨论了条件部分满足时的扩展策略。在合成与真实数据上的SLAM、SNL和SfM基准测试中,本方法相较当前最优方法运行速度提升最高达35倍,同时保持高精度。代码与实验数据均已开源。
原文摘要 · Abstract (English)
Robotic perception often requires solving large nonlinear least-squares (NLS) problems. While sparsity has been well-exploited to scale solvers, a complementary and underexploited structure is \emph{separability} -- where some variables (e.g., visual landmarks) appear linearly in the residuals and, for any estimate of the remaining variables (e.g., poses), have a closed-form solution. Variable projection (VarPro) methods are a family of techniques that exploit this structure by analytically eliminating the linear variables and presenting a reduced problem in the remaining variables that has favorable properties. However, VarPro has seen limited use in robotic perception; a major challenge arises from gauge symmetries (e.g., cost invariance to global shifts and rotations), which are common in perception and induce specific computational challenges in standard VarPro approaches. We present a VarPro scheme designed for problems with gauge symmetries that jointly exploits separability and sparsity. Our method can be applied as a one-time preprocessing step to construct a \emph{matrix-free Schur complement operator}. This operator allows efficient evaluation of costs, gradients, and Hessian-vector products of the reduced problem and readily integrates with standard iterative NLS solvers. We provide precise conditions under which our method applies, and describe extensions when these conditions are only partially met. Across synthetic and real benchmarks in SLAM, SNL, and SfM, our approach achieves up to \textbf{2$\times$--35$\times$ faster runtimes} than state-of-the-art methods while maintaining accuracy. We release an open-source C++ implementation and all datasets from our experiments.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。