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
ISSN: 0148-7191, e-ISSN: 2688-3627
Published April 14, 2020 by SAE International in United States
This content contains downloadable datasetsAnnotation ability available
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.
CitationDudekula, 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
|[Unnamed Dataset 1]|
|[Unnamed Dataset 2]|
|[Unnamed Dataset 3]|
- 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, doi: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, doi: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, doi: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, doi: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, doi: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, doi: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, doi: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,” in Proceedings of the IEEE International Conference on Rehabilitation Robotics, Zurich, Switzerland, June 27- July 1, 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, doi: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, doi: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, doi: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, doi: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, doi: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, doi:10.3390/s18103251.
- Rajamani, R. , “Vehicle Dynamics and Control, Mechanical Engineering Series,” 2012, doi: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,” in 2012 15th International Conference on Information Fusion, Singapore, 2012, 787-793.
- Pettersson, M. , “Extended Kalman Filter for Robust UAV Attitude Estimation,” 2015.
- CH-Robotics UM7-IMU Manuals, “AN-1008-Sensors for Orientation Estimation,” Document rev. 1.0, Oct. 2012, 1-11, “AN-1005-Undestanding Euler Angles,” Document rev. 1.1, Mar. 2013, 1-12