Table of Contents
International Journal of Navigation and Observation
Volume 2015, Article ID 503814, 18 pages
http://dx.doi.org/10.1155/2015/503814
Research Article

A DCM Based Attitude Estimation Algorithm for Low-Cost MEMS IMUs

Autonomous Systems Research Group, Department of Electrical Engineering and Automation, School of Electrical Engineering, Aalto University, P.O. Box 15500, 00076 Aalto, Finland

Received 16 July 2015; Revised 29 October 2015; Accepted 4 November 2015

Academic Editor: Aleksandar Dogandzic

Copyright © 2015 Heikki Hyyti and Arto Visala. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Linked References

  1. M. Euston, P. Coote, R. Mahony, J. Kim, and T. Hamel, “A complementary filter for attitude estimation of a fixed-wing UAV,” in Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '08), pp. 340–345, IEEE, Nice, France, September 2008. View at Publisher · View at Google Scholar · View at Scopus
  2. V. Bistrov, “Performance analysis of alignment process of MEMS IMU,” International Journal of Navigation and Observation, vol. 2012, Article ID 731530, 11 pages, 2012. View at Publisher · View at Google Scholar · View at Scopus
  3. Z. Ercan, V. Sezer, H. Heceoglu et al., “Multi-sensor data fusion of DCM based orientation estimation for land vehicles,” in Proceedings of the IEEE International Conference on Mechatronics (ICM '11), pp. 672–677, IEEE, Istanbul, Turkey, April 2011. View at Publisher · View at Google Scholar · View at Scopus
  4. P. Zhou, M. Li, and G. Shen, “Use it free: instantly knowing your phone attitude,” in Proceedings of the 20th Annual International Conference on Mobile Computing and Networking (MobiCom '14), pp. 605–616, Maui, Hawaii, USA, September 2014. View at Publisher · View at Google Scholar
  5. L. Lou, X. Xu, J. Cao, Z. Chen, and Y. Xu, “Sensor fusion-based attitude estimation using low-cost MEMS-IMU for mobile robot navigation,” in Proceedings of the 6th IEEE Joint International Information Technology and Artificial Intelligence Conference (ITAIC '11), pp. 465–468, IEEE, Chongqing, China, August 2011. View at Publisher · View at Google Scholar · View at Scopus
  6. L. Sahawneh and M. A. Jarrah, “Development and calibration of low cost MEMS IMU for UAV applications,” in Proceedings of the 5th International Symposium on Mechatronics and Its Applications (ISMA '08), pp. 1–9, Amman, Jordan, May 2008. View at Publisher · View at Google Scholar · View at Scopus
  7. H. J. Luinge and P. H. Veltink, “Inclination measurement of human movement using a 3-D accelerometer with autocalibration,” IEEE Transactions on Neural Systems and Rehabilitation Engineering, vol. 12, no. 1, pp. 112–121, 2004. View at Publisher · View at Google Scholar · View at Scopus
  8. M. H. Raibert, Legged Robots That Balance, MIT Press, 1986.
  9. E. Edwan, J. Zhang, J. Zhou, and O. Loffeld, “Reduced DCM based attitude estimation using low-cost IMU and magnetometer triad,” in Proceedings of the 8th Workshop on Positioning Navigation and Communication (WPNC '11), pp. 1–6, IEEE, Dresden, Germany, April 2011. View at Publisher · View at Google Scholar · View at Scopus
  10. E. Foxlin, “Inertial head-tracker sensor fusion by a complementary separate-bias Kalman filter,” in Proceedings of the IEEE Virtual Reality Annual International Symposium, pp. 185–194, IEEE, Santa Clara, Calif, USA, April 1996. View at Publisher · View at Google Scholar · View at Scopus
  11. S. O. H. Madgwick, A. J. L. Harrison, and R. Vaidyanathan, “Estimation of IMU and MARG orientation using a gradient descent algorithm,” in Proceedings of the IEEE International Conference on Rehabilitation Robotics (ICORR '11), pp. 1–7, IEEE, Zürich, Switzerland, July 2011. View at Publisher · View at Google Scholar · View at Scopus
  12. N. H. Q. Phuong, H.-J. Kang, Y.-S. Suh, and Y.-S. Ro, “A DCM based orientation estimation algorithm with an inertial measurement unit and a magnetic compass,” Journal of Universal Computer Science, vol. 15, no. 4, pp. 859–876, 2009. View at Google Scholar · View at Zentralblatt MATH · View at Scopus
  13. D. Jurman, M. Jankovec, R. Kamnik, and M. Topič, “Calibration and data fusion solution for the miniature attitude and heading reference system,” Sensors and Actuators A: Physical, vol. 138, no. 2, pp. 411–420, 2007. View at Publisher · View at Google Scholar · View at Scopus
  14. M. Romanovas, L. Klingbeil, M. Trächtler, and Y. Manoli, “Efficient orientation estimation algorithm for low cost inertial and magnetic sensor systems,” in Proceedings of the IEEE/SP 15th Workshop on Statistical Signal Processing (SSP '09), pp. 586–589, IEEE, Cardiff, Wales, September 2009. View at Publisher · View at Google Scholar · View at Scopus
  15. R. Munguia and A. Grau, “Attitude and heading system based on EKF total state configuration,” in Proceedings of the IEEE International Symposium on Industrial Electronics (ISIE '11), pp. 2147–2152, IEEE, Gdańsk, Poland, June 2011. View at Publisher · View at Google Scholar
  16. 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. 1, pp. 99–113, 2013. View at Publisher · View at Google Scholar · View at Scopus
  17. D. Gebre-Egziabher, R. C. Hayward, and J. D. Powell, “Design of multi-sensor attitude determination systems,” IEEE Transactions on Aerospace and Electronic Systems, vol. 40, no. 2, pp. 627–649, 2004. View at Publisher · View at Google Scholar · View at Scopus
  18. J. K. Hall, N. B. Knoebel, and T. W. McLain, “Quaternion attitude estimation for miniature air vehicles using a multiplicative extended Kalman filter,” in Proceedings of the IEEE/ION Position, Location and Navigation Symposium (PLANS '08), pp. 1230–1237, IEEE, Monterey, Calif, USA, May 2008. View at Publisher · View at Google Scholar · View at Scopus
  19. H. G. De Marina, F. J. Pereda, J. M. Giron-Sierra, and F. Espinosa, “UAV attitude estimation using unscented Kalman filter and TRIAD,” IEEE Transactions on Industrial Electronics, vol. 59, no. 11, pp. 4465–4474, 2012. View at Publisher · View at Google Scholar · View at Scopus
  20. N. S. Kumar and T. Jann, “Estimation of attitudes from a low-cost miniaturized inertial platform using Kalman Filter-based sensor fusion algorithm,” Sadhana, vol. 29, pp. 217–235, 2004. View at Publisher · View at Google Scholar
  21. 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. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus
  22. M. Ruizenaar, E. van der Hall, and M. Weiss, “Gyro bias estimation using a dual instrument configuration,” in Proceedings of the 2nd CEAS Specialist Conference on Guidance, Navigation & Control (EuroGNC '13), Delft, The Netherlands, April 2013.
  23. M.-D. Hua, G. Ducard, T. Hamel, R. Mahony, and K. Rudin, “Implementation of a nonlinear attitude estimator for aerial robotic vehicles,” IEEE Transactions on Control Systems Technology, vol. 22, no. 1, pp. 201–213, 2014. View at Publisher · View at Google Scholar · View at Scopus
  24. Z. Wu, Z. Sun, W. Zhang, and Q. Chen, “A novel approach for attitude estimation using MEMS inertial sensors,” in Proceedings of the IEEE (SENSORS '14), pp. 1022–1025, IEEE, Valencia, Spain, November 2014. View at Publisher · View at Google Scholar
  25. R. Zhu, D. Sun, Z. Zhou, and D. Wang, “A linear fusion algorithm for attitude determination using low cost MEMS-based sensors,” Measurement, vol. 40, no. 3, pp. 322–328, 2007. View at Publisher · View at Google Scholar · View at Scopus
  26. B. Barshan and H. F. Durrant-Whyte, “Inertial navigation systems for mobile robots,” IEEE Transactions on Robotics and Automation, vol. 11, no. 3, pp. 328–342, 1995. View at Publisher · View at Google Scholar · View at Scopus
  27. B. Huyghe, J. Doutreloigne, and J. Vanfleteren, “3D orientation tracking based on unscented kalman filtering of accelerometer and magnetometer data,” in Proceedings of the IEEE Sensors Applications Symposium (SAS '09), pp. 148–152, New Orleans, La, USA, February 2009.
  28. S. O. Madgwick, An efficient orientation filter for inertial and inertial/magnetic sensor arrays, University of Bristol, Bristol, UK, 2010.
  29. G. Baldwin, R. Mahony, J. Trumpf, T. Hamel, and T. Cheviron, “Complementary filter design on the Special Euclidean group S E (3),” in Proceedings of the European Control Conference, vol. 1, p. 2, Greece, Athens, July 2007.
  30. T. Hamel and R. Mahony, “Attitude estimation on SO[3] based on direct inertial measurements,” in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA '06), pp. 2170–2175, IEEE, Orlando, Fla, USA, May 2006. View at Publisher · View at Google Scholar
  31. H. F. Grip, T. I. Fossen, T. A. Johansen, and A. Saberi, “Globally exponentially stable attitude and gyro bias estimation with application to GNSS/INS integration,” Automatica, vol. 51, pp. 158–166, 2015. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus
  32. A. Khosravian, J. Trumpf, R. Mahony, and T. Hamel, “Velocity aided attitude estimation on SO(3) with sensor delay,” in Proceedings of the IEEE 53rd Annual Conference on Decision and Control (CDC '14), pp. 114–120, IEEE, Los Angeles, Calif, USA, December 2014. View at Publisher · View at Google Scholar
  33. P. Martin and E. Salaün, “Design and implementation of a low-cost observer-based attitude and heading reference system,” Control Engineering Practice, vol. 18, no. 7, pp. 712–722, 2010. View at Publisher · View at Google Scholar · View at Scopus
  34. M.-D. Hua, “Attitude estimation for accelerated vehicles using GPS/INS measurements,” Control Engineering Practice, vol. 18, no. 7, pp. 723–732, 2010. View at Publisher · View at Google Scholar · View at Scopus
  35. H. Chao, C. Coopmans, L. Di, and Y. Q. Chen, “A comparative evaluation of low-cost IMUs for unmanned autonomous systems,” in Proceedings of the IEEE Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI '10), pp. 211–216, IEEE, Salt Lake City, Utah, USA, September 2010. View at Publisher · View at Google Scholar · View at Scopus
  36. J. L. Crassidis, F. L. Markley, and Y. Cheng, “Survey of nonlinear attitude estimation methods,” Journal of Guidance, Control, and Dynamics, vol. 30, no. 1, pp. 12–28, 2007. View at Publisher · View at Google Scholar · View at Scopus
  37. R. Mahony, T. Hamel, J. Trumpf, and C. Lageman, “Nonlinear attitude observers on SO(3) for complementary and compatible measurements: a theoretical study,” in Proceedings of the 48th IEEE Conference on Decision and Control, Held Jointly with the 28th Chinese Control Conference (CDC/CCC '09), pp. 6407–6412, Shanghai, China, December 2009.
  38. A. Khosravian and M. Namvar, “Globally exponential estimation of satellite attitude using a single vector measurement and gyro,” in Proceedings of the 49th IEEE Conference on Decision and Control (CDC '10), pp. 364–369, IEEE, Atlanta, Ga, USA, December 2010. View at Publisher · View at Google Scholar · View at Scopus
  39. A. Khosravian, J. Trumpf, R. Mahony, and C. Lageman, “Observers for invariant systems on Lie groups with biased input measurements and homogeneous outputs,” Automatica, vol. 55, pp. 19–26, 2015. View at Publisher · View at Google Scholar · View at MathSciNet
  40. B. Siciliano and O. Khatib, Springer Handbook of Robotics, Springer, 2008.
  41. E. Nebot and H. Durrant-Whyte, “Initial calibration and alignment of low-cost inertial navigation units for land vehicle applications,” Journal of Robotic Systems, vol. 16, no. 2, pp. 81–92, 1999. View at Publisher · View at Google Scholar · View at Scopus
  42. R. E. Kalman, “A new approach to linear filtering and prediction problems,” Journal of Basic Engineering, vol. 82, no. 1, pp. 35–45, 1960. View at Publisher · View at Google Scholar
  43. Y. Bar-Shalom, X. R. Li, and T. Kirubarajan, Estimation with Applications to Tracking and Navigation: Theory Algorithms and Software, John Wiley & Sons, New York, NY, USA, 2001.
  44. S. Thrun, W. Burgard, and D. Fox, Probabilistic Robotics, MIT Press, Cambridge, Mass, USA, 2005.
  45. S. J. Julier and J. J. LaViola Jr., “On Kalman filtering with nonlinear equality constraints,” IEEE Transactions on Signal Processing, vol. 55, no. 6, pp. 2774–2784, 2007. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus
  46. R. S. Jones, “Mathematical functions,” in The C Programmer's Companion: ANSI C Library Functions, Silicon Press, Summit, NJ, USA, 1st edition, 1991. View at Google Scholar
  47. S.-H. P. Won and F. Golnaraghi, “A triaxial accelerometer calibration method using a mathematical model,” IEEE Transactions on Instrumentation and Measurement, vol. 59, no. 8, pp. 2144–2153, 2010. View at Publisher · View at Google Scholar · View at Scopus
  48. MicroStrain, “Inertia-link inertial measurement unit and vertical gyro,” 2007, http://www.microstrain.com/inertial/Inertia-Link.
  49. Analog Devices, Digital Accelerometer ADXL345, Analog Devices, Norwood, Mass, USA, 2009.
  50. InvenSense, ITG-3200 Product Specification, InvenSense, 2011.
  51. R. Bischoff, J. Kurth, G. Schreiber et al., “The KUKA-DLR lightweight robot arm—a new reference platform for robotics research and manufacturing,” in Proceedings of the 41st International Symposium on Robotics and the 6th German Conference on Robotics (ISR-ROBOTIK '10), pp. 1–8, VDE, Munich, Germany, June 2010.
  52. G. Schreiber, A. Stemmer, and R. Bischoff, “The fast research interface for the kuka lightweight robot,” in Proceedings of the IEEE Workshop on Innovative Robot Control Architectures for Demanding (Research) Applications: How to Modify and Enhance Commercial Controllers (ICRA 2010), Anchorage, Alaska, USA, May 2010.
  53. M. D. Comparetti, E. De Momi, T. Beyl, M. Kunze, J. Raczkowsky, and G. Ferrigno, “Convergence analysis of an iterative targeting method for keyhole robotic surgery,” International Journal of Advanced Robotic Systems, vol. 11, no. 1, article 60, 2014. View at Publisher · View at Google Scholar · View at Scopus
  54. D. Simon, Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches, John Wiley & Sons, 2006.