An Improved Yaw Estimation Algorithm for Land Vehicles Using MARG Sensors

This paper presents a linear Kalman filter for yaw estimation of land vehicles using magnetic angular rate and gravity (MARG) sensors. A gyroscope measurement update depending on the vehicle status and constraining yaw estimation is introduced. To determine the vehicle status, the correlations between outputs from different sensors are analyzed based on the vehicle kinematic model and Coriolis theorem, and a vehicle status marker is constructed. In addition, a two-step measurement update method is designed. The method treats the magnetometer measurement update separately after the other updates and eliminates its impact on attitude estimation. The performances of the proposed algorithm are tested in experiments and the results show that: the introduced measurement update is an effective supplement to the magnetometer measurement update in magnetically disturbed environments; the two-step measurement update method makes attitude estimation immune to errors induced by magnetometer measurement update, and the proposed algorithm provides more reliable yaw estimation for land vehicles than the conventional algorithm.

[1]  F. Markley.  Attitude Error Representations for Kalman Filtering , 2003 .

[2]  Vicente Milanés Montero,et al.  Autonomous Pedestrian Collision Avoidance Using a Fuzzy Steering Controller , 2011, IEEE Transactions on Intelligent Transportation Systems.

[3]  Angelo M. Sabatini,et al.  Kalman-Filter-Based Orientation Determination Using Inertial/Magnetic Sensors: Observability Analysis and Performance Evaluation , 2011, Sensors.

[4]  Mohan M. Trivedi,et al.  Video-based lane estimation and tracking for driver assistance: survey, system, and evaluation , 2006, IEEE Transactions on Intelligent Transportation Systems.

[5]  Azim Eskandarian,et al.  Research advances in intelligent collision avoidance and adaptive cruise control , 2003, IEEE Trans. Intell. Transp. Syst..

[6]  Benedetto Allotta,et al.  An Attitude Estimation Algorithm for Mobile Robots Under Unknown Magnetic Disturbances , 2016, IEEE/ASME Transactions on Mechatronics.

[7]  Hee-Jun Kang,et al.  Quaternion-Based Indirect Kalman Filter Discarding Pitch and Roll Information Contained in Magnetic Sensors , 2012, IEEE Transactions on Instrumentation and Measurement.

[8]  Sebastian Madgwick,et al.  Estimation of IMU and MARG orientation using a gradient descent algorithm , 2011, 2011 IEEE International Conference on Rehabilitation Robotics.

[9]  Tomomichi Sugihara,et al.  A nonlinear complementary filter for attitude estimation with dynamics compensation of MARG sensor , 2016, 2016 IEEE International Conference on Advanced Intelligent Mechatronics (AIM).

[10]  Hamad Ahmed,et al.  Accurate Attitude Estimation of a Moving Land Vehicle Using Low-Cost MEMS IMU Sensors , 2017, IEEE Transactions on Intelligent Transportation Systems.

[11]  D. Chilton.  Inertial Navigation , 1959, Nature.

[12]  Marko Topič,et al.  Calibration and data fusion solution for the miniature attitude and heading reference system , 2007 .

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

[14]  Zhaofeng Li,et al.  Adaptive EKF Based on HMM Recognizer for Attitude Estimation Using MEMS MARG Sensors , 2018, IEEE Sensors Journal.

[15]  Carlos Silvestre,et al.  Geometric Approach to Strapdown Magnetometer Calibration in Sensor Frame , 2011, IEEE Transactions on Aerospace and Electronic Systems.

[16]  Young Soo Suh.  Orientation Estimation Using a Quaternion-Based Indirect Kalman Filter With Adaptive Estimation of External Acceleration , 2010, IEEE Transactions on Instrumentation and Measurement.

[17]  Hassen Fourati,et al.  Fast Complementary Filter for Attitude Estimation Using Low-Cost MARG Sensors , 2016, IEEE Sensors Journal.

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

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

[20]  Kyongsu Yi,et al.  An investigation into vehicle rollover prevention by coordinated control of active anti-roll bar and electronic stability program , 2012 .

[21]  Xiaoming Zhang,et al.  A New Quaternion-Based Kalman Filter for Real-Time Attitude Estimation Using the Two-Step Geometrically-Intuitive Correction Algorithm , 2017, Sensors.

[22]  Tae Suk Yoo,et al.  Gain-Scheduled Complementary Filter Design for a MEMS Based Attitude and Heading Reference System , 2011, Sensors.

[23]  Hideki Hashimoto,et al.  Development of advanced parking assistance system , 2003, IEEE Trans. Ind. Electron..

[24]  Robert E. Mahony,et al.  Nonlinear Complementary Filters on the Special Orthogonal Group , 2008, IEEE Transactions on Automatic Control.

[25]  G. Wahba.  A Least Squares Estimate of Satellite Attitude , 1965 .

[26]  Thomas B. Schön,et al.  Magnetometer Calibration Using Inertial Sensors , 2016, IEEE Sensors Journal.

[27]  Jizhong Xiao,et al.  A Linear Kalman Filter for MARG Orientation Estimation Using the Algebraic Quaternion Algorithm , 2016, IEEE Transactions on Instrumentation and Measurement.

[28]  Robert B. McGhee,et al.  A Simplified Quaternion-Based Algorithm for Orientation Estimation From Earth Gravity and Magnetic Field Measurements , 2008, IEEE Transactions on Instrumentation and Measurement.

[29]  Xiaoli Meng,et al.  Adaptive sensor data fusion in motion capture , 2010, 2010 13th International Conference on Information Fusion.

[30]  Xiaoli Meng,et al.  Quaternion-Based Kalman Filter With Vector Selection for Accurate Orientation Tracking , 2012, IEEE Transactions on Instrumentation and Measurement.