Performance Improvement of Inertial Navigation System by Using Magnetometer with Vehicle Dynamic Constraints

A navigation algorithm is proposed to increase the inertial navigation performance of a ground vehicle using magnetic measurements and dynamic constraints. The navigation solutions are estimated based on inertial measurements such as acceleration and angular velocity measurements. To improve the inertial navigation performance, a three-axis magnetometer is used to provide the heading angle, and nonholonomic constraints (NHCs) are introduced to increase the correlation between the velocity and the attitude equation. The NHCs provide a velocity feedback to the attitude, which makes the navigation solution more robust. Additionally, an acceleration-based roll and pitch estimation is applied to decrease the drift when the acceleration is within certain boundaries. The magnetometer and NHCs are combined with an extended Kalman filter. An experimental test was conducted to verify the proposed method, and a comprehensive analysis of the performance in terms of the position, velocity, and attitude showed that the navigation performance could be improved by using the magnetometer and NHCs. Moreover, the proposed method could improve the estimation performance for the position, velocity, and attitude without any additional hardware except an inertial sensor and magnetometer. Therefore, this method would be effective for ground vehicles, indoor navigation, mobile robots, vehicle navigation in urban canyons, or navigation in any global navigation satellite system-denied environment.

[1]  Xiaoming Hu,et al.  Drift-free attitude estimation for accelerated rigid bodies , 2004, Autom..

[2]  B.B. Mohr,et al.  Micro air vehicle navigation system , 2008, IEEE Aerospace and Electronic Systems Magazine.

[3]  M. J. Caruso,et al.  Applications of magnetic sensors for low cost compass systems , 2000, IEEE 2000. Position Location and Navigation Symposium (Cat. No.00CH37062).

[4]  Naser El-Sheimy,et al.  A combined algorithm of improving INS error modeling and sensor measurements for accurate INS/GPS navigation , 2006 .

[5]  T. Tsujimura,et al.  Electromagnetic system determining the position of tunnelling robots , 2000 .

[6]  Demoz Gebre-Egziabher,et al.  A Non-linear , Two-step Estimation Algorithm for Calibrating Solid-state Strapdown Magnetometers , 2001 .

[7]  Ling Yang,et al.  An enhanced MEMS-INS/GNSS integrated system with fault detection and exclusion capability for land vehicle navigation in urban areas , 2013, GPS Solutions.

[8]  James Cutler,et al.  Attitude-Independent Magnetometer Calibration with Time-Varying Bias , 2012 .

[9]  Jeongho Cho,et al.  INS/vSLAM system using distributed particle filter , 2010 .

[10]  Yvon Savaria,et al.  An integrated structure for Kalman-filter-based measurand reconstruction , 1994 .

[11]  D.A. Antonov,et al.  Experimental automobile integrated navigation module , 2008, IEEE Aerospace and Electronic Systems Magazine.

[12]  Halil Ersin Soken,et al.  In flight magnetometer calibration via unscented Kalman filter , 2011, Proceedings of 5th International Conference on Recent Advances in Space Technologies - RAST2011.

[13]  Eun-Hwan Shin.  A Quaternion-Based Unscented Kalman Filter for the Integration of GPS and MEMS INS , 2004 .

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

[15]  Young Soo Suh.  Attitude estimation using low cost accelerometer and gyroscope , 2003, 7th Korea-Russia International Symposium on Science and Technology, Proceedings KORUS 2003. (IEEE Cat. No.03EX737).

[16]  A. Soloviev,et al.  Tight coupling of GPS, laser scanner, and inertial measurements for navigation in urban environments , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

[17]  P. Groves.  Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems, Second Edition , 2013 .

[18]  Salah Sukkarieh,et al.  Bearing-Only SLAM for an Airborne Vehicle , 2005 .

[19]  Xiaoji Niu,et al.  Observability Analysis of Non-Holonomic Constraints for Land-Vehicle Navigation Systems , 2012 .

[20]  Demoz Gebre-Egziabher,et al.  Calibration of Strapdown Magnetometers in Magnetic Field Domain , 2006 .

[21]  Michael J. Caruso,et al.  Applications of Magnetoresistive Sensors in Navigation Systems , 1997 .

[22]  Andrey Soloviev,et al.  Integration of GPS and vision measurements for navigation in GPS challenged environments , 2010, IEEE/ION Position, Location and Navigation Symposium.

[23]  Eun-Hwan Shin,et al.  Accuracy Improvement of Low Cost INS/GPS for Land Applications , 2002 .

[24]  Branko Ristic,et al.  Beyond the Kalman Filter: Particle Filters for Tracking Applications , 2004 .

[25]  Strapdown inertial navigation system aiding with nonholonomic constraints using indirect Kalman filtering , .

[26]  Robert Grover Brown,et al.  Introduction to random signals and applied Kalman filtering : with MATLAB exercises and solutions , 1996 .

[27]  Sangkyung Sung,et al.  Integration of limited GNSS signals with monocular vision based navigation , 2012, 2012 12th International Conference on Control, Automation and Systems.

[28]  Malcolm D. Shuster,et al.  Attitude-Independent Magnetometer-Bias Determination: A Survey , 2002 .

[29]  P. Groves.  Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[30]  Sangkyung Sung,et al.  GNSS integration with vision-based navigation for low GNSS visibility conditions , 2013, GPS Solutions.

[31]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[32]  Elliott D. Kaplan.  Understanding GPS : principles and applications , 1996 .

[33]  Tim Bailey.  Constrained initialisation for bearing-only SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).