Abstract
An extended Kalman filter (EKF) is developed on the special Euclidean group, S E(3) for geometric control of a quadrotor UAV. It is obtained by performing an intrinsic form of linearization on S E(3) to estimate the state of the quadrotor from noisy measurements. The proposed estimator considers all of the coupling effects between rotational and translational dynamics, and it is developed in a coordinate-free fashion. The desirable features of the proposed EKF are illustrated by numerical examples and experimental results for several scenarios. The proposed estimation scheme on S E(3) has been unprecedented and these results can be particularly useful for aggressive maneuvers in GPS denied environments or in situations where parts of onboard sensors fail.
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.References
Mellinger, D., Shomin, M., Michael, N., Kumar, V.: Cooperative grasping and transport using multiple quadrotors Distributed Autonomous Robotic Systems, vol. 83, pp 545–558. Springer, Berlin Heidelberg (2013)
Kim, S., Choi, S., Kim, H.J.: Aerial manipulation using a quadrotor with a two dof robotic arm Intelligent Robots and Systems, pp 4990–4995 (2013)
Goodarzi, F.A., Lee, D., Lee, T.: Geometric stabilization of quadrotor UAV with a payload connected by flexible cable Proceedings of American Control Conference, Portland OR, pp 4925–4930 (2014)
Kostas Alexis, G.N., Papachristos, C., Tzes, A.: Model predictive quadrotor indoor position control IEEE, 19th Mediterranean Conference on Control and Automation, pp 1247–1252 (2011)
Gumusboga, I., Kiyak, E.: An integrated navigation system design for quadrotors. Sensor Data Fusion: Trends, Solutions, Applications (SDF) (2015)
Oh, K.-H., Ahn, H.-S.: Extended kalman filter with multi-frequency reference data for quadrotor navigation IEEE, 15th International Conference on Control, Automation and Systems (ICCAS 2017), pp 201–206 (2015)
Moghadam, M., Caliskan, F.: Actuator and sensor fault detection and diagnosis of quadrotor based on two-stage kalman filter IEEE, 5th Australian Control Conference (AUCC), pp 182–187 (2015)
Alkowatly, M.T., Becerra, V.M., Holderbaum, W.: Bio-inspired autonomous visual vertical control of a quadrotor uav. J. Guid. Control. Dyn. 38(2), 249–262 (2015)
Sa, I., Corke, P.: 100Hz Onboard Vision for Quadrotor State Estimation Australasian Conference on Robotics and Automation. Victoria University of Wellington, New Zealand (2012)
Gautam, D., Ha, C.: Control of a quadrotor using a smart self-tuning fuzzy pid controller. Int. J. Adv. Robot. Syst. 10, 380–2013 (2014)
Grzonka, S., Grisetti, G., Burgard, W.: Towards a Navigation System for Autonomous Indoor Flying IEEE Kobe International Conference on Robotics and Automation. Kobe International Conference Center, Japan (2009)
Hoffmann, N.G.F., Bertram, T.: Attitude estimation and control of a quadrocopter The 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems, pp 1072–1077 (2010)
Wang, S., Yang, Y.: Quadrotor aircraft attitude estimation and control based on kalman filter IEEE, Proceedings of 31st Chinese Control Conference, pp 5634–5639 (2012)
Henriques, B.S.M.: Estimation and Control of a Quadrotor Attitude. Universidade Tecnica De Lisboa, Lisbon (2011)
Avram, R.C., Zhang, X., Campbell, J.: Sensor fault diagnosis in quadrotors using nonlinear adaptive estimators Annual Conference of the Prognostics and Health Management Society (2014)
Hong, Y.Z.Y., Lin, X., Zhao, Y.: Real-time pose estimation and motion control for a quadrotor uav Proceeding of the 11th World Congress on Intelligent Control and Automation, pp 2370–2375 (2014)
Bhat, S., Bernstein, D.: A topological obstruction to continuous global stabilization of rotational motion and the unwinding phenomenon. Syst. Control Lett. 39, 66–73 (2000)
Zeghlache, S., Saigaa, D., Kara, K., Bouguerra, A.: State vector estimation using extended filter kalman for the sliding mode controlled quadrotor helicopter in vertical flight 8th International Conference on Electrical and Electronics Engineering (ELECO), pp 492–496 (2013)
Yuan, X., Yu, S., Zhang, S., Wang, G., Liu, S.: Quaternion-based unscented kalman filter for accurate indoor heading estimation using wearable multi-sensor system. Sensors 15, 10 872–10 890 (2015)
Mercado, D., Castillo, P., Castro, R., Lozano, R.: 2-sliding mode trajectory tracking control and ekf estimation for quadrotors 19th IFAC World Congress (IFAC WC 2014), pp 8849–8854, Cape Town (2014)
Tanveer, M.H., Ahmed, S.F., Hazry, D., Warsi, F.A., Joyo, M.: Stablized controller design for attitude and altitude controlling of quadrotor under disturbance and noisy conditions. Am. J. Appl. Sci. 10(8), 819–831 (2013)
Izadi, H.A., Zhang, Y., Gordon, B.W.: Gordonfault tolerant model predictive control of quadrotor helicopters with actuator fault estimation 18th IFAC World Congress, Milano (2011)
Yang, S., Fang, Z., Jain, S., Dubey, G., Maeta, S.M., Roth, S., Scherer, S., Zhang, Y., Nuske, S.T.: High-precision autonomous flight in constrained shipboard environments, Robotics Institute, Carnegie Mellon University, Tech. Rep CMU-RI-TR-15-06 (2015)
Jurado, F., Rodriguez, M., Dzul, A., Campa, R.: Stochastic Feedback Controller for a Quadrotor Uav with Dual Modi Ed Extended Kalman Filter Workshop on Research, Education and Development of Unmanned Aerial Systems (RED- UAS), Cancun (2015)
Goodarzi, F.A., Lee, T.: Dynamics and control of quadrotor UAVs transporting a rigid body connected via flexible cables Proceedings of American Control Conference, Chicago IL, pp 4677–4682 (2015)
Goodarzi, F.A., Lee, D., Lee, T.: Geometric control of a quadrotor UAV transporting a payload connected via flexible cable. Int. J. Control. Autom. Syst. 13(6), (2015)
Goodarzi, F: Geometric nonlinear controls for multiple cooperative quadrotor UAVs transporting a rigid body, Ph.D. dissertation, The George Washington University (2015)
Goodarzi, F.A., Lee, T.: Stabilization of a rigid body payload with multiple cooperative quadrotors. ASME Journal of Dynamic Systems, Measurement, and Control 138(12), 121 001–12 (2016)
Goodarzi, F., Lee, D., Lee, T.: Geometric nonlinear PID, control of a quadrotor UAV on S E(3) Proceedings of the European Control Conference, pp 3845–3850 (2013)
Goodarzi, F.A., Lee, D., Lee, T.: Geometric adaptive tracking control of a quadrotor unmanned aerial vehicle on S E(3) for agile maneuvers. J. Dyn. Syst. Meas. Control. 137(9), 091 007–12 (2015)
Goodarzi, F.A., Lee, T.: Extended kalman filter on S E(3) for geometric control of a quadrotor UAV IEEE International Conference on Unmanned Aircraft Systems, pp 1371–1380, Arlington (2016)
Bullo, F., Lewis, A.: Geometric control of mechanical systems, ser. Texts in Applied Mathematics. Springer, vol. 49, modeling, analysis, and design for simple mechanical control systems (2005)
Lee, T.: Robust adaptive tracking on S O(3) with an application to the attitude dynamics of a quadrotor UAV. IEEE Trans. Control Syst. Technol. 21(5), 1924–1930 (2013)
Subbarao, K.: Nonlinear PID-like controllers for rigid-body attitude stabilization. J. Astronaut. Sci. 52 (1-2), 61–74 (2004)
Subbarao, K., Akella, M.: Differentiator-free nonlinear proportional-integral controllers for rigid-body attitude stabilization. J. Guid. Control. Dyn. 27(6), 1092–1096 (2004)
Show, L., Juang, J., Lin, C., Jan, Y.: Spacecraft robust attitude tracking design: PID control approach (2002)
Lee, T., leok, M., McClamroch, N.: Nonlinear robust tracking control of a quadrotor UAV on S E(3). Asian Journal of Control 15(2), 391–408 (2013)
Butcher, J.C.: The numerical analysis of ordinary differential equations: Runge-kutta and general linear methods. Wiley-Interscience, New York (1987)
Author information
Authors and Affiliations
Corresponding author
Rights and permissions
About this article
Cite this article
Goodarzi, F.A., Lee, T. Global Formulation of an Extended Kalman Filter on SE(3) for Geometric Control of a Quadrotor UAV. J Intell Robot Syst 88, 395–413 (2017). https://doi.org/10.1007/s10846-017-0525-6
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10846-017-0525-6