A Direct and Non-Singular UKF Approach Using Euler Angle Kinematics for Integrated Navigation Systems

This paper presents a direct and non-singular approach based on an unscented Kalman filter (UKF) for the integration of strapdown inertial navigation systems (SINSs) with the aid of velocity. The state vector includes velocity and Euler angles, and the system model contains Euler angle kinematics equations. The measured velocity in the body frame is used as the filter measurement. The quaternion nonlinear equality constraint is eliminated, and the cross-noise problem is overcome. The filter model is simple and easy to apply without linearization. Data fusion is performed by an UKF, which directly estimates and outputs the navigation information. There is no need to process navigation computation and error correction separately because the navigation computation is completed synchronously during the filter time updating. In addition, the singularities are avoided with the help of the dual-Euler method. The performance of the proposed approach is verified by road test data from a land vehicle equipped with an odometer aided SINS, and a singularity turntable test is conducted using three-axis turntable test data. The results show that the proposed approach can achieve higher navigation accuracy than the commonly-used indirect approach, and the singularities can be efficiently removed as the result of dual-Euler method.

[1]  H. S. Wolff,et al.  iRun: Horizontal and Vertical Shape of a Region-Based Graph Compression , 2022, Sensors.

[2]  Weng Jun,et al.  SINS in-motion alignment and position determination for land-vehicle based on quaternion Kalman filter , 2013, Proceedings of the 32nd Chinese Control Conference.

[3]  Narjes Davari,et al.  Asynchronous direct Kalman filtering approach for underwater integrated navigation system , 2015 .

[4]  Nicolas Petit,et al.  Navigation system for ground vehicles using temporally interconnected observers , 2011, Proceedings of the 2011 American Control Conference.

[5]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[6]  Sugjoon Yoon.  A Study on Optimal Switching Angles in Dual-Euler Method , 2002 .

[8]  Daniele Mortari,et al.  How to avoid singularity when using Euler angles , 2005 .

[9]  John B. Moore,et al.  Direct Kalman filtering approach for GPS/INS integration , 2002 .

[10]  Lin Zhao,et al.  An Adaptive Unscented Kalman Filtering Algorithm for MEMS/GPS Integrated Navigation Systems , 2014, J. Appl. Math..

[11]  Aboelmagd Noureldin,et al.  Vehicle navigator using a mixture particle filter for inertial sensors/odometer/map data/GPS integration , 2012, IEEE Transactions on Consumer Electronics.

[12]  O Hegrenaes,et al.  Model-Aided INS With Sea Current Estimation for Robust Underwater Navigation , 2011, IEEE Journal of Oceanic Engineering.

[13]  Seong Yun Cho,et al.  Modified Unscented Kalman Filter for a Multirate INS/GPS Integrated Navigation System , 2013 .

[14]  Wanli Li,et al.  A Novel Scheme for DVL-Aided SINS In-Motion Alignment Using UKF Techniques , 2013, Sensors.

[15]  Mohammed Benjelloun,et al.  Quaternion Unscented Kalman Filtering for integrated Inertial Navigation and GPS , 2008, 2008 11th International Conference on Information Fusion.

[16]  Liu Hua Qun,et al.  Research on Control of Aircraft Trajectory in Simulating Game Scene Based on the Double Euler Method , 2013 .

[17]  Hugh F. Durrant-Whyte,et al.  A new method for the nonlinear transformation of means and covariances in filters and estimators , 2000, IEEE Trans. Autom. Control..

[18]  J. Junkins,et al.  Stereographic Orientation Parameters for Attitude Dynamics: A Generalization of the Rodrigues Parameters , 1996 .

[19]  P. Zhang,et al.  Navigation with IMU/GPS/digital compass with unscented Kalman filter , 2005, IEEE International Conference Mechatronics and Automation, 2005.

[20]  M. Shuster.  A survey of attitude representation , 1993 .

[21]  Kyoung-Ho Choi,et al.  Ground vehicle navigation in harsh urban conditions by integrating inertial navigation system, global positioning system, odometer and vision data , 2011 .

[22]  I. Bar-Itzhack,et al.  Novel quaternion Kalman filter , 2002, IEEE Transactions on Aerospace and Electronic Systems.

[23]  Xiaosu Xu,et al.  Kalman Filter for Cross-Noise in the Integration of SINS and DVL , 2014 .

[24]  Yuanyuan Zhao,et al.  Autonomous Underwater Vehicle Navigation , 2010, IEEE Journal of Oceanic Engineering.

[25]  Joseph J. LaViola,et al.  On Kalman Filtering With Nonlinear Equality Constraints , 2007, IEEE Transactions on Signal Processing.

[26]  Eun-Hwan Shin,et al.  An unscented Kalman filter for in-motion alignment of low-cost IMUs , 2004, PLANS 2004. Position Location and Navigation Symposium (IEEE Cat. No.04CH37556).

[27]  J.L. Crassidis,et al.  Sigma-point Kalman filtering for integrated GPS and inertial navigation , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[28]  D. Gingras,et al.  Comparison between the unscented Kalman filter and the extended Kalman filter for the position estimation module of an integrated navigation information system , 2004, IEEE Intelligent Vehicles Symposium, 2004.

[29]  Jiancheng Fang,et al.  An innovational transfer alignment method based on parameter identification UKF for airborne distributed POS , 2014 .

[30]  E. Kraft,et al.  A quaternion-based unscented Kalman filter for orientation tracking , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.

[31]  Malcolm D. Shuster.  Survey of attitude representations , 1993 .

[32]  Nicolas Petit,et al.  Design of a navigation filter by analysis of local observability , 2010, 49th IEEE Conference on Decision and Control (CDC).

[33]  Chan Gook Park,et al.  Lever Arm Compensation for GPS/INS/Odometer Integrated System , 2006 .

[34]  Carlos Silvestre,et al.  Tightly coupled ultrashort baseline and inertial navigation system for underwater vehicles: An experimental validation , 2013, J. Field Robotics.

[35]  Yanming Feng,et al.  Analysis of a robust Kalman filter in loosely coupled GPS/INS navigation system , 2016 .