DOI QR코드

DOI QR Code

Constraint-Combined Adaptive Complementary Filter for Accurate Yaw Estimation in Magnetically Disturbed Environments

  • Received : 2019.03.09
  • Accepted : 2019.03.28
  • Published : 2019.03.31

Abstract

One of the major issues in inertial and magnetic measurement unit (IMMU)-based 3D orientation estimation is compensation for magnetic disturbances in magnetometer signals, as the magnetic disturbance is a major cause of inaccurate yaw estimation. In the proposed approach, a kinematic constraint is used to provide a measurement equation in addition to the accelerometer and magnetometer signals to mitigate the disturbance effect on the orientation estimation. Although a Kalman filter (KF) is the most popular framework for IMMU-based orientation estimation, a complementary filter (CF) has its own advantages over KF in terms of mathematical simplicity and ease of implementation. Accordingly, this paper introduces a quaternion-based CF with a constraint-combined correction equation. Furthermore, the weight of the constraint relative to the magnetometer signal is adjusted to adapt to magnetic environments to optimally deal with the magnetic disturbance. In the results of our validation experiments, the average and maximum of yaw errors were $1.17^{\circ}$ and $1.65^{\circ}$ from the proposed CF, respectively, and $8.88^{\circ}$ and $14.73^{\circ}$ from the conventional CF, respectively, showing the superiority of the proposed approach.

Keywords

HSSHBT_2019_v28n2_81_f0001.png 이미지

Fig. 1. Experimental setup.

HSSHBT_2019_v28n2_81_f0002.png 이미지

Fig. 2. Experimental result of Test 2: (a) magnitude of the applied magnetic disturbance and (b) yaw estimation errors with respect to the reference.

HSSHBT_2019_v28n2_81_f0003.png 이미지

Fig. 3. Experimental result of Test 3: (a) magnitude of the applied magnetic disturbance, (b) the weight of constraint, and (c)~(e) yaw, pitch and roll estimation errors with respect to the reference, respectively.

Table 1. Experimental conditions of each test.

HSSHBT_2019_v28n2_81_t0001.png 이미지

Table 2. Experimental results (unit: degree).

HSSHBT_2019_v28n2_81_t0002.png 이미지

References

  1. A. Filippeschi, N. Schmitz, M. Miezal, G. Bleser, E. Ruffaldi, and D. Stricker, "Survey of motion tracking methods based on inertial sensors: A focus on upper limb human motion", Sensors, Vol. 17, No. 6, p. 1257, 2017. https://doi.org/10.3390/s17061257
  2. Y. J. Hwang and S. B. Choi, "Vehicle orientation estimation by using magnetometer and inertial sensors", Trans. KSAE, Vol. 24, No. 4, pp. 408-415, 2016. https://doi.org/10.7467/KSAE.2016.24.4.408
  3. J. Chardonnens, J. Favre, F. Cuendet, G. Gremion, and K. Aminian, "A system to measure the kinematics during the entire ski jump sequence using inertial sensors", J. Biomech, Vol. 46, No. 1, pp. 56-62, 2013. https://doi.org/10.1016/j.jbiomech.2012.10.005
  4. S. Han and J. Wang, "A novel method to integrate IMU and magnetometers in attitude and heading reference systems", J. Navig., Vol. 64, No. 4, pp. 727-738, 2011. https://doi.org/10.1017/S0373463311000233
  5. D. Gebre-Egziabher, G. H. Elkaim, J. D. Powell, and B. W. Parkinson, "A gyro-free quaternion-based attitude determination system suitable for implementation using low cost sensors", Proc. of IEEE Posit. Locat. Navig. Symp., pp. 185-192, San Diego, CA, USA, 2000.
  6. P. H. Veltink, H. J. Bussmann, W. de Vries, W. J. Martens, and R. C. Van Lummel, "Detection of static and dynamic activities using uniaxial accelerometers", IEEE. Trans. Rehabil. Eng., Vol. 4, No. 4, pp. 375-385, 1996. https://doi.org/10.1109/86.547939
  7. G. Ligorio and A. M. Sabatini, "Dealing with magnetic disturbances in human motion capture: A survey of technique", Micromachines, Vol. 7, No. 3, p. 43, 2016. https://doi.org/10.3390/mi7030043
  8. C. Yi, J. Ma, H. Guo, J. Han, H. Gao, F. Jiang, and C. Yang, "Estimating three-dimensional body orientation based on an improved complementary filter for human motion tracking", Sensors, Vol. 18, No. 11, p. 3765, 2018. https://doi.org/10.3390/s18113765
  9. Y. S. Suh, Y. S. Ro, and H. J. 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, 2012. https://doi.org/10.1109/TIM.2011.2181910
  10. E. R. Bachmann, I. Duman, U. Y. Usta, R. B. McGhee, X. P. Yun, and M. J. Zyda, "Orientation tracking for humans and robots using inertial sensors", Proc. Int. Symp. Comput. Intell. Robot. Autom., pp. 187-194, Monterey, CA., USA., 1999.
  11. S. O. H. Madgwick, A. J. L. Harrison, and R. Vaidyanathan, "Estimation of IMU and MARG orientation using a gradient descent algorithm", Proc. of IEEE Int. Conf. Rehabil. Robot., Zurich, Switzerland, 2011.
  12. J. K. Lee and E. J. Park, "A fast quaternion-based orientation optimizer via virtual rotation for human motion tracking", IEEE Trans. Biomed. Eng., Vol. 56, No. 8, pp. 1574-1582, 2009. https://doi.org/10.1109/TBME.2008.2001285
  13. G. Ligorio and A. M. Sabatini, "A linear Kalman filtering-based approach for 3D orientation estimation from magnetic/inertial sensors", Proc. of IEEE Int. Conf. Multisen. Fusion Integr. Intell. Syst., pp. 77-82, San Diego, CA, USA, 2015.
  14. J. K. Lee, "A parallel Kalman filter for estimation of magnetic disturbance and orientation", Trans. Korean Soc. Mech. Eng. A, Vol. 40, No. 7, pp. 659-666, 2016. https://doi.org/10.3795/KSME-A.2016.40.7.659
  15. M. J. Choi and J. K. Lee, "An order-switching magnetic disturbance compensation mechanism for accurate azimuth estimation", J. Inst. Contr. Robot. Syst., Vol. 23, No. 7, pp. 552-558, 2017. https://doi.org/10.5302/J.ICROS.2017.17.0047
  16. D. Laidig, T. Schauer, and T. Seel, "Exploiting kinematic constraints to compensate magnetic disturbances when calculating joint angles of approximate hinge joints from orientation estimates of inertial sensors", Proc. of IEEE Int. Conf. Rehabil. Robot., pp. 971-976, London, UK, 2017.
  17. V. Bonnet, V. Joukov, D. Kulic, P. Fraisse, N. Ramdani, and G. Venture, "Monitoring of hip and knee joint angles using a single inertial measurement unit during lower limb rehabilitation", IEEE Sens. J., Vol. 16, No. 6, pp. 1557-1564, 2016. https://doi.org/10.1109/JSEN.2015.2503765
  18. B. Fasel, J. Sporri, P. Schutz, S. Lorenzetti, and K. Aminian, "Validation of functional calibration and strap-down joint drift correction for computing 3D joint angles of knee, hip, and trunk in alpine skiing", PloS ONE, Vol. 12, No. 7, p. e0181446, 2017. https://doi.org/10.1371/journal.pone.0181446
  19. M. J. Choi and J. K. Lee, "Inertial sensor-based attitude estimation combining a kinematic constraint for elimination of acceleration-induced inaccuracy", Trans. Korean Soc. Mech. Eng. A, Vol. 42, No. 3, pp. 263-269, 2018. https://doi.org/10.3795/KSME-A.2018.42.3.263
  20. T. Seel, T. Schauer, and J. Raisch, "Joint axis and position estimation from inertial measurement data by exploiting kinematic constraints", Proc. of IEEE Int. Conf. on Control Appl., pp. 45-49, Dubrovnik, Croatia, 2012.
  21. N. Hansen, "The CMA Evolution Strategy: A Comparing Review", in Towards a New Evolutionary Computation, J. A. Lozano, P. Larranaga, I. Inza, E. Bengoetxea, Eds., Springer, Berlin, pp. 75-102, 2006.