GPS-denied Navigation: Attitude, Position, Linear Velocity, and Gravity Estimation with Nonlinear Stochastic Observer

Successful navigation of a rigid-body traveling with six degrees of freedom (6 DoF) requires accurate estimation of attitude, position, and linear velocity. The true navigation dynamics are highly nonlinear and are modeled on the matrix Lie group of SE2(3). This paper presents novel geometric nonlinear continuous stochastic navigation observers on SE2(3) capturing the true nonlinearity of the problem. The proposed observers combines IMU and landmark measurements. It efficiently handles the IMU measurement noise. The proposed observers are guaranteed to be almost semi-globally uniformly ultimately bounded in the mean square. Quaternion representation is provided. A real-world quadrotor measurement dataset is used to validate the effectiveness of the proposed observers in its discrete form.

[1]  Minh-Duc Hua,et al.  Riccati Observer Design for Pose, Linear Velocity and Gravity Direction Estimation Using Landmark Position and IMU Measurements , 2018, 2018 IEEE Conference on Control Technology and Applications (CCTA).

[2]  Hashim A. Hashim.  Guaranteed Performance Nonlinear Observer for Simultaneous Localization and Mapping , 2020, IEEE Control Systems Letters.

[3]  Hashim A. Hashim.  A Geometric Nonlinear Stochastic Filter for Simultaneous Localization and Mapping , 2021, Aerospace Science and Technology.

[4]  Tor Arne Johansen,et al.  Attitude Estimation Using Biased Gyro and Vector Measurements With Time-Varying Reference Vectors , 2012, IEEE Transactions on Automatic Control.

[5]  Roland Siegwart,et al.  The EuRoC micro aerial vehicle datasets , 2016, Int. J. Robotics Res..

[6]  Miroslav Krstic,et al.  Stabilization of stochastic nonlinear systems driven by noise of unknown covariance , 2001, IEEE Trans. Autom. Control..

[7]  Hai-Bo Ji,et al.  Adaptive output-feedback tracking of stochastic nonlinear systems , 2006, IEEE Trans. Autom. Control..

[8]  Axel Barrau,et al.  The Invariant Extended Kalman Filter as a Stable Observer , 2014, IEEE Transactions on Automatic Control.

[9]  Hashim A. Hashim,et al.  Landmark and IMU Data Fusion: Systematic Convergence Geometric Nonlinear Observer for SLAM and Velocity Bias , 2020, IEEE Transactions on Intelligent Transportation Systems.

[10]  Hashim A. Hashim.  Special Orthogonal Group SO(3), Euler Angles, Angle-axis, Rodriguez Vector and Unit-Quaternion: Overview, Mapping and Challenges , 2019, ArXiv.

[11]  Taeyoung Lee,et al.  Exponential stability of an attitude tracking control system on SO(3) for large-angle rotational maneuvers , 2012, Syst. Control. Lett..

[12]  F. Markley,et al.  Unscented Filtering for Spacecraft Attitude Estimation , 2003 .

[13]  Carlos Silvestre,et al.  On the observability of linear motion quantities in navigation systems , 2011, Syst. Control. Lett..

[14]  William G. Faris.  Lectures on Stochastic Processes , 2004 .

[15]  Hashim A Hashim.  Nonlinear Stochastic Estimators on the Special Euclidean Group SE(3) using Uncertain IMU and Vision Measurements , 2020, ArXiv.

[16]  Hashim A. Hashim,et al.  Nonlinear Pose Filters on the Special Euclidean Group SE(3) With Guaranteed Transient and Steady-State Performance , 2019, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[17]  Hashim A. Hashim,et al.  Nonlinear Stochastic Attitude Filters on the Special Orthogonal Group 3: Ito and Stratonovich , 2018, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[18]  A. D. Lewis,et al.  Geometric control of mechanical systems : modeling, analysis, and design for simple mechanical control systems , 2005 .

[19]  Rita Cunha,et al.  A nonlinear position and attitude observer on SE(3) using landmark measurements , 2010, Syst. Control. Lett..