Skip to main content
Log in

Heading angle estimation using rotating magnetometer for mobile robots under environmental magnetic disturbances

  • Original Research Paper
  • Published:
Intelligent Service Robotics Aims and scope Submit manuscript

Abstract

The heading angle plays a vital role in the localization and mapping of mobile robots. It is generally obtained by fusing measurements from gyroscope and magnetometer. However, ferromagnetic objects in real-world environments will disturb the magnetic field and will, therefore, cause significant errors in the estimated heading angles. This work proposes a novel method that employs a rotating magnetometer to detect ambient spatial magnetic disturbances and corrects the heading angle. The algorithm is based on the extended Kalman filter (EKF). Firstly, a criterion named spatial disturbance index is defined to characterize the disturbance quantitatively. And then the magnetometer measurement error covariance of the EKF is tuned adaptively according to the proposed criterion, so that a relatively reliable heading angle can be obtained even under strong spatial dynamic magnetic disturbances. In addition, the estimated heading angle can quickly restore to the correct value when the spatial disturbances disappear. The proposed algorithm has the benefit of adjusting the fusing degree of gyroscope and magnetometer adaptively to reject spatial disturbances and avoid the adverse impact of inherent gyroscope drift. The algorithm is evaluated under static and dynamic conditions in real-world indoor/outdoor environments. The results show that our algorithm outperforms the conventional EKF with fixed measurement error covariance and also the algorithm using only gyroscope.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6
Fig. 7
Fig. 8
Fig. 9
Fig. 10
Fig. 11
Fig. 12
Fig. 13
Fig. 14

Similar content being viewed by others

References

  1. Sabattini L et al (2013) Technological roadmap to boost the introduction of AGVs in industrial applications. In: 2013 IEEE 9th international conference on intelligent computer communication and processing (ICCP), Cluj-Napoca, pp 203–208

  2. Vasiljevic G et al (2016) High-accuracy vehicle localization for autonomous warehousing. Robot Comput Integr Manuf 42:1–16

    Article  Google Scholar 

  3. Röwekämper J, Sprunk C, Tipaldi GD, Stachniss C, Pfaff P, Burgard W (2012) On the position accuracy of mobile robot localization based on particle filters combined with scan matching. In: 2012 IEEE/RSJ international conference on intelligent robots and systems, Vilamoura, pp 3158–3164

  4. Hahnel D, Burgard W, Fox D, Thrun S (2003) An efficient fastSLAM algorithm for generating maps of large-scale cyclic environments from raw laser range measurements. In: Proceedings 2003 IEEE/RSJ international conference on intelligent robots and systems (IROS 2003) (Cat. No.03CH37453), Las Vegas, NV, USA, vol 1, pp 206–211

  5. Hess W, Kohler D, Rapp H, Andor D (2016) Real-time loop closure in 2D LIDAR SLAM. In: 2016 IEEE international conference on robotics and automation (ICRA), Stockholm, pp 1271–1278

  6. Grisetti G, Stachniss C, Burgard W (2007) Improved techniques for grid mapping with Rao-Blackwellized particle filters. IEEE Trans Robot 23(1):34–46

    Article  Google Scholar 

  7. Bar-Itzhack IY, Montgomery PY, Garrick JC (1998) Algorithms for attitude determination using the global positioning system. J Guid Control Dyn 21(6):846–852

    Article  Google Scholar 

  8. Kingston D, Beard R (2004) Real-time attitude and position estimation for small UAVs using low-cost sensors. In: AIAA 3rd “unmanned unlimited” technical conference, workshop and exhibit

  9. Caruso MJ (2000) Applications of magnetic sensors for low cost compass systems. In: IEEE 2000. Position location and navigation symposium (Cat. No.00CH37062), San Diego, CA, USA, pp 177–184

  10. Wu Z, Sun Z, Zhang W, Chen Q (2016) A novel approach for attitude estimation based on MEMS inertial sensors using nonlinear complementary filters. IEEE Sens J 16(10):3856–3864

    Article  Google Scholar 

  11. Vallivaara I, Haverinen J, Kemppainen A, Röning J (2010) Simultaneous localization and mapping using ambient magnetic field. In: 2010 IEEE conference on multisensor fusion and integration, Salt Lake City, UT, pp 14–19

  12. Costanzi R, Fanelli F, Monni N, Ridolfi A, Allotta B (2016) An attitude estimation algorithm for mobile robots under unknown magnetic disturbances. IEEE/ASME Trans Mechatron 21(4):1900–1911

    Article  Google Scholar 

  13. Vasconcelos JF, Elkaim G, Silvestre C, Oliveira P, Cardeira B (2011) Geometric approach to strapdown magnetometer calibration in sensor frame. IEEE Trans Aerosp Electron Syst 47(2):1293–1306

    Article  Google Scholar 

  14. Gebre-Egziabher D, Elkaim GH, Powell JD, Parkinson BW (2001) A non-linear, two-step estimation algorithm for calibrating solid-state strapdown magnetometers. In: Proceedings of international conference on integrated navigation systems, St. Petersburg, Russia, pp 290–297

  15. Sabet MT, Mohammadi Daniali HR, Fathi AR, Alizadeh E (2017) Experimental analysis of a low-cost dead reckoning navigation system for a land vehicle using a robust AHRS. Robot Auton Syst 95:37–51

    Article  Google Scholar 

  16. Roetenberg D, Luinge HJ, Baten CTM, Veltink PH (2005) Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation. IEEE Trans Neural Syst Rehabil Eng 13(3):395–405

    Article  Google Scholar 

  17. Odry Á, Fullér R, Rudas IJ et al (2018) Kalman filter for mobile-robot attitude estimation: novel optimized and adaptive solutions. Mech Syst Signal Process 110:569–589

    Article  Google Scholar 

  18. Marins JL, Yun X, Bachmann ER, McGhee RB, Zyda MJ (2001) An extended EKF for quaternion-based orientation estimation using MARG sensors. In: Proceedings 2001 IEEE/RSJ international conference on intelligent robots and systems. Expanding the Societal Role of Robotics in the Next Millennium (Cat. No.01CH37180), Maui, HI, USA, vol 4, pp 2003–2011

  19. Sabatelli S, Galgani M, Fanucci L, Rocchi A (2013) A double-stage EKF for orientation tracking with an integrated processor in 9-D imu. IEEE Trans Instrum Meas 62(3):590–598

    Article  Google Scholar 

  20. Qiu ZB, Qian HM (2018) Adaptive genetic particle filter and its application to attitude estimation system. Digit Signal Proc 81:163–172

    Article  Google Scholar 

  21. Yadav N, Bleakley C (2014) Accurate orientation estimation using AHRS under conditions of magnetic distortion. Sensors (Basel, Switzerland) 14:20008–20024

    Article  Google Scholar 

  22. Koo W, Chun S, Sung S, Lee YJ, Kang T (2008) In-flight heading estimation of strapdown magnetometers using particle filters. In: 2008 IEEE national aerospace and electronics conference, Dayton, OH, pp 379–384

  23. Mahony RE, Hamel T, Pflimlin JM (2008) Nonlinear complementary filters on the special orthogonal group. IEEE Trans Autom Control 53(5):1203–1218

    Article  MathSciNet  Google Scholar 

  24. Saealal MS, Derawi D, Salim ND, Tumari MZM (2017) Real-time nonlinear complementary filter on SO(3) for attitude estimation of small-scale aerial robot. In: 2017 international conference on vision, image and signal processing (ICVISP), Osaka, pp 109–113

  25. Euston M, Coote P, Mahony R, Kim J, Hamel T (2008) A complementary filter for attitude estimation of a fixed-wing UAV. In: 2008 IEEE/RSJ international conference on intelligent robots and systems, Nice, pp 340–345

  26. Widodo RB, Edayoshi H, Wada C (2014) Complementary filter for orientation estimation: adaptive gain based on dynamic acceleration and its change. In: 2014 joint 7th international conference on soft computing and intelligent systems (SCIS) and 15th international symposium on advanced intelligent systems (ISIS), Kitakyushu, pp 906–909

  27. Bayat M, Atashgah MAA (2017) An augmented strapdown inertial navigation system using Jerk and Jounce of motion for a flying robot. J Navig 70:907

    Article  Google Scholar 

  28. Lee J, Lim J, Lee J (2018) Compensated heading angles for outdoor mobile robots in magnetically disturbed environment. IEEE Trans Industr Electron 65(2):1408–1419

    Article  Google Scholar 

  29. Lee JK (2019) A parallel attitude-heading EKF without state-augmentation of model-based disturbance components. IEEE Trans Instrum Meas 68(7):2668–2670

    Article  Google Scholar 

  30. Zhang Q, Gao Q, Chen Y, Huang X (2010) A novel magnetic compass calibration method based on improved ellipse model. In: 2010 international conference on intelligent control and information processing, Dalian, pp 11–15

  31. Fang J, Sun H, Cao J, Zhang X, Tao Y (2011) A novel calibration algorithm of magnetometer based on ellipsoid fitting. IEEE Trans Instrum Meas 60(6):2053–2061

    Article  Google Scholar 

  32. Jiménez R, Seco F, Prieto JC, Guevara J (2010) Indoor pedestrian navigation using an INS/EKF framework for yaw drift reduction and a foot-mounted IMU. In: 2010 7th workshop on positioning, navigation and communication, Dresden, pp 135–143

  33. Renaudin V, Afzal MH, Lachapelle G (2010) Complete triaxis magnetometer calibration in the magnetic domain. J Sens 2010:967245:1–967245:10

    Article  Google Scholar 

  34. Park M, Gao Y (2006) Error analysis and stochastic modeling of low-cost MEMS accelerometer. J Intell Robot Syst 46(1):27–41

    Article  Google Scholar 

  35. Welch G, Bishop G (1995) An introduction to the Kalman filter. Technical report, UNC-CH computer science technical report 95041

  36. Hemerly EM, Coelho FAA (2014) Explicit solution for magnetometer calibration. IEEE Trans Instrum Meas 63(8):2093–2095

    Article  Google Scholar 

  37. Fitzgibbon MP, Fisher RB (1999) Direct least square fitting of ellipses. IEEE Trans Pattern Anal Mach Intell 21(5):476–480

    Article  Google Scholar 

Download references

Acknowledgements

This work was supported by the Guangdong science and technology department under Grant No. 2016A010106005.

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Feng Ye.

Additional information

Publisher's Note

Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Ye, F., Shi, F., Lai, Y. et al. Heading angle estimation using rotating magnetometer for mobile robots under environmental magnetic disturbances. Intel Serv Robotics 13, 459–477 (2020). https://doi.org/10.1007/s11370-020-00334-7

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s11370-020-00334-7

Keywords

Navigation