This content is not included in
your SAE MOBILUS subscription, or you are not logged in.
Alleviating the Magnetic Effects on Magnetometers Using Vehicle Kinematics for Yaw Estimation for Autonomous Ground Vehicles
Technical Paper
2020-01-1025
ISSN: 0148-7191, e-ISSN: 2688-3627
This content contains downloadable datasets
Annotation ability available
Sector:
Language:
English
Abstract
Autonomous vehicle operation is dependent upon accurate position estimation and thus a major concern of implementing the autonomous navigation is obtaining robust and accurate data from sensors. This is especially true, in case of Inertial Measurement Unit (IMU) sensor data. The IMU consists of a 3-axis gyro, 3-axis accelerometer, and 3-axis magnetometer. The IMU provides vehicle orientation in 3D space in terms of yaw, roll and pitch. Out of which, yaw is a major parameter to control the ground vehicle’s lateral position during navigation. The accelerometer is responsible for attitude (roll-pitch) estimates and magnetometer is responsible for yaw estimates. However, the magnetometer is prone to environmental magnetic disturbances which induce errors in the measurement. The present work focuses on alleviating magnetic disturbances for ground vehicles by fusing the vehicle kinematics information with IMU senor in an Extended Kalman filter (EKF) with the vehicle orientation represented using Quaternions. In addition, the error in rate measurements from gyro sensor gets accumulated as the time progress which results in drift in rate measurements and thus affecting the vehicle orientation estimation. To resolve and account for the gyro drift, the EKF algorithm includes gyro bias terms in state vector, which augments the state vector with 4 Quaternions and 3 gyro bias vectors. The proposed modified EKF strategy has been experimentally tested and validated on 1/5th scale buggy type truck. The developed EKF, analysis and results are present which shows that, while the vehicle is affected by up to 1 ± 0.8 Norm of magnetic field and based on the curvature of the road it can reduce the RMS errors in yaw estimations from 3.4 to 0.5° in straight path and from 6.0 to 1.9° during tuning paths. Due to high accuracy in speed sensor and steering angle measurements, this fusion algorithm is robust and can make yaw estimations within ±1.5° heading error for about 30-meter distance.
Recommended Content
Authors
Topic
Citation
Dudekula, A. and Naber, J., "Alleviating the Magnetic Effects on Magnetometers Using Vehicle Kinematics for Yaw Estimation for Autonomous Ground Vehicles," SAE Technical Paper 2020-01-1025, 2020, https://doi.org/10.4271/2020-01-1025.Data Sets - Support Documents
| Title | Description | Download |
|---|---|---|
| Unnamed Dataset 1 | ||
| Unnamed Dataset 2 | ||
| Unnamed Dataset 3 |
Also In
References
- Vahidi , A. and Eskandarian , A. Research Advances in Intelligent Collision Avoidance and Adaptive Cruise Control IEEE Transactions on Intelligent Transportation Systems 4 3 143 153 Sept. 2003 10.1109/TITS.2003.821292
- Fernandez Llorca , D. et al. Autonomous Pedestrian Collision Avoidance Using a Fuzzy Steering Controller IEEE Transactions on Intelligent Transportation Systems 12 2 390 401 June 2011 10.1109/TITS.2010.2091272
- McCall , J.C. and Trivedi , M.M. Video-Based Lane Estimation and Tracking for Driver Assistance: Survey, System, and Evaluation IEEE Transactions on Intelligent Transportation Systems 7 1 20 37 Mar. 2006 10.1109/TITS.2006.869595
- Yim , S. , Jeon , K. , and Yi , K. An Investigation into Vehicle Rollover Prevention by Coordinated Control of Active Anti-Roll Bar and Electronic Stability Program Int. J. Control Autom. Syst. 10 275 287 2012
- Zhang , Z. , Meng , X. , and Wu , J. Quaternion-Based Kalman Filter with Vector Selection for Accurate Orientation Tracking IEEE Transactions on Instrumentation and Measurement 61 10 2817 2824 Oct. 2012 10.1109/TIM.2012.2196397
- Wahba , G. A Least Squares Estimate of Satellite Attitude SIAM Rev. 7 409 1965
- Valenti , R.G. , Dryanovski , I. , and Xiao , J. A Linear Kalman Filter for MARG Orientation Estimation Using the Algebraic Quaternion Algorithm IEEE Transactions on Instrumentation and Measurement 65 2 467 481 Feb. 2016 10.1109/TIM.2015.2498998
- Yun , X. , Bachmann , E.R. , and McGhee , R.B. A Simplified Quaternion-Based Algorithm for Orientation Estimation from Earth Gravity and Magnetic Field Measurements IEEE Transactions on Instrumentation and Measurement 57 3 638 650 Mar. 2008 10.1109/TIM.2007.911646
- Mahony , R. , Hamel , T. , and Pflimlin , J. Nonlinear Complementary Filters on the Special Orthogonal Group IEEE Transactions on Automatic Control 53 5 1203 1218 June 2008 10.1109/TAC.2008.923738
- Madgwick , S.O.H. , Harrison , A.J.L. , and Vaidyanathan , R. Estimation of IMU and MARG Orientation Using a Gradient Descent Algorithm Proceedings of the IEEE International Conference on Rehabilitation Robotics Zurich, Switzerland 2011 1 7
- Markley , F.L. Attitude Error Representations for Kalman Filtering J. Guid. Control Dynam. 26 311 317 2003
- Crassidis , J. and Markley , F.L. Unscented Filtering for Spacecraft Attitude Estimation J. Guid. Control Dyn. 26 536 542 2003
- Choukroun , D. , Bar-Itzhack , I.Y. , and Oshman , Y. Novel Quaternion Kalman Filter IEEE Transactions on Aerospace and Electronic Systems 42 1 174 190 Jan. 2006 10.1109/TAES.2006.1603413
- Costanzi , R. , Fanelli , F. , Monni , N. , Ridolfi , A. , and Allotta , B. An Attitude Estimation Algorithm for Mobile Robots under Unknown Magnetic Disturbances IEEE/ASME Transactions on Mechatronics 21 4 1900 1911 Aug. 2016 10.1109/TMECH.2016.2559941
- Tong , X. et al. Adaptive EKF Based on HMM Recognizer for Attitude Estimation Using MEMS MARG Sensors IEEE Sensors Journal 18 8 3299 3310 Apr. 15, 2018 10.1109/JSEN.2017.2787578
- Feng , K. , Li , J. , Zhang , X. , Shen , C. et al. A New Quaternion-Based Kalman Filter for Real-Time Attitude Estimation Using the Two-Step Geometrically-Intuitive Correction Algorithm Sensors 17 2146 2017
- Suh , Y.S. Orientation Estimation Using a Quaternion-Based Indirect Kalman Filter with Adaptive Estimation of External Acceleration IEEE Transactions on Instrumentation and Measurement 59 12 3296 3305 Dec. 2010 10.1109/TIM.2010.2047157
- Suh , Y.S. , Ro , Y.S. , and Kang , H.J. Quaternion-Based Indirect Kalman Filter Discarding Pitch and Roll Information Contained in Magnetic Sensors IEEE Transactions on Instrumentation and Measurement 61 6 1786 1792 June 2012 10.1109/TIM.2011.2181910
- Shi , G. , Li , X. , and Jiang , Z. An Improved Yaw Estimation Algorithm for Land Vehicles Using MARG Sensors Sensors (Basel) 18 10 3251 2018 10.3390/s18103251
- Rajamani , R. 2012 10.1007/978-1-4614-1433-9_2
- Kok , M. , Hol , J.D. , Schön , T.B. , Gustafsson , F. et al. Calibration of a Magnetometer in Combination with Inertial Sensors 2012 15th International Conference on Information Fusion Singapore 2012 787 793
- Pettersson , M. 2015
- 2013