Abstract:The combination of visual and inertial sensors for state estimation has recently found wide echo in the robotics community, especially in the aerial robotics field, due to the lightweight and complementary characteristics of the sensors data. However, most state estimation systems based on visual-inertial sensing suffer from severe processor requirements, which in many cases make them impractical. In this paper, we propose a simple, low-cost and high rate method for state estimation enabling autonomous flight of micro aerial vehicles, which presents a low computational burden. The proposed state estimator fuses observations from an inertial measurement unit, an optical flow smart camera and a time-of-flight range sensor. The smart camera provides optical flow measurements up to a rate of 200 Hz, avoiding the computational bottleneck to the main processor produced by all image processing requirements. To the best of our knowledge, this is the first example of extending the use of these smart cameras from hovering-like motions to odometry estimation, producing estimates that are usable during flight times of several minutes. In order to validate and defend the simplest algorithmic solution, we investigate the performances of two Kalman filters, in the extended and error-state flavors, alongside with a large number of algorithm modifications defended in earlier literature on visual-inertial odometry, showing that their impact on filter performance is minimal. To close the control loop, a non-linear controller operating in the special Euclidean group SE(3) is able to drive, based on the estimated vehicle’s state, a quadrotor platform in 3D space guaranteeing the asymptotic stability of 3D position and heading. All the estimation and control tasks are solved on board and in real time on a limited computational unit. The proposed approach is validated through simulations and experimental results, which include comparisons with ground-truth data provided by a motion capture system. For the benefit of the community, we make the source code public.

Invariant Extended Kalman Filter-based state estimation for MAV in GPS-denied environments

Invariant Observer Design of a RGB-D Aided Inertial System for MAV in GPS-Denied Environments

Invariant Observer-Based State Estimation for Micro-Aerial Vehicles in GPS-Denied Indoor Environments Using an RGB-D Camera and MEMS Inertial Sensors.

Combined RGBD-inertial based state estimation for MAV in GPS-denied indoor environments

A Visual-Inertial Navigation System Based on Multi-State Constraint Kalman Filter

Direct Visual-Inertial Ego-Motion Estimation via Iterated Extended Kalman Filter

Inertial-Aided Metric States and Surface Normal Estimation Using a Monocular Camera.

Cascaded Motion Estimation for Intelligent Vehicles in GNSS-Denied Scenes

Indoor Integrated Navigation of Micro Aerial Vehicle Based on Radar-Scanner and Inertial Navigation System

Body-Centered Dynamically-Tuned Error-State Extended Kalman Filter for Visual Inertial Odometry in GNSS-Denied Environments

Toward Autonomous Navigation Using an RGB-D Camera for Flight in Unknown Indoor Environments

Inertial-aided State and Slope Estimation Using a Monocular Camera

Sensing and Control of a Quadrotor Using a Visual Inertial Fusion Method

Visual Odometry and 3D Mapping in Indoor Environments

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

Features of Invariant Extended Kalman Filter Applied to Unmanned Aerial Vehicle Navigation

Semi-Aerodynamic Model Aided Invariant Kalman Filtering for UAV Full-State Estimation

Robust Stereo Visual Inertial Navigation System Based on Multi-Stage Outlier Removal in Dynamic Environments

Autonomous navigation of micro aerial vehicles using high-rate and low-cost sensors

Variational Bayesian-Based Adaptive Error-State Kalman Filter With Application on LiDAR-Inertial Integrated Navigation System

Robust Vision-Aided Inertial Navigation System for Protection Against Ego-Motion Uncertainty of Unmanned Ground Vehicle