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.
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.References
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)
Crassidis, J., Markley, F., Chen, Y.: Survey of nonlinear attitude estimation methods. J. Guid., Control Dyn. 30(1), 12–28 (2007)
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)
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)
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)
Grzonka, S., Grisetti, G., Burgard, W.: A fully autonomous indoor quadrotor. IEEE Trans. Robot. 28(1), 90–100 (2012)
Henriques, B.: Estimation and control of a quadrotor attitude. Master thesis, Instituto Superior Tecnico, Universidade Tecnica de Lisboa (2011)
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)
Hua, M.D.: Attitude estimation for accelerated vehicles using GPS/INS measurements. Control. Eng. Pract. 18(7), 723–732 (2010)
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)
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)
Madinehi, N.: Rigid body attitude estimation: An overview and comparative study. Master thesis, Western University Canada (2013)
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)
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)
Mahony, R., Kumar, V., Corke, P.: Multirotor aerial vehicles: Modeling, estimation, and control of quadrotor. IEEE Robot. Autom. Mag. 19(3), 20–32 (2012)
Markley, F.: Attitude determination using vector observations and the singular value decomposition. J. Astronaut. Sci 36(3), 245–258 (1988)
Markley, F.L., Mortari, D.: Quaternion attitude estimation using vector observations. J. Astronaut. Sci. 48(2-3), 359–380 (2000)
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)
Mathworks: Dryden Wind Turbulence Model, Matlab Aerospace Toolbox (2014)
Politi, T.: A formula for the exponential of a real skew-symmetric matrix of order 4. BIT 41(4), 842–845 (2001)
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)
Shuster, M.D.: A simple Kalman filter and smoother for spacecraft attitude. J. Astronaut. Sci. 37(1), 86–106 (1989)
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)
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)
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)
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)
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)
Author information
Authors and Affiliations
Corresponding author
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
About this article
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
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10846-014-0170-2