Improving leader-follower formation control performance for quadrotors

This thesis aims to improve the leader-follower team formation flight performance of Unmanned Aerial Vehicles (UAVs) by applying nonlinear robust and optimal techniques, in particular the nonlinear H_infinity and the iterative Linear Quadratic Regulator (iLQR), to stabilisation, path tracking and leader-follower team formation control problems. Existing solutions for stabilisation, path tracking and leader-follower team formation control have addressed a linear or nonlinear control technique for a linearised system with limited disturbance consideration, or for a nonlinear system with an obstacle-free environment. To cover part of this area of research, in this thesis, some nonlinear terms were included in the quadrotors' dynamic model, and external disturbance and model parameter uncertainties were considered. Five different controllers were developed. The first and the second controllers, the nonlinear suboptimal H_infinity control technique and the Integral Backstepping (IBS) controller, were based on Lyapunov theory. The H_infinity controller was developed with consideration of external disturbance and model parameter uncertainties. These two controllers were compared for path tracking and leader-follower team formation control. The third controller was the Proportional Derivative square (PD2), which was applied for attitude control and compared with the H_infinity controller. The fourth and the fifth controllers were the Linear Quadratic Regulator (LQR) control technique and the optimal iLQR, which was developed based on the LQR control technique. These were applied for attitude, path tracking and team formation control and there results were compared. Two features regarding the choice of the control technique were addressed: stability and robustness on the one hand, which were guaranteed using the H_infinity control technique as the disturbance is inherent in its mathematical model, and the improvement in the performance optimisation on the other, which was achieved using the iLQR technique as it is based on the optimal LQR control technique. Moreover, one loop control scheme was used to control each vehicle when these controllers were implemented and a distributed control scheme was proposed for the leader-follower team formation problem. Each of the above mentioned controllers was tested and verified in simulation for different predefined paths. Then only the nonlinear H_infinity controller was tested in both simulation and real vehicles experiments.

[1]  Hyo-Sung Ahn,et al.  Nonlinear Control of Quadrotor for Point Tracking: Actual Implementation and Experimental Tests , 2015, IEEE/ASME Transactions on Mechatronics.

[2]  Cheolkeun Ha,et al.  Control of a Quadrotor Using a Smart Self-Tuning Fuzzy PID Controller , 2013 .

[3]  Abdelkader Abdessameud,et al.  Formation control of VTOL-UAVs , 2009, CDC 2009.

[4]  S. R. Munasinghe,et al.  A velocity feedback fuzzy logic controller for stable hovering of a quad rotor UAV , 2009, 2009 International Conference on Industrial and Information Systems (ICIIS).

[5]  Yacine Challal,et al.  Quadrotors Formation Control: A Wireless Medium Access Aware Approach , 2012 .

[6]  Jay A. Farrell,et al.  Quaternion-based trajectory tracking control of VTOL-UAVs using command filtered backstepping , 2013, 2013 American Control Conference.

[7]  Youmin Zhang,et al.  Formation control of multiple quadrotors based on leader-follower method , 2015, 2015 International Conference on Unmanned Aircraft Systems (ICUAS).

[8]  Aníbal Ollero,et al.  Reconfigurable Control Architecture for Distributed Systems in the HERO Autonomous Helicopter , 2011, IEEE Transactions on Industrial Electronics.

[9]  M.A. Jarrah,et al.  Attitude stabilization of quadrotor UAV using Backstepping Fuzzy Logic & Backstepping Least-Mean-Square controllers , 2008, 2008 5th International Symposium on Mechatronics and Its Applications.

[10]  Taeyoung Lee,et al.  Nonlinear Robust Tracking Control of a Quadrotor UAV on SE(3) , 2013 .

[11]  Emanuele Frontoni,et al.  COALITION FORMATION FOR UNMANNED QUADROTORS , 2011 .

[12]  Rogelio Lozano,et al.  Real-time stabilization and tracking of a four rotor mini-rotorcraft , 2003 .

[13]  Béla Lantos,et al.  Formation Control of Quadrotor Helicopters with Guaranteed Collision Avoidance via Safe Path , 2012 .

[14]  Rafael Fierro,et al.  Trajectory generation for swing-free maneuvers of a quadrotor with suspended payload: A dynamic programming approach , 2012, 2012 IEEE International Conference on Robotics and Automation.

[15]  Emil Fresk,et al.  Full quaternion based attitude control for a quadrotor , 2013, 2013 European Control Conference (ECC).

[16]  M. Schreier,et al.  Modeling and adaptive control of a quadrotor , 2012, 2012 IEEE International Conference on Mechatronics and Automation.

[17]  Nicolas Marchand,et al.  Bounded attitude control of rigid bodies: Real-time experimentation to a quadrotor mini-helicopter , 2011 .

[18]  John T. Betts,et al.  Practical Methods for Optimal Control and Estimation Using Nonlinear Programming , 2009 .

[19]  Thang Nguyen Trong,et al.  The quadrotor MAV system using PID control , 2015, 2015 IEEE International Conference on Mechatronics and Automation (ICMA).

[20]  Zdeněk Hurák,et al.  Advanced control of quadrotor using eigenaxis rotation , 2011, 2011 IEEE International Conference on Control Applications (CCA).

[21]  Daniel Mellinger,et al.  Trajectory generation and control for quadrotors , 2012 .

[22]  Hai Lin,et al.  Decentralized hybrid formation control of Unmanned Aerial Vehicles , 2014, 2014 American Control Conference.

[23]  Byung-Cheol Min,et al.  Development of a Micro Quad-Rotor UAV for Monitoring an Indoor Environment , 2009, FIRA RoboWorld Congress.

[24]  Vijay Kumar,et al.  Trajectory design and control for aggressive formation flight with quadrotors , 2012, Auton. Robots.

[25]  Zhang Tao,et al.  Formation tracking control of multiple quadrotors based on backstepping , 2015, 2015 34th Chinese Control Conference (CCC).

[26]  K. Madhava Krishna,et al.  Model Predictive Control for Micro Aerial Vehicle Systems (MAV) Systems , 2014, ArXiv.

[27]  Andrea Cavallaro,et al.  Distributed vision-based flying cameras to film a moving target , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[28]  Rita Cunha,et al.  A Globally Stabilizing Path Following Controller for Rotorcraft With Wind Disturbance Rejection , 2015, IEEE Transactions on Control Systems Technology.

[29]  C.J.B. Macnab,et al.  A New Robust Adaptive-Fuzzy Control Method Applied to Quadrotor Helicopter Stabilization , 2006, NAFIPS 2006 - 2006 Annual Meeting of the North American Fuzzy Information Processing Society.

[30]  Guilherme V. Raffo,et al.  MPC with Nonlinear ℋ∞ Control for Path Tracking of a Quad-Rotor Helicopter , 2008 .

[31]  W. Nouibat,et al.  Fuzzy-PID hybrid control system to navigate an autonomous mini-Quadrotor , 2013, 3rd International Conference on Systems and Control.

[32]  Mac Schwager,et al.  Vector field following for quadrotors using differential flatness , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[33]  Rogelio Lozano,et al.  Hovering quad-rotor control: A comparison of nonlinear controllers using visual feedback , 2010, 49th IEEE Conference on Decision and Control (CDC).

[34]  Nicholas Roy,et al.  Towards A Swarm of Agile Micro Quadrotors , 2013 .

[35]  Jeremy C. Goldin.  Perching using a quadrotor with onboard sensing , 2011 .

[36]  Wan Kyun Chung,et al.  Bringing Nonlinear $\mathcal {H}_\infty$ Optimality to Robot Controllers , 2015, IEEE Transactions on Robotics.

[37]  Manfred Morari,et al.  Environment-independent formation flight for micro aerial vehicles , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[38]  Wang Jian,et al.  Backstepping-Based Inverse Optimal Attitude Control of Quadrotor , 2013 .

[39]  Shen Lincheng,et al.  An iterative learning controller for quadrotor UAV path following at a constant altitude , 2015, 2015 34th Chinese Control Conference (CCC).

[40]  Anuradha M. Annaswamy,et al.  A robust environment for simulation and testing of adaptive control for mini-UAVs , 2009, 2009 American Control Conference.

[41]  Cairo L. Nascimento,et al.  Autonomous Construction of Multiple Structures Using Learning Automata: Description and Experimental Validation , 2015, IEEE Systems Journal.

[42]  Priyo Sidik Sasongko,et al.  Multi flying vehicle control for saving fuel , 2014 .

[43]  Rogelio Lozano,et al.  Quad-rotor switching control: An application for the task of path following , 2012, 2012 American Control Conference (ACC).

[44]  Baris Fidan,et al.  Distributed Cohesive Motion Control of Flight Vehicle Formations , 2013, IEEE Transactions on Industrial Electronics.

[45]  Kemal Buyukkabasakal,et al.  Real-time implementation of decentralized adaptive formation control on multi-quadrotor systems , 2015, 2015 European Control Conference (ECC).

[46]  Vijay Kumar,et al.  Decentralized formation control with variable shapes for aerial robots , 2012, 2012 IEEE International Conference on Robotics and Automation.

[47]  A. Schaft.  L/sub 2/-gain analysis of nonlinear systems and nonlinear state-feedback H/sub infinity / control , 1992 .

[48]  Aldo Jaimes,et al.  An approach to surveillance an area using swarm of fixed wing and quad-rotor unmanned aerial vehicles UAV(s) , 2008, 2008 IEEE International Conference on System of Systems Engineering.

[49]  Wouter Caarls,et al.  Distance metric approximation for state-space RRTs using supervised learning , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[50]  Houria Siguerdidjane,et al.  ROBUST CONTROL AND VISUAL SERVOING OF AN UAV , 2008 .

[51]  Marcelo De Lellis Costa de Oliveira,et al.  Modeling, Identification and Control of a Quadrotor Aircraft , 2011 .

[52]  Galzi Damien,et al.  Unmanned Aerial Vehicle Formation Flight Using Sliding Mode Disturbance Observers , 2009 .

[53]  R. Beard.  Quadrotor Dynamics and Control , 2008 .

[54]  Rita Cunha,et al.  A trajectory tracking LQR controller for a quadrotor: Design and experimental evaluation , 2015, TENCON 2015 - 2015 IEEE Region 10 Conference.

[55]  Yisheng Zhong,et al.  Time-Varying Formation Control for Unmanned Aerial Vehicles: Theories and Applications , 2015, IEEE Transactions on Control Systems Technology.

[56]  Andrew Roberts,et al.  Inertial Vector Measurements Based Velocity-Free Attitude Stabilization , 2013, IEEE Transactions on Automatic Control.

[57]  Youmin Zhang,et al.  Fault-Tolerant Trajectory Tracking Control of a Quadrotor Helicopter Using Gain-Scheduled PID and Model Reference Adaptive Control , 2011 .

[58]  Mustapha Hamerlain,et al.  Adaptive fuzzy tracking control of unmanned quadrotor via backstepping , 2014, 2014 IEEE 23rd International Symposium on Industrial Electronics (ISIE).

[59]  Itthisek Nilkhamhang,et al.  Path tracking of UAV using self-tuning PID controller based on fuzzy logic , 2010, Proceedings of SICE Annual Conference 2010.

[60]  K. D. Do,et al.  Global tracking control of quadrotor VTOL aircraft in three dimensional space , 2013, 2013 Australian Control Conference.

[61]  Alexandra Moutinho,et al.  Stabilization and Altitude Control of an Indoor Low-Cost Quadrotor: Design and Experimental Results , 2015, 2015 IEEE International Conference on Autonomous Robot Systems and Competitions.

[62]  Martin Buss,et al.  Autonomous hovering of a vision/IMU guided quadrotor , 2009, 2009 International Conference on Mechatronics and Automation.

[63]  James Diebel,et al.  Representing Attitude : Euler Angles , Unit Quaternions , and Rotation Vectors , 2006 .

[64]  Michael David Schmidt,et al.  SIMULATION AND CONTROL OF A QUADROTOR UNMANNED AERIAL VEHICLE , 2011 .

[65]  Daniel Mellinger,et al.  Control of Quadrotors for Robust Perching and Landing , 2010 .

[66]  E. Altug,et al.  Modeling and PD Control of a Quadrotor VTOL Vehicle , 2007, 2007 IEEE Intelligent Vehicles Symposium.

[67]  Vicente Parra-Vega,et al.  Toward force control of a quadrotor UAV in SE(3) , 2012, 2012 IEEE 51st IEEE Conference on Decision and Control (CDC).

[68]  Dongjun Lee,et al.  Distributed Backstepping Control of Multiple Thrust-Propelled Vehicles on Balanced Graph , 2011 .

[69]  Dongjun Lee,et al.  Teleoperation control of formation among multiple under-actuated quadrotor UAVs , 2013, 2013 IEEE RO-MAN.

[70]  Haider A. F. Almurib,et al.  A review of autonomous multi-agent quad-rotor control techniques and applications , 2011, 2011 4th International Conference on Mechatronics (ICOM).

[71]  Rita Cunha,et al.  Robust take-off and landing for a quadrotor vehicle , 2010, 2010 IEEE International Conference on Robotics and Automation.

[72]  Abdelhamid Rabhi,et al.  Model-free control of a quadrotor vehicle , 2014, 2014 International Conference on Unmanned Aircraft Systems (ICUAS).

[73]  Roland Siegwart,et al.  Backstepping and Sliding-mode Techniques Applied to an Indoor Micro Quadrotor , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[74]  Matilde Santos,et al.  Intelligent fuzzy controller of a quadrotor , 2010, 2010 IEEE International Conference on Intelligent Systems and Knowledge Engineering.

[75]  Roland Siegwart,et al.  Full control of a quadrotor , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[76]  Sven Behnke,et al.  Nonlinear Model-based Position Control for Quadrotor UAVs , 2014, ISR 2014.

[77]  Yasir Amir Khan Niazi.  Modeling and Neural Control of Quadrotor Helicopter , 2010 .

[78]  O. Egeland,et al.  State feedback H∞-suboptimal control of a rigid spacecraft , 1997, IEEE Trans. Autom. Control..

[79]  Vahid Johari Majd,et al.  Cooperative formation control of quadrotors with obstacle avoidance and self collisions based on a hierarchical MPC approach , 2014, 2014 Second RSI/ISM International Conference on Robotics and Mechatronics (ICRoM).

[80]  Rita Cunha,et al.  A nonlinear quadrotor trajectory tracking controller with disturbance rejection , 2014, 2014 American Control Conference.

[81]  Jie Huang,et al.  The leader-following consensus of multiple rigid spacecraft systems , 2013, 2013 American Control Conference.

[82]  Emanuel Stingu,et al.  Design and implementation of a structured flight controller for a 6DoF quadrotor using quaternions , 2009, 2009 17th Mediterranean Conference on Control and Automation.

[83]  Frank L. Lewis,et al.  Aircraft Control and Simulation , 1992 .

[84]  E. Todorov,et al.  A generalized iterative LQG method for locally-optimal feedback control of constrained nonlinear stochastic systems , 2005, Proceedings of the 2005, American Control Conference, 2005..

[85]  G.V. Raffo,et al.  Backstepping/nonlinear H∞ control for path tracking of a quadrotor unmanned aerial vehicle , 2008, 2008 American Control Conference.

[86]  Boris Lohmann,et al.  Quasi-static feedback linearization for the translational dynamics of a quadrotor helicopter , 2012, 2012 American Control Conference (ACC).

[87]  Yan Jiang,et al.  An iterative linear quadratic regulator based trajectory tracking controller for wheeled mobile robot , 2012, Journal of Zhejiang University SCIENCE C.

[88]  Abdelaziz Benallegue,et al.  Backstepping Control for a Quadrotor Helicopter , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[89]  Vijay Kumar,et al.  Swarm Coordination Based on Smoothed Particle Hydrodynamics Technique , 2013, IEEE Transactions on Robotics.

[90]  Octavio Garcia,et al.  Time-parametrization control of quadrotors with a robust quaternion-based sliding mode controller for aggressive maneuvering , 2013, 2013 European Control Conference (ECC).

[91]  Yisheng Zhong,et al.  Formation control for quadrotor swarm systems: Algorithms and experiments , 2013, Proceedings of the 32nd Chinese Control Conference.

[92]  Boris Lohmann,et al.  Trajectory tracking control for a quadrotor helicopter based on backstepping using a decoupling quaternion parametrization , 2013, 21st Mediterranean Conference on Control and Automation.

[93]  Maryam Kamgarpour.  Path Tracking Control for Quadrotor Helicopters Katie Miller Graduate Student Mentor : , 2008 .

[94]  Youmin Zhang,et al.  Flatness-Based Trajectory Planning/Replanning for a Quadrotor Unmanned Aerial Vehicle , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[95]  Mehmet Önder Efe,et al.  Neural Network Assisted Computationally Simple PI$^\lambda$D$^\mu$ Control of a Quadrotor UAV , 2011, IEEE Transactions on Industrial Informatics.

[96]  Rafael Castro-Linares,et al.  Robust trajectory tracking control of a quadrotor helicopter , 2014, 2014 European Control Conference (ECC).

[97]  Vijay Kumar,et al.  Capt: Concurrent assignment and planning of trajectories for multiple robots , 2014, Int. J. Robotics Res..

[98]  H. Marquez.  Nonlinear Control Systems: Analysis and Design , 2003, IEEE Transactions on Automatic Control.

[99]  Adha Imam Cahyadi,et al.  Path planning and formation control via potential function for UAV Quadrotor , 2014, 2014 International Conference on Advanced Robotics and Intelligent Systems (ARIS).

[100]  Yaonan Wang,et al.  Fuzzy radial basis function neural network PID control system for a quadrotor UAV based on particle swarm optimization , 2015, 2015 IEEE International Conference on Information and Automation.

[101]  N. Marchand,et al.  Event-triggered nonlinear control for attitude stabilization of a quadrotor , 2013, 2013 International Conference on Unmanned Aircraft Systems (ICUAS).

[102]  Alberto Bemporad,et al.  Decentralized Hybrid Model Predictive Control of a Formation of Unmanned Aerial Vehicles , 2011 .

[103]  Kai-Yuan Cai,et al.  Quadrotor aircraft control without velocity measurements , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[104]  Xinhua Wang,et al.  Quad rotor arial robot dynamic modeling and configuration stabilization , 2010, 2010 2nd International Asia Conference on Informatics in Control, Automation and Robotics (CAR 2010).

[105]  Ilia G. Polushin,et al.  Motion Coordination of Thrust-Propelled Underactuated Vehicles in the Presence of Communication Delays , 2014, IFAC Proceedings Volumes.

[106]  Peter Xiaoping Liu,et al.  Robust Control of Four-Rotor Unmanned Aerial Vehicle With Disturbance Uncertainty , 2015, IEEE Transactions on Industrial Electronics.

[107]  M. Heidarian,et al.  Attitude control of VTOL-UAVs , 2012, Proceedings of 2012 UKACC International Conference on Control.

[108]  Mehmet Önder Efe,et al.  Autonomous quadrotor flight with vision-based obstacle avoidance in virtual environment , 2012, Expert Syst. Appl..

[109]  Javier Moreno-Valenzuela,et al.  A New Nonlinear PI/PID Controller for Quadrotor Posture Regulation , 2010, 2010 IEEE Electronics, Robotics and Automotive Mechanics Conference.

[110]  Roland Siegwart,et al.  PID vs LQ control techniques applied to an indoor micro quadrotor , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[111]  Martin Saska,et al.  Motion planning and control of formations of micro aerial vehicles , 2014 .

[112]  J. Kuipers.  Quaternions and Rotation Sequences , 1998 .

[113]  Taeyoung Lee,et al.  Robust Adaptive Attitude Tracking on ${\rm SO}(3)$ With an Application to a Quadrotor UAV , 2013, IEEE Transactions on Control Systems Technology.

[114]  Peter Corke,et al.  Estimation and control for an open-source quadcopter , 2011, ICRA 2011.

[115]  Emanuel Todorov,et al.  Iterative Linear Quadratic Regulator Design for Nonlinear Biological Movement Systems , 2004, ICINCO.

[116]  Herbert Werner,et al.  Robust controller design for formation flight of quad-rotor helicopters , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[117]  Abdelhamid Tayebi,et al.  Attitude stabilization of a VTOL quadrotor aircraft , 2006, IEEE Transactions on Control Systems Technology.

[118]  Vicente Parra-Vega,et al.  Continuous reactive-based position-attitude control of quadrotors , 2012, 2012 American Control Conference (ACC).

[119]  Rogerio A. Enríquez-Caldera,et al.  LQR control for a quadrotor using unit quaternions: Modeling and simulation , 2013, CONIELECOMP 2013, 23rd International Conference on Electronics, Communications and Computing.

[120]  S. Jagannathan,et al.  Neural network control of quadrotor UAV formations , 2009, 2009 American Control Conference.

[121]  H. Jin Kim,et al.  Robust control of a quadrotor using Takagi-Sugeno fuzzy model and an LMI approach , 2014, 2014 14th International Conference on Control, Automation and Systems (ICCAS 2014).

[122]  M. Tadjine,et al.  Sliding Mode Control Based on Backstepping Approach for an UAV Type-Quadrotor , 2007 .

[123]  Claire J. Tomlin,et al.  Quadrotor Helicopter Trajectory Tracking Control , 2008 .