Skip to main content
SpringerLink
Log in

Attitude Estimation in SO(3): A Comparative UAV Case Study

  • Published:
Journal of Intelligent & Robotic Systems Aims and scope Submit manuscript

Abstract

This paper introduces a novel algorithm to obtain attitude estimations from low cost inertial measurement units including 3-axis accelerometer, 3-axis gyroscope and 3-axis magnetometer. This nonlinear attitude estimator is derived from Lyapunov’s theory and formulated in the special orthogonal group SO(3). The impact of the gyroscope bias is also assessed and an online estimator provided. The performance of the proposed estimator is validated and compared to current commonly used methods, namely the classical extended Kalman filter and two other nonlinear estimators in SO(3). Realistic simulations consider a quadcopter unmanned aerial vehicle subject to wind disturbances and whose sensors parameters have been identified from flight tests data.

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

Access this article

Log in via an institution

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

Instant access to the full article PDF.

Institutional subscriptions

Similar content being viewed by others

References

  1. Batista, P., Silvestre, C., Oliveira, P.: Sensor-based globally asymptotically stable filters for attitude estimation: Analysis, design, and performance evaluation. IEEE Trans. Autom. Control 57(8), 2095–2100 (2012)

    Article  MathSciNet  Google Scholar 

  2. Crassidis, J., Markley, F., Chen, Y.: Survey of nonlinear attitude estimation methods. J. Guid., Control Dyn. 30(1), 12–28 (2007)

    Article  Google Scholar 

  3. Eynard, D., Vasseur, P., Demonceaux, C., Frémont, V.: UAV altitude estimation by mixed stereoscopic vision. In: Proceedings IEEE/RSJ International Conference on Intelligent Robots and Systems, pp 646–651. IEEE, Taipei (2010)

  4. Fernando, T., Chandiramani, J., Lee, T., Gutierrez, H.: Robust adaptive geometric tracking controls on SO(3) with an application to the attitude dynamics of a quadrotor UAV. In: Proceedings 50th IEEE Conference on Decision and Control and European Control Conference, pp 7380–7385. IEEE, Orlando (2011)

  5. Gebre-Egziabher, D., Elkaim, G.H., Powell, J.D., Parkinson, B.W.: A gyro-free quaternion-based attitude determination system suitable for implementation using low cost sensors. In: Proceedings Position Location and Navigation Symposium, pp 185–192. IEEE (2000)

  6. Grzonka, S., Grisetti, G., Burgard, W.: A fully autonomous indoor quadrotor. IEEE Trans. Robot. 28(1), 90–100 (2012)

    Article  Google Scholar 

  7. Henriques, B.: Estimation and control of a quadrotor attitude. Master thesis, Instituto Superior Tecnico, Universidade Tecnica de Lisboa (2011)

  8. Honegger, D., Meier, L., Tanskanen, P., Pollefeys, M.: An open source and open hardware embedded metric optical flow CMOS camera for indoor and outdoor applications. In: Proceedings IEEE International Conference on Robotics and Automation, pp 1736–1741. IEEE, Karlsruhe (2013)

  9. Hua, M.D.: Attitude estimation for accelerated vehicles using GPS/INS measurements. Control. Eng. Pract. 18(7), 723–732 (2010)

    Article  Google Scholar 

  10. Kumar, N.S., Jann, T.: Estimation of attitudes from a low-cost miniaturized inertial platform using Kalman filter-based sensor fusion algorithm. Sadhana 29(2), 217–235 (2004)

    Article  Google Scholar 

  11. Lee, T.G, Leoky, M., McClamroch, N.H.: Geometric tracking control of a quadrotor UAV on SE(3). In: Proceedings 49th IEEE Conference on Decision and Control, pp 5420–5425. IEEE, Atlanta (2010)

  12. Madinehi, N.: Rigid body attitude estimation: An overview and comparative study. Master thesis, Western University Canada (2013)

  13. Mahony, R., Hamel, T., Pflimlin, J.M.J.: Nonlinear complementary filters on the special orthogonal group. IEEE Trans. Autom. Control 53(5), 1203–1218 (2008)

    Article  MathSciNet  Google Scholar 

  14. Mahony, R., Hamel, T., Trumpf, J., Lageman, C.: Nonlinear attitude observers on SO(3) for complementary and compatible measurements: A theoretical study. In: Proceedings Joint 48th IEEE Conference on Decision and Control and 28th Chinese Control Conference, pp. 6407–6412. IEEE, Shanghai (2009)

  15. Mahony, R., Kumar, V., Corke, P.: Multirotor aerial vehicles: Modeling, estimation, and control of quadrotor. IEEE Robot. Autom. Mag. 19(3), 20–32 (2012)

    Article  Google Scholar 

  16. Markley, F.: Attitude determination using vector observations and the singular value decomposition. J. Astronaut. Sci 36(3), 245–258 (1988)

    MathSciNet  Google Scholar 

  17. Markley, F.L., Mortari, D.: Quaternion attitude estimation using vector observations. J. Astronaut. Sci. 48(2-3), 359–380 (2000)

    Google Scholar 

  18. Martin, P., Salaun, E.: Generalized multiplicative extended Kalman filter for aided attitude and heading reference system. In: Proceedings Guidance, Navigation and Control Conference, pp 1–13. AIAA, Toronto (2010)

  19. Mathworks: Dryden Wind Turbulence Model, Matlab Aerospace Toolbox (2014)

  20. Politi, T.: A formula for the exponential of a real skew-symmetric matrix of order 4. BIT 41(4), 842–845 (2001)

    Article  MATH  MathSciNet  Google Scholar 

  21. Shabayek, A.E.R., Demonceaux, C., Morel, O., Fofi, D.: Vision based UAV attitude estimation: Progress and insights. J. Intell. Robot. Syst. 65(1-4), 295–308 (2012)

    Article  Google Scholar 

  22. Shuster, M.D.: A simple Kalman filter and smoother for spacecraft attitude. J. Astronaut. Sci. 37(1), 86–106 (1989)

    Google Scholar 

  23. Vandyke, M.C., Schwartz, J.L., Hall, C.D.: Unscented Kalman filtering for spacecraft attitude state and parameter estimation. In: Proceedings AAS/AIAA space flight mechanics conference (2004)

  24. Vasconcelos, J., et al.: Discrete-time complementary filters for attitude and position estimation: Design, analysis and experimental validation. IEEE Trans. Control Syst. Technol. 19(1), 181–198 (2011)

    Article  MathSciNet  Google Scholar 

  25. Vasconcelos, J.F., Cunha, R., Silvestre, C., Oliveira, P.: A nonlinear position and attitude observer on SE(3) using landmark measurements. Syst. Control Lett. 59(3-4), 155–166 (2010)

    Article  MATH  MathSciNet  Google Scholar 

  26. Vasconcelos, J.F., Silvestre, C., Oliveira, P.: A nonlinear GPS/IMU based observer for rigid body attitude and position estimation. In: Proceedings 47th IEEE Conference on Decision and Control, pp. 1255–1260 . IEEE, Cancun (2008)

  27. Yoo, T., Hong, S., Yoon, H., Park, S.: Gain-scheduled complementary filter design for a MEMS based attitude and heading reference system. Sensors 11(4), 3816–3830 (2011)

    Article  Google Scholar 

Download references

Author information

Authors and Affiliations

  1. LAETA, IDMEC, Instituto Superior Técnico, Universidade de Lisboa, Av. Rovisco Pais, Pav. Mecânica 3, 1049-001, Lisbon, Portugal

    Alexandra Moutinho & José Raul Azinheira

  2. Instituto Superior Técnico, Universidade de Lisboa, Av. Rovisco Pais, 1049-001, Lisbon, Portugal

    Miguel Figueirôa

Authors
  1. Alexandra Moutinho
    View author publications

    You can also search for this author in PubMed Google Scholar

  2. Miguel Figueirôa
    View author publications

    You can also search for this author in PubMed Google Scholar

  3. José Raul Azinheira
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to Alexandra Moutinho.

Additional information

This work was supported by Fundação para a Ciência e a Tecnologia (FCT), through IDMEC, under LAETA PEst-OE/EME/LA0022.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Moutinho, A., Figueirôa, M. & Azinheira, J.R. Attitude Estimation in SO(3): A Comparative UAV Case Study. J Intell Robot Syst 80, 375–384 (2015). https://doi.org/10.1007/s10846-014-0170-2

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10846-014-0170-2

Keywords

Search

Navigation