Robust ellipsoid fitting method based on optimization of a novel nonlinear cost function in navigation systems

  • Mojtaba MirzaeiEmail author
  • Iman Hosseini
Technical Paper


Low-cost sensors based on micro-electro-mechanical systems (MEMS) are typically used for attitude determination in navigation systems especially magnetometer which is used for heading determination. The measured value of the MEMS magnetometer is subjected to different kinds of error such as random noise, constant bias, non-orthogonality, scale factor deviation and more importantly hard iron and soft iron effects. Therefore, in order to reach more accurate measurement, high-precision calibration is needed. One of the most common methods for calibrating MEMS magnetic sensors is least squares ellipsoid fitting. But, the common least squares ellipsoid fitting method can be inefficient for real-time applications in the presence of colored noise and outliers. In this paper, a modified ellipsoid fitting method is proposed in which a nonlinear optimization is developed to minimize a novel cost function. In the cost function of the proposed robust method, the effect of outliers and noise is considered and the standard deviation of the data is kept minimum. Finally, the efficiency of the new algorithms is demonstrated through the experimental results.


Magnetometer Calibration Ellipsoid fitting Nonlinear optimization 



  1. 1.
    Chernov N, Lesort C (2005) Least squares fitting of circles. J Math Imaging Vis J Artic 23(3):239–252MathSciNetCrossRefGoogle Scholar
  2. 2.
    Ladrón de Guevara I, Muñoz J, de Cózar OD, Blázquez EB (2011) Robust fitting of circle arcs. J Math Imaging Vis J Artic 40(2):147–161MathSciNetCrossRefGoogle Scholar
  3. 3.
    Muñoz-Pérez J, de Cózar-Macías OD, Blázquez-Parra EB, Ladrón de Guevara-López I (2014) Multicriteria robust fitting of elliptical primitives. J Math Imaging Vis J Artic 49(2):492–509MathSciNetzbMATHGoogle Scholar
  4. 4.
    Szpak ZL, Chojnacki W, van den Hengel A (2015) Guaranteed ellipse fitting with a confidence region and an uncertainty measure for centre, axes, and orientation. J Math Imaging Vis J Artic 52(2):173–199MathSciNetCrossRefGoogle Scholar
  5. 5.
    Waibel P, Matthes J, Gröll L (2015) Constrained ellipse fitting with center on a line. J Math Imaging Vis J Artic 53(3):364–382MathSciNetCrossRefGoogle Scholar
  6. 6.
    Sahin T, Unel M (2008) Stable algebraic surfaces for 3d object representation. J Math Imaging Vis J Artic 32(2):127–137CrossRefGoogle Scholar
  7. 7.
    Cross G, Zisserman A (1998) Quadric reconstruction from dual-space geometry. In: Sixth international conference on computer vision, IEEE, pp 25–31Google Scholar
  8. 8.
    Lee PY, Moore JB (2004) Geometric optimization for 3D pose estimation of quadratic surfaces. In: Conference record of the thirty-eighth Asilomar conference on signals, systems and computers, vol. 1, IEEE, pp 131–135Google Scholar
  9. 9.
    Collings S, Kozera R, Noakes L (2009) Robust surface fitting from two views using restricted correspondence. J Math Imaging Vis 34(2):200–221MathSciNetCrossRefGoogle Scholar
  10. 10.
    Gang Y, Yingtang Z, Hongbo F, GuoQuan R, Zhining L (2015) Integrated calibration of magnetic gradient tensor system. J Magn Magn Mater 374:289–297CrossRefGoogle Scholar
  11. 11.
    Gietzelt M, Wolf K-H, Marschollek M, Haux R (2013) Performance comparison of accelerometer calibration algorithms based on 3D-ellipsoid fitting methods. Comput Methods Programs Biomed 111(1):62–71CrossRefGoogle Scholar
  12. 12.
    Malyugina A, Igudesman K, Chickrin D (2014) Least-squares fitting of a three-dimensional ellipsoid to noisy data. Appl Math Sci 8(149):7409–7421Google Scholar
  13. 13.
    Hwangbo M, Kanade T (2008) Factorization-based calibration method for MEMS inertial measurement unit. In: ICRA 2008 international conference on robotics and automation, IEEE, pp 1306–1311Google Scholar
  14. 14.
    Fang J, Sun H, Cao J, Zhang X, Tao Y (2011) A novel calibration method of magnetic compass based on ellipsoid fitting. IEEE Trans Instrum Meas 60(6):2053–2061CrossRefGoogle Scholar
  15. 15.
    Lou X, Zhou L, Jia Y (2014) Realization of ellipsoid fitting calibration for three-axis magnetic sensor based on stm 32 embedded system. In: International conference on human centered computing, Springer, pp 717–726Google Scholar
  16. 16.
    Fang J, Liu Z (2015) A new inclination error calibration method of motion table based on accelerometers. IEEE Trans Instrum Meas 64(2):487–493CrossRefGoogle Scholar
  17. 17.
    Geiger W et al (2008) MEMS IMU for AHRS applications. In: 2008 IEEE/ION position, location and navigation symposium, pp 225–231Google Scholar
  18. 18.
    Chan A-L, Tan S-L, Kwek C.-L (2011) Sensor data fusion for attitude stabilization in a low cost Quadrotor system. In: IEEE 15th international symposium on consumer electronics (ISCE), IEEE, pp 34–39Google Scholar
  19. 19.
    Sheng H, Zhang T (2015) MEMS-based low-cost strap-down AHRS research. Measurement 59:63–72CrossRefGoogle Scholar
  20. 20.
    Su Z, Yang L, Kong Q, Hong L (2015) AHRS design based on STM32 and MEMS sensors. Int J Control Autom 8(7):55–66CrossRefGoogle Scholar
  21. 21.
    Dariusz N, Andrzej T, Grzegorz K (2016) Analysis of the quality control of UAVs for the case of the analytical redundancy of measurements. In: AIAA modeling and simulation technologies conference (AIAA Aviation: American Institute of Aeronautics and Astronautics)Google Scholar
  22. 22.
    Kingston DB, Beard RW (2004) Real-time attitude and position estimation for small UAVs using low-cost sensors. In: AIAA 3rd unmanned unlimited technical conference, Workshop and exhibit, sn, pp 2004–6488Google Scholar
  23. 23.
    No H, Cho A, Kee C (2015) Attitude estimation method for small UAV under accelerative environment. GPS Solut J Artic 19(3):343–355CrossRefGoogle Scholar
  24. 24.
    Yu Z, Bao X, Nonami K (2008) Course keeping control of an autonomous boat using low cost sensors. J Syst Design Dynam 2(1):389–400CrossRefGoogle Scholar
  25. 25.
    Yu Z, Bao X, Nonami K (2007) Mixed H2/H∞ based course-following control for a small low cost autonomous boat. ICGST Int J Autom Control Syst Eng 7(1):51Google Scholar
  26. 26.
    Larson J, Bruch M, Ebken J (2006) Autonomous navigation and obstacle avoidance for unmanned surface vehicles. In: Defense and security symposium, pp 623007–623007-12. International society for optics and photonicsGoogle Scholar
  27. 27.
    Harris JW, Stöcker H (1998) Handbook of mathematics and computational science. Springer, BerlinCrossRefGoogle Scholar
  28. 28.
    Li Q, Griffiths JG (2004) Least squares ellipsoid specific fitting. In: Geometric modeling and processing, 2004. Proceedings, IEEE, pp 335–340Google Scholar
  29. 29.
    Ying X, Yang L, Zha H (2012) A fast algorithm for multidimensional ellipsoid-specific fitting by minimizing a new defined vector norm of residuals using semidefinite programming. IEEE Trans Pattern Anal Mach Intell 34(9):1856–1863CrossRefGoogle Scholar
  30. 30.
    Vajk I, Hetthéssy J (2003) Identification of nonlinear errors-in-variables models. Automatica 39(12):2099–2107MathSciNetCrossRefGoogle Scholar
  31. 31.
    Gebre-Egziabher D, Elkaim GH, David Powell J, Parkinson BW (2006) Calibration of strapdown magnetometers in magnetic field domain. J Aerospace Eng 19(2):87–102CrossRefGoogle Scholar
  32. 32.
    Foster CC, Elkaim GH (2008) Extension of a two-step calibration methodology to include nonorthogonal sensor axes. IEEE Trans Aerospace Electron Syst 44(3):1070–1078CrossRefGoogle Scholar
  33. 33.
    Jurman D, Jankovec M, Kamnik R, Topič M (2007) Calibration and data fusion solution for the miniature attitude and heading reference system. Sens Actuators A Phys 138(2):411–420CrossRefGoogle Scholar
  34. 34.
    Li X, Li Z (2012) A new calibration method for tri-axial field sensors in strap-down navigation systems. Meas Sci Technol 23(10):105105CrossRefGoogle Scholar
  35. 35.
    Kanatani K, Rangarajan P (2011) Hyper least squares fitting of circles and ellipses. Comput Stat Data Anal 55(6):2197–2208MathSciNetCrossRefGoogle Scholar
  36. 36.
    Liu YX, Li XS, Zhang XJ, Feng YB (2014) Novel calibration algorithm for a three-axis strapdown magnetometer. Sensors 14(5):8485–8504CrossRefGoogle Scholar
  37. 37.
    Grubbs FE (1969) Procedures for detecting outlying observations in samples. Technometrics 11(1):1–21CrossRefGoogle Scholar
  38. 38.
    Audet C, Dennis JE Jr (2002) Analysis of generalized pattern searches. SIAM J Optim 13(3):889–903MathSciNetCrossRefGoogle Scholar

Copyright information

© The Brazilian Society of Mechanical Sciences and Engineering 2019

Authors and Affiliations

  1. 1.Shiraz UniversityShirazIran

Personalised recommendations