InGVIO: A Consistent Invariant Filter for Fast and High-Accuracy GNSS-Visual-Inertial Odometry

by   Changwu Liu, et al.

Combining Global Navigation Satellite System (GNSS) with visual and inertial sensors can give smooth pose estimation without drifting in geographical coordinates. The fusion system gradually degrades to Visual-Inertial Odometry (VIO) with the number of satellites decreasing, which guarantees robust global navigation in GNSS unfriendly environments. In this letter, we propose an open-sourced invariant filter-based platform, InGVIO, to tightly fuse monocular/stereo visual-inertial measurements, along with raw data from GNSS, i.e. pseudo ranges and Doppler shifts. InGVIO gives highly competitive results in terms of accuracy and computational load compared to current graph-based and `naive' EKF-based algorithms. Thanks to our proposed key-frame marginalization strategies, the baseline for triangulation is large although only a few cloned poses are kept. Besides, landmarks are anchored to a single cloned pose to fit the nonlinear log-error form of the invariant filter while achieving decoupled propagation with IMU states. Moreover, we exploit the infinitesimal symmetries of the system, which gives equivalent results for the pattern of degenerate motions and the structure of unobservable subspaces compared to our previous work using observability analysis. We show that the properly-chosen invariant error captures such symmetries and has intrinsic consistency properties. InGVIO is tested on both open datasets and our proposed fixed-wing datasets with variable levels of difficulty. The latter, to the best of our knowledge, are the first datasets open-sourced to the community on a fixed-wing aircraft with raw GNSS.


Tightly-coupled Fusion of Global Positional Measurements in Optimization-based Visual-Inertial Odometry

Motivated by the goal of achieving robust, drift-free pose estimation in...

Precise Visual-Inertial Localization for UAV with the Aid of A 2D Georeferenced Map

Precise geolocalization is crucial for unmanned aerial vehicles (UAVs). ...

UMS-VINS: United Monocular-Stereo Features for Visual-Inertial Tightly Coupled Odometry

This paper introduces the united monocular-stereo features into a visual...

Robocentric Visual-Inertial Odometry

In this paper, we propose a novel robocentric formulation of the visual-...

Minimization of GNSS-Denied Inertial Navigation Errors for Fixed Wing Autonomous Unmanned Air Vehicles

This article proposes an inertial navigation algorithm intended to lower...

EqVIO: An Equivariant Filter for Visual Inertial Odometry

Visual Inertial Odometry (VIO) is the problem of estimating a robot's tr...

Consistent Right-Invariant Fixed-Lag Smoother with Application to Visual Inertial SLAM

State estimation problems that use relative observations routinely arise...

Please sign up or login with your details

Forgot password? Click here to reset