Abstract:Combining Global Navigation Satellite System (GNSS) with visual and inertial sensors can give smooth pose estimation without drifting. 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. InGVIO gives highly competitive results in terms of computational load compared to current graph-based algorithms, meanwhile possessing the same or even better level of accuracy. Thanks to our proposed marginalization strategies, the baseline for triangulation is large although only a few cloned poses are kept. Moreover, we define the infinitesimal symmetries of the system and exploit the various structures of its symmetry group, being different from the total symmetries of the VIO case, which elegantly gives results for the pattern of degenerate motions and the structure of unobservable subspaces. We prove that the properly-chosen invariant error is still compatible with all possible symmetry group structures of InGVIO and has intrinsic consistency properties. Besides, InGVIO has strictly linear error propagation without linearization error. InGVIO is tested on both open datasets and our proposed fixed-wing datasets with variable levels of difficulty and various numbers of satellites. The latter datasets, to the best of our knowledge, are the first datasets open-sourced to the community on a fixed-wing aircraft with raw GNSS.

A Novel Binocular OI( Orthogonal Iteration) Fusion Algorithm Better for Estimation of Spacecraft Position and Attitude

A novel rectification framework for coaxial omni-directional stereo

Improved Iterative Pose Estimation Algorithm Using Three-Dimensional Feature Points

A Monocular Odometer for a Quadrotor Using a Homography Model and Inertial Cues

A Tightly Coupled Feature-Based Visual-Inertial Odometry With Stereo Cameras

Robust and Efficient Visual-Inertial Odometry with Multi-plane Priors.

A Novel Algorithm for Pose Estimation Based on Generalized Orthogonal Iteration with Uncertainty-Weighted Measuring Error of Feature Points

A Homography-Based Visual Inertial Fusion Method for Robust Sensing of a Micro Aerial Vehicle

Nonlinear Complementary Filter for Attitude Estimation by Fusing Inertial Sensors and a Camera

Robust Visual Inertial Monocular Using Nonlinear Optimization.

Tightly Coupled Visual-Inertial Fusion with Image Enhancement for Robust Positioning

High Precision and Fast Estimation of Position and Attitude Measurement for Space Targets

Stereo Orientation Prior for UAV Robust and Accurate Visual Odometry

DS-VIO: Robust and Efficient Stereo Visual Inertial Odometry based on Dual Stage EKF

Tightly Coupled Algorithm of Visual Inertial Odometry and Magnetometer Fusion

Multi-Sensor Fusion Positioning Method Based on Batch Inverse Covariance Intersection and IMM

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

Modeling Varying Camera-IMU Time Offset in Optimization-Based Visual-Inertial Odometry

Automatic Instantaneous Attitude Estimation Framework for Spacecraft Based on Colocated Optical/ISAR Observation

Optimization-based alignment for inertial navigation systems: Theory and algorithm

A 6-DOF Navigation Method based on Iterative Closest Imaging Point Algorithm