DOI QR코드

DOI QR Code

A Sequential Orientation Kalman Filter for AHRS Limiting Effects of Magnetic Disturbance to Heading Estimation

  • Lee, Jung Keun (Institute of Machine Convergence Technology, Hankyong National University) ;
  • Choi, Mi Jin (Dept. of Mechanical Engineering, Hankyong National University)
  • 투고 : 2016.12.05
  • 심사 : 2017.04.14
  • 발행 : 2017.07.01

초록

This paper deals with three dimensional orientation estimation algorithm for an attitude and heading reference system (AHRS) based on nine-axis inertial/magnetic sensor signals. In terms of the orientation estimation based on the use of a Kalman filter (KF), the quaternion is arguably the most popular orientation representation. However, one critical drawback in the quaternion representation is that undesirable magnetic disturbances affect not only yaw estimation but also roll and pitch estimations. In this paper, a sequential direction cosine matrix-based orientation KF for AHRS has been presented. The proposed algorithm uses two linear KFs, consisting of an attitude KF followed by a heading KF. In the latter, the direction of the local magnetic field vector is projected onto the heading axis of the inertial frame by considering the dip angle, which can be determined after the attitude KF. Owing to the sequential KF structure, the effects of even extreme magnetic disturbances are limited to the roll and pitch estimations, without any additional decoupling process. This overcomes an inherent issue in quaternion-based estimation algorithms. Validation test results show that the proposed method outperforms other comparison methods in terms of the yaw estimation accuracy during perturbations and in terms of the recovery speed.

키워드

참고문헌

  1. Jung Keun Lee, Stephen N. Robinovitch and Edward J. Park, "Inertial sensing-based pre-impact detection of falls involving near-fall scenarios," IEEE Trans. Neural Syst. Rehab. Eng., vol. 23, pp. 258-266, 2015. https://doi.org/10.1109/TNSRE.2014.2357806
  2. Ja-Woong Yoon, Yeon-Sik Noh, Yi-Suk Kwon, Won-Ki Kim and Hyung-Ro Yoon, "Improvement of dynamic respiration monitoring through sensor fusion of accelerometer and gyro-sensor," J. Elect. Eng. Technol., vol. 9, no. 1, pp. 334-343, Jan. 2014. https://doi.org/10.5370/JEET.2014.9.1.334
  3. Duy Duong Pham, Quoc Khanh Dang and Young Soo Suh, "Golf green slope estimation using a cross laser structured light system and an accelerometer," J. Elect. Eng. Technol., vol. 11, no. 2, pp. 508-518, Mar. 2016. https://doi.org/10.5370/JEET.2016.11.2.508
  4. Jung Keun Lee and Edward J. Park, "A fast quaternion-based orientation optimizer via virtual rotation for human motion tracking," IEEE Tran. Biomed. Eng., vol. 56, no. 5, pp. 1574-1582, May 2009. https://doi.org/10.1109/TBME.2008.2001285
  5. Jung Keun Lee and Edward J. Park, "Minimum-order Kalman filter with vector selector for accurate estimation of human body orientation," IEEE Trans. Robot., vol. 25, no. 5, pp. 1196-1201, 2009. https://doi.org/10.1109/TRO.2009.2017146
  6. Eric R. Bachmann, Xiaoping Yun and Anne Brumfield, "Limitations of attitude estimation algorithms for inertial/magnetic sensor modules," IEEE. Robot. Autom., vol. 14, pp.76-87, 2007.
  7. W. De Vries, H. Veeger, C. Baten and F. van der Helm, "Magnetic distortion in motion labs, implications for validating inertial magnetic sensors," Gait Posture., vol. 29, pp. 535-541, 2009. https://doi.org/10.1016/j.gaitpost.2008.12.004
  8. Nagesh Yadav and Chris Bleakley, "Accurate orientation estimation using AHRS under conditions of magnetic distortion," Sensors, vol. 14, pp. 20008-20024, 2014. https://doi.org/10.3390/s141120008
  9. Sebastian O. H. Madgwick, Andrew Harrison and Ravi Vaidyanathan, "Estimation of IMU and MARG orientation using a gradient descent algorithm," in Proc. of the 2011 IEEE Int'l Conf. on Rehab. Robotics (ICORR), Zurich, Switzerland, July 2011.
  10. Jung Keun Lee, Edward J. Park and Stephen N. Robinovitch, "Estimation of attitude and external acceleration using inertial sensor measurement during various dynamic conditions," IEEE Trans. Instrum. Meas., vol. 61, no. 8, pp. 2262-2273, Aug. 2012. https://doi.org/10.1109/TIM.2012.2187245
  11. Grace Wahba, "Problem 65-1: A least squares estimate of satellite attitude," SIAM Rev., vol. 7, no. 3, p.409, Jul. 1965.
  12. Xiaoping Yun, Eric R. Bachmann and Robert B. McGhee, "A simplified quaternion-based algorithm for orientation estimation from Earth gravity and magnetic field measurements," IEEE Trans. Instrum. Meas., vol. 57, no. 3, pp. 638-650, Mar. 2008. https://doi.org/10.1109/TIM.2007.911646
  13. Young Soo Suh, "Orientation estimation using a quaternion-based indirect Kalman filter with adaptive estimation of external acceleration." IEEE Trans. Instrum. Meas., vol. 59, no. 12, pp. 3296-3305, Dec. 2010. https://doi.org/10.1109/TIM.2010.2047157
  14. Young Soo Suh, Young Shick Ro and Hee Jun Kang, "Quaternion-based indirect Kalman filter discarding pitch and roll information contained in magnetic sensors," IEEE Trans. Instrum. Meas., vol. 61, no. 6, pp. 1786-1792, Jun. 2012. https://doi.org/10.1109/TIM.2011.2181910
  15. Nguyen Ho Quoc Phuong, Hee-Jun Kang, Young-Soo Suh and Young-Sik Ro, "A DCM based orientation estimation algorithm with an inertial measurement unit and a magnetic compass," J. Univers. Comput. Sci., vol. 15, no. 4, pp. 859-876, 2009.
  16. Henk J. Luinge and Peter H. Veltink, "Measuring orientation of human body segments using miniature gyroscopes and accelerometers," Med. Biol. Eng. Comput., vol. 43, no. 2, pp. 273-282, Mar. 2005. https://doi.org/10.1007/BF02345966
  17. Xsens MTw user's manual, available online: https://www.xsens.com.
  18. Gabriele Ligorio and Angelo Maria Sabatini, "Dealing with magnetic disturbances in human motion capture: a survey of techniques," Micromachines, vol. 7, no. 43, Mar. 2016.