Geometric Stochastic Filter with Guaranteed Performance for Autonomous Navigation based on IMU and Feature Sensor Fusion

Abstract

This paper concerns the estimation problem of attitude, position, and linear velocity of a rigid-body autonomously navigating with six degrees of freedom (6 DoF). The navigation dynamics are highly nonlinear and are modeled on the matrix Lie group of the extended Special Euclidean Group ${\mathbb{SE}}_2(3)$. A computationally cheap geometric nonlinear stochastic navigation filter is proposed on ${\mathbb{SE}}_2(3)$ with guaranteed transient and steady-state performance. The proposed filter operates based on a fusion of sensor measurements collected by a low-cost inertial measurement unit (IMU) and features (obtained by a vision unit). The closed loop error signals are guaranteed to be almost semi-globally uniformly ultimately bounded in the mean square from almost any initial condition. The equivalent quaternion representation is included in the Appendix. The filter is proposed in continuous form, and its discrete form is tested on a real-world dataset of measurements collected by a quadrotor navigating in three dimensional (3D) space. Keywords: Localization, navigation, position and orientation estimation, stochastic systems, GPS-denied navigation observer, navigation estimator, vision-aided inertial navigation systems (VA-INSs), stochastic differential equation, Gaussian noise, sensor fusion.

Control Engineering Practice

References in corpus (5)

• Systematic Convergence of Nonlinear Stochastic Estimators on the Special Orthogonal Group SO(3)
• Landmark and IMU Data Fusion: Systematic Convergence Geometric Nonlinear Observer for SLAM and Velocity Bias
• A Geometric Nonlinear Stochastic Filter for Simultaneous Localization and Mapping
• Nonlinear Stochastic Estimators on the Special Euclidean Group SE(3) using Uncertain IMU and Vision Measurements
• Nonlinear Pose Filters on the Special Euclidean Group SE(3) with Guaranteed Transient and Steady-state Performance

Cited by in corpus (9)

• Advances in UAV Avionics Systems Architecture, Classification and Integration: A Comprehensive Review and Future Perspectives
• UWB Ranging and IMU Data Fusion: Overview and Nonlinear Stochastic Filter for Inertial Navigation
• Observer-based Controller for VTOL-UAVs Tracking using Direct Vision-Aided Inertial Navigation Measurements
• Exponentially Stable Observer-based Controller for VTOL-UAVs without Velocity Measurements
• Equivariant Filter Design for Inertial Navigation Systems with Input Measurement Biases
• Quaternion-based Unscented Kalman Filter for 6-DoF Vision-based Inertial Navigation in GPS-denied Regions
• Adaptive Neural Network Stochastic-Filter-based Controller for Attitude Tracking with Disturbance Rejection
• DeepUKF-VIN: Adaptively-tuned Deep Unscented Kalman Filter for 3D Visual-Inertial Navigation based on IMU-Vision-Net
• Asymptotically Stable Observer-based Controller for Attitude Tracking with Systematic Convergence