Autonomous In-motion Alignment for Land Vehicle Strapdown Inertial Navigation System without the Aid of External Sensors

This paper describes a fully autonomous real-time in-motion alignment algorithm for Strapdown Inertial Navigation Systems (SINS) in land vehicle applications. Once the initial position is available, the vehicle can start a mission immediately with accurate attitude, position and velocity information determined within ten minutes. This is achieved by two tightly coupled stages, that is, real-time Double-vector Attitude Determination Coarse Alignment (DADCA) and Backtracking Fine Alignment (BFA). In the DADCA process, the vehicle motion is omitted to roughly estimate the attitude at the very start of the alignment. Meanwhile, attitude quaternions and velocity increments are extracted and recorded. The BFA process utilises the stored data and exploits the Non-Holonomic Constraints (NHC) of a vehicle to obtain virtual velocity measurements. A linear SINS/NHC Kalman filter with mounting angles as extended states is constructed to improve the fine alignment accuracy. The method is verified by three vehicle tests, which shows that the accuracy of alignment azimuth is 0·0358° (Root Mean Square, RMS) and the positioning accuracy is about 15 m (RMS) at the end of the alignment.

[1]  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).

[2]  Yuanxin Wu,et al.  Velocity/Position Integration Formula (II): Application to Inertial Navigation Computation , 2012, ArXiv.

[3]  Yuanxin Wu,et al.  Velocity/Position Integration Formula Part I: Application to In-Flight Coarse Alignment , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[4]  Peter M. G. Silson,et al.  Coarse Alignment of a Ship's Strapdown Inertial Attitude Reference System Using Velocity Loci , 2011, IEEE Transactions on Instrumentation and Measurement.

[5]  Yeon Fuh Jiang.  Error analysis of analytic coarse alignment methods , 1998 .

[6]  Burak H. Kaygisiz,et al.  In-motion Alignment of a Low-cost GPS/INS under Large Heading Error , 2015 .

[7]  Lubin Chang,et al.  Initial Alignment for a Doppler Velocity Log-Aided Strapdown Inertial Navigation System With Limited Information , 2017, IEEE/ASME Transactions on Mechatronics.

[8]  Qian Xu,et al.  Adaptive filtering design for in-motion alignment of INS , 2014, The 26th Chinese Control and Decision Conference (2014 CCDC).

[9]  Yang Liu,et al.  Impact Assessment of GNSS Spoofing Attacks on INS/GNSS Integrated Navigation System , 2018, Sensors.

[10]  D. Hu,et al.  Optimization-based alignment for inertial navigation systems: Theory and algorithm , 2011 .

[11]  Hugh F. Durrant-Whyte,et al.  A new algorithm for the alignment of inertial measurement units without external observation for land vehicle applications , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[12]  James R. Wertz,et al.  Spacecraft attitude determination and control , 1978 .

[13]  Yuanxin Wu.  Versatile land navigation using inertial sensors and odometry: Self-calibration, in-motion alignment and positioning , 2014, 2014 DGON Inertial Sensors and Systems (ISS).

[14]  S. Fujioka,et al.  Nonlinear Filtering Methods for the INS/GPS In-Motion Alignment and Navigation , 2006 .

[15]  D. Simon.  Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches , 2006 .

[16]  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.

[17]  Kai-Wei Chiang,et al.  Performance analysis of an AKF based tightly-coupled INS/GNSS integrated scheme with NHC for land vehicular applications , 2013 .

[18]  Fangjun Qin,et al.  A Novel Autonomous Initial Alignment Method for Strapdown Inertial Navigation System , 2017, IEEE Transactions on Instrumentation and Measurement.

[19]  N. El-Sheimy,et al.  Coarse alignment for marine SINS using gravity in the inertial frame as a reference , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

[20]  Yuanxin Wu,et al.  Self-calibration for Land Navigation Using Inertial Sensors and Odometer: Observability Analysis , 2009 .

[21]  Ashok Joshi,et al.  In-motion Alignment of Inertial Navigation System with Doppler Speed Measurements , 2015 .

[22]  Jie Hu,et al.  A new in-motion initial alignment for land-vehicle SINS/OD integrated system , 2014, 2014 IEEE/ION Position, Location and Navigation Symposium - PLANS 2014.

[23]  Hugh F. Durrant-Whyte,et al.  The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications , 2001, IEEE Trans. Robotics Autom..

[24]  John Weston,et al.  Strapdown Inertial Navigation Technology, Second Edition , 2005 .

[25]  Wanli Li,et al.  A novel backtracking navigation scheme for Autonomous Underwater Vehicles , 2014 .

[26]  Wanli Li,et al.  Optimization-based INS in-motion alignment approach for underwater vehicles , 2013 .

[27]  Yuanxin Wu,et al.  Velocity/Position Integration Formula Part II: Application to Strapdown Inertial Navigation Computation , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[28]  Sagi Filin,et al.  Analytical Observability Analysis of INS with Vehicle Constraints , 2015 .

[29]  Wanli Li,et al.  A Fast SINS Initial Alignment Scheme for Underwater Vehicle Applications , 2012, Journal of Navigation.

[30]  Yuanxin Wu,et al.  Underwater Doppler Navigation with Self-calibration , 2015, ArXiv.

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

[32]  Fu Mengyin,et al.  Automatic calibration and in-motion alignment of an odometer-aided INS , 2012, Proceedings of the 31st Chinese Control Conference.

[33]  Wang Hai-ming.  Inertial navigation algorithm aided by motion constraints of vehicle , 2012 .

[34]  Fangjun Qin,et al.  In-Motion Initial Alignment for Odometer-Aided Strapdown Inertial Navigation System Based on Attitude Estimation , 2017, IEEE Sensors Journal.

[35]  Sagi Filin,et al.  Analytical Observability Analysis of INS with Vehicle Constraints: Analytical Observ. of INS with Vehicle Constraints , 2014 .