Accuracy and computational efficiency are the most important metrics to Visual Inertial Navigation System (VINS). The existing VINS algorithms with either high accuracy or low computational complexity, are difficult to provide the high precision localization in resource-constrained devices. To this end, we propose a novel filter-based VINS framework named SchurVINS, which could guarantee both high accuracy by building a complete residual model and low computational complexity with Schur complement. Technically, we first formulate the full residual model where Gradient, Hessian and observation covariance are explicitly modeled. Then Schur complement is employed to decompose the full model into ego-motion residual model and landmark residual model. Finally, Extended Kalman Filter (EKF) update is implemented in these two models with high efficiency. Experiments on EuRoC and TUM-VI datasets show that our method notably outperforms state-of-the-art (SOTA) methods in both accuracy and computational complexity. We will open source our experimental code to benefit the community.

翻译：精度与计算效率是视觉惯性导航系统（VINS）最重要的指标。现有VINS算法或具有高精度，或具有低计算复杂度，难以在资源受限设备上提供高精度定位。为此，我们提出了一种名为SchurVINS的新型滤波式VINS框架，该框架通过构建完整残差模型保证高精度，并利用Schur补实现低计算复杂度。技术层面，我们首先构建包含显式建模的梯度、海森矩阵和观测协方差的完整残差模型；随后采用Schur补将完整模型分解为自运动残差模型和路标残差模型；最终在这两个模型上高效执行扩展卡尔曼滤波（EKF）更新。在EuRoC和TUM-VI数据集上的实验表明，我们的方法在精度和计算复杂度上均显著优于当前最优（SOTA）方法。我们将开源实验代码以惠及社区。