arXiv:2409.11372cs.RO2024-09中稿 · the 2025 IEEE/RSJ …被引 3

提出新型视觉惯性导航滤波器,单精度下更稳定且快41%。

PC-SRIF: Preconditioned Cholesky-based Square Root Information Filter for Vision-aided Inertial Navigation

  • 用预条件化改进平方根信息滤波,提升Cholesky分解稳定性。
  • 在单精度下实现41%提速,性能优于传统QR方法。
  • 适合追求高效率与稳定性的嵌入式视觉惯性系统开发者。

本文提出一种新型视觉惯性导航系统(VINS)估计算法——预条件化基于Cholesky的平方根信息滤波器(PC-SRIF)。现有基于(平方根)信息滤波的VINS常因数值不稳定性而采用QR分解,尤其在单精度平台上。我们分析发现,信息矩阵病态并非VINS固有特性,而是特定参数化导致。通过识别影响条件数的关键因素,提出预条件技术缓解该问题。基于此,构建的PC-SRIF在单精度下仍能稳定进行Cholesky分解,理论效率更高。实验验证表明,所实现的PC-SRIF在运行时间上比基于QR的SRIF快41%,充分支持其理论优势。

原文摘要 · Abstract (English)

In this paper, we introduce a novel estimator for vision-aided inertial navigation systems (VINS), the Preconditioned Cholesky-based Square Root Information Filter (PC-SRIF). When solving linear systems, employing Cholesky decomposition offers superior efficiency but can compromise numerical stability. Due to this, existing VINS utilizing (Square Root) Information Filters often opt for QR decomposition on platforms where single precision is preferred, avoiding the numerical challenges associated with Cholesky decomposition. While these issues are often attributed to the ill-conditioned information matrix in VINS, our analysis reveals that this is not an inherent property of VINS but rather a consequence of specific parameterizations. We identify several factors that contribute to an ill-conditioned information matrix and propose a preconditioning technique to mitigate these conditioning issues. Building on this analysis, we present PC-SRIF, which exhibits remarkable stability in performing Cholesky decomposition in single precision when solving linear systems in VINS. Consequently, PC-SRIF achieves superior theoretical efficiency compared to alternative estimators. To validate the efficiency advantages and numerical stability of PC-SRIF based VINS, we have conducted well controlled experiments, which provide empirical evidence in support of our theoretical findings. Remarkably, in our VINS implementation, PC-SRIF's runtime is 41% faster than QR-based SRIF.

视觉惯性滤波器高效算法

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