This paper proposes a novel fast deterministic quaternion attitude determination method for accelerometer and magnetometer combination (AMC). After taking insight to the attitude determination theory, an important relationship between the sensor outputs and the magnetometer’s reference vector is successfully derived. Based on the relationship, the optimal quaternion associated with the attitude of a certain object is easily calculated. The main breakthrough of this paper is that it significantly simplifies the determination of the magnetometer’s reference vector which always needs systematic calibration or iterative estimation in existing methods. We name the proposed method the Fast Accelerometer-Magnetometer Fusion (FAMF). Our proposed method has the advantages of better computation accuracy and less time consumption. Several experiments are carried out to illustrate the attitude determination results. Besides, comparisons with existing representative methods are also presented in the experimental section of this paper, which verify the effectiveness of the proposed FAMF. Finally, we experimentally show that the FAMF’s roll and pitch angles are immune to magnetic distortion, which ensures the robustness under complex environments for micro air vehicles (MAV).
In diesem Beitrag wird eine neuartige, auf Quaternionen basierende Methode präsentiert, um die Orientierung einer Plattform im Raum aus Beschleunigungs- und Magnetfeldsensordaten (AMC) zu bestimmen. Nach einer Einführung in die Theorie der Lageschätzung wird eine wichtige Beziehung zwischen den Sensorausgangssignalen und dem Magnetometer-Referenzvektor abgeleitet. Darauf basierend wird die optimale Quaternion der Orientierung hergeleitet. Der Hauptaspekt dieses Betrags, die Entwicklung der Fast Accelerometer-Magnetometer Fusion (FAMF), besteht in der signifikanten Vereinfachung bei der Bestimmung des Magnetometer-Referenzvektors, welcher bei alternativen Schätzmethoden entweder iterativ bestimmt oder durch Kalibrierung festgelegt werden muss. Die vorgestellte Methode erlaubt, verglichen mit anderen Methoden, schnellere Berechnungen und ergibt eine kleinere Unsicherheit. Es werden mehrere Experimente dargestellt und analysiert, welche die Vorteile der vorgeschlagenen Methode illustrieren. Es wird weiters gezeigt, dass die nach FAMF bestimmten Roll- und Nick-Winkel unempfindlich gegenüber magnetischer Beeinflussung sind, was den Einsatz dieses robusten Verfahrens in magnetisch komplexer Umgebung erlaubt.
Funding source: National Natural Science Foundation of China
Award Identifier / Grant number: 41604025
Funding statement: This work is supported by the National Natural Science Foundation of China under grant No. 41604025, partially supported by Sichuan Province Science and Technology Project (No. 2018CC0018; 2018SZ0364).
About the authors
Jin Wu received the B.S. Degree from University of Electronic Science and Technology of China, Chengdu, China. His research interests include robot navigation, multi-sensor fusion, automatic control and mechatronics. He is a member of IEEE.
Chengxi Zhang received his B.S. and M.S. degrees at Harbin Institute of Technology, China, in 2012 and 2015, Ph.D. in at Shanghai Jiao Tong University, in 2019. Currently he is a post-doc researcher at Harbin Institute of Technology, Shenzhen campus, China. His research interests are spacecraft control, event-based control and their applications.
Zebo Zhou was born in November, 1982 in Yongchuan, Chongqing, China. He received the B.Sc. and M.Sc. degrees in School of Geodesy and Geomatics from Wuhan University, Wuhan, China, in 2004 and 2006, respectively, and the Ph.D. degree from the College of Surveying and Geoinformatics, Tongji University, Shanghai, China in 2009. He was a visiting fellow with the Surveying & Geospatial Engineering Group, within the School of Civil & Environmental Engineering, University of New South Wales, Australia in 2009 and 2015. He is currently an associate professor with the School of Aeronautics and Astronautics, University of Electronic Science and Technology of China, Chengdu, China. His research interests include GNSS navigation and positioning, GNSS/INS integrated navigation, multi-sensor fusion. Prof. Zhou has been in charge of projects of National Natural Science Foundation of China and has taken part in the National 863 High-tech Founding of China. He served as a Guest Editor of several special issues published on INTERNATIONAL JOURNAL OF DISTRIBUTED SENSOR NETWORKS and ASIAN JOURNAL OF CONTROL. He has been presenting related works on the annual conference of the institute of navigation (ION), the annual Chinese satellite navigation conference (CSNC) for several times and has received the best paper awards in these conferences.
1. Y. Shi, R. Li, and H. Xu, “Control Augmentation Design of UAVS Based on Deviation Modification of Aerodynamic Focus,” Journal of Industrial and Management Optimization, vol. 11, no. 1, pp. 231–240, 2015.10.3934/jimo.2015.11.231Search in Google Scholar
2. X. Yun, J. Calusdian, E. R. Bachmann, and R. B. McGhee, “Estimation of human foot motion during normal walking using inertial and magnetic sensor measurements,” IEEE Transactions on Instrumentation and Measurement, vol. 61, no. 7, pp. 2059–2072, 2012.10.1109/TIM.2011.2179830Search in Google Scholar
3. X. Yun and E. Bachmann, “Design, Implementation, and Experimental Results of a Quaternion-Based Kalman Filter for Human Body Motion Tracking,” Robotics, IEEE Transactions on, vol. 22, no. 6, pp. 1216–1227, 2006.10.1109/TRO.2006.886270Search in Google Scholar
5. Y. Wu, J. Wang, and D. Hu, “A New Technique for INS/GNSS Attitude and Parameter Estimation Using Online Optimization,” IEEE Transactions on Signal Processing, vol. 62, no. 10, pp. 2642–2655, 2014.10.1109/TSP.2014.2312317Search in Google Scholar
6. J. Wu, Z. Zhou, R. Li, L. Yang, and H. Fourati, “Attitude Determination Using a Single Sensor Observation: Analytic Quaternion Solutions and Property Discussion,” IET Science, Measurement & Technology, vol. 11, no. 3, pp. 731–739, 2017.10.1049/iet-smt.2016.0202Search in Google Scholar
7. Z. Zhou, J. Wu, Y. Li, C. Fu, and H. Fourati, “Critical Issues on Kalman Filter with Colored and Correlated System Noises,” Asian Journal of Control, 2017. [Online]. Available: http://arxiv.org/abs/1003.2005.10.1002/asjc.1545Search in Google Scholar
8. A. M. Sabatini, “Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing,” IEEE Transactions on Biomedical Engineering, vol. 53, no. 7, pp. 1346–1356, 2006.10.1109/TBME.2006.875664Search in Google Scholar PubMed
9. Z. Zhou, Y. Li, J. Liu, and G. Li, “Equality constrained robust measurement fusion for adaptive kalman-filter-based heterogeneous multi-sensor navigation,” IEEE Transactions on Aerospace and Electronic Systems, vol. 49, no. 4, pp. 2146–2157, 2013.10.1109/TAES.2013.6621807Search in Google Scholar
10. G. Ligorio, A. M. Sabatini, and S. Member, “A Novel Kalman Filter for Human Motion Tracking With an Inertial-Based Dynamic Inclinometer,” IEEE Transactions on Biomedical Engineering, vol. 62, no. 8, pp. 2033–2043, 2015.10.1109/TBME.2015.2411431Search in Google Scholar PubMed
11. W. Li and J. Wang, “Effective Adaptive Kalman Filter for MEMS-IMU/Magnetometers Integrated Attitude and Heading Reference Systems,” Journal of Navigation, vol. 66, no. 01, pp. 99–113, 2012.10.1017/S0373463312000331Search in Google Scholar
13. I. Y. Bar-Itzhack and R. R. Harman, “Optimized TRIAD Algorithm for Attitude Determination,” Journal of Guidance, Control, and Dynamics, vol. 20, no. 1, pp. 208–211, 1997.10.2514/6.1996-3616Search in Google Scholar
15. M. D. Shuster and S. D. Oh, “Three-axis attitude determination from vector observations,” Journal of Guidance, Control, and Dynamics, vol. 4, no. 1, pp. 70–77, 1981.10.2514/3.19717Search in Google Scholar
16. F. L. Markley, “Attitude determination using vector observations – A fast optimal matrix algorithm,” The Journal of the Astronautical Sciences, vol. 41, no. 2, pp. 261–280, 1993.Search in Google Scholar
18. D. Mortari, “ESOQ-2 single-point algorithm for fast optimal spacecraft attitude determination,” Advances in the Astronautical Sciences, PART 2, vol. 95, no. August, pp. 817–825, 1997.Search in Google Scholar
19. J. Wu, Z. Zhou, B. Gao, R. Li, Y. Cheng, and H. Fourati, “Fast Linear Quaternion Attitude Estimator Using Vector Observations,” IEEE Transactions on Automation Science and Engineering, vol. 15, no. 1, pp. 307–319, 2018.10.1109/TASE.2017.2699221Search in Google Scholar
20. J. Marins, X. Yun, E. Bachmann, R. McGhee, and M. Zyda, “An extended Kalman filter for quaternion-based orientation estimation using MARG sensors,” Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems, vol. 4, 2001.Search in Google Scholar
21. S. O. H. Madgwick, A. J. L. Harrison, and R. Vaidyanathan, “Estimation of IMU and MARG orientation using a gradient descent algorithm,” IEEE International Conference on Rehabilitation Robotics, 2011.10.1109/ICORR.2011.5975346Search in Google Scholar PubMed
22. Y. Tian, H. Wei, and J. Tan, “An adaptive-gain complementary filter for real-time human motion tracking with MARG sensors in free-living environments,” IEEE Transactions on Neural Systems and Rehabilitation Engineering, vol. 21, no. 2, pp. 254–264, 2013.10.1109/TNSRE.2012.2205706Search in Google Scholar PubMed
23. H. Fourati, N. Manamanni, L. Afilal, and Y. Handrich, “Complementary Observer for Body Segments Motion Capturing by Inertial and Magnetic Sensors,” IEEE/ASME Transactions on Mechatronics, vol. 19, no. 1, pp. 149–157, 2014.10.1109/TMECH.2012.2225151Search in Google Scholar
24. X. Yun, E. R. Bachmann, and R. B. McGhee, “A simplified quaternion-based algorithm for orientation estimation from earth gravity and magnetic field measurements,” IEEE Transactions on Instrumentation and Measurement, vol. 57, no. 3, pp. 638–650, 2008.10.1109/TIM.2007.911646Search in Google Scholar
26. P. B. Davenport, “A vector approach to the algebra of rotations with applications,” NASA Technical Note, 1968.Search in Google Scholar
27. J. E. Keat, “Analysis of Least-Squares Attitude Determination Routine DOAOP,” Computer Sciences Corporation, vol. 6034, 1977.Search in Google Scholar
28. F. L. Markley, “Fast Quaternion Attitude Estimation from Two Vector Measurements,” Journal of Guidance, Control, and Dynamics, vol. 25, no. 2, pp. 411–414, 2002.10.2514/2.4897Search in Google Scholar
29. A. Vydhyanathan, G. Bellusci, H. Luinge, and P. Slycke, “The next generation xsens motion trackers for industrial applications,” Xsens: Enschede, The Netherlands, 2015.Search in Google Scholar
30. L. Jie, Z. Xiaoming, L. Jun, and C. Guobin, “Calibration of triaxial MEMS vector field measurement system,” IET Science, Measurement & Technology, vol. 8, no. 6, pp. 601–609, 2014.10.1049/iet-smt.2013.0202Search in Google Scholar
31. T. Ozyagcilar, “Implementing a tilt-compensated ecompass using accelerometer and magnetometer sensors,” Freescale semiconductor, AN, vol. 4248, 2012.Search in Google Scholar
32. J. Wu, Z. Zhou, J. Chen, H. Fourati, and R. Li, “Fast Complementary Filter for Attitude Estimation Using Low-Cost MARG Sensors,” IEEE Sensors Journal, vol. 16, no. 18, pp. 6997–7007, 2016.10.1109/JSEN.2016.2589660Search in Google Scholar
33. R. Mahony, T. Hamel, and J. M. Pflimlin, “Nonlinear complementary filters on the special orthogonal group,” IEEE Transactions on Automatic Control, vol. 53, no. 5, pp. 1203–1218, 2008.10.1109/TAC.2008.923738Search in Google Scholar
34. S. O. H. Madgwick, A. J. L. Harrison, and R. Vaidyanathan, “Estimation of IMU and MARG orientation using a gradient descent algorithm,” IEEE International Conference on Rehabilitation Robotics, 2011.10.1109/ICORR.2011.5975346Search in Google Scholar PubMed
© 2020 Walter de Gruyter GmbH, Berlin/Boston