用姿态仅表示法提升视觉惯性定位精度,融合GNSS实现无漂移高鲁棒定位。
PO-GVINS: Tightly Coupled GNSS-Visual-Inertial Integration with Pose-Only Representation
- 采用姿态仅表示法替代传统多视图特征,避免特征维度爆炸和线性化误差。
- 融合已解算整数偏差的GNSS原始观测,实现厘米级定位与零漂移状态估计。
- 适合自动驾驶、无人机等复杂环境下对高精度定位有要求的应用场景。
高精度可靠的定位对于自动驾驶、无人机及智能机器人等系统的感知与决策至关重要。由于单一传感器存在固有局限,融合具备互补能力的异构传感器是实现该目标的有效途径。本文提出一种基于滤波器的紧耦合全球导航卫星系统(GNSS)-视觉惯性定位框架,采用仅姿态表示(pose-only, PO)形式的视觉惯性系统(VINS),命名为PO-GVINS。现有VINS通常依赖3D特征先验,需联合估计相机位姿与3D特征位置,易引入特征线性化误差并导致状态维度爆炸。而姿态仅表示法通过两个相机位姿表示特征深度,将3D特征位置从状态向量中移除,避免上述问题。我们首次在VINS中应用该方法,即PO-VINS;随后引入已解算整数偏差的GNSS原始测量,实现高精度、无漂移的状态估计。大量实验表明,所提PO-VINS显著优于多状态约束卡尔曼滤波器(MSCKF);结合GNSS后,PO-GVINS在复杂环境中实现了精确、无漂移的定位,具备强鲁棒性。
原文摘要 · Abstract (English)
Accurate and reliable positioning is crucial for perception, decision-making, and other high-level applications in autonomous driving, unmanned aerial vehicles, and intelligent robots. Given the inherent limitations of standalone sensors, integrating heterogeneous sensors with complementary capabilities is one of the most effective approaches to achieving this goal. In this paper, we propose a filtering-based, tightly coupled global navigation satellite system (GNSS)-visual-inertial positioning framework with a pose-only formulation applied to the visual-inertial system (VINS), termed PO-GVINS. Specifically, multiple-view imaging used in current VINS requires a priori of 3D feature, then jointly estimate camera poses and 3D feature position, which inevitably introduces linearization error of the feature as well as facing dimensional explosion. However, the pose-only (PO) formulation, which is demonstrated to be equivalent to the multiple-view imaging and has been applied in visual reconstruction, represent feature depth using two camera poses and thus 3D feature position is removed from state vector avoiding aforementioned difficulties. Inspired by this, we first apply PO formulation in our VINS, i.e., PO-VINS. GNSS raw measurements are then incorporated with integer ambiguity resolved to achieve accurate and drift-free estimation. Extensive experiments demonstrate that the proposed PO-VINS significantly outperforms the multi-state constrained Kalman filter (MSCKF). By incorporating GNSS measurements, PO-GVINS achieves accurate, drift-free state estimation, making it a robust solution for positioning in challenging environments.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。