Collision-free UAV formation flight control based on nonlinear MPC

A collision-free formation flight controller for unmanned aerial vehicle (UAV) is designed in the framework of nonlinear model predictive control (MPC). It can consider control input saturation and state constraints explicitly. Formation configuration is determined based on virtual reference point method, which has no error propagation in the formation. The formation flight controller is designed in a distributed way. Based on the tracking error, the objective function for each UAV is designed in the nonlinear MPC framework. A new type of cost function, based on the UAV's velocity orientation and relative distance between UAV and obstacle, is added to the objective function to guarantee obstacle avoidance. Inter-vehicle collision avoidance is also ensured by cost function combined with a priority strategy. The nonlinear optimization problem is solved by the filter-SQP method, which has the better convergence and numeric. Simulation results are provided to evaluate the performance of the designed collision-free formation flight controller.

[1]  YangQuan Chen,et al.  Leaderless Formation Control for Multiple Autonomous Vehicles , 2006 .

[2]  Randal W. Beard,et al.  A decentralized approach to formation maneuvers , 2003, IEEE Trans. Robotics Autom..

[3]  Tiauw Hiong Go,et al.  Formation Flight Control Using Model Predictive Approach , 2009 .

[4]  Wei Ren,et al.  On Constrained Nonlinear Tracking Control of a Small Fixed-wing UAV , 2007, J. Intell. Robotic Syst..

[5]  Tiauw Hiong Go,et al.  3- D Formulation of Formation Flight Based on Model Predictive Control with Collision Avoidance Scheme , 2010 .

[6]  William B. Dunbar,et al.  Model predictive control of coordinated multi-vehicle formations , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[7]  John D'Azzo,et al.  Close formation flight control , 1999 .

[8]  Sven Leyffer,et al.  Nonlinear programming without a penalty function , 2002, Math. Program..

[9]  Jurek Z. Sasiadek,et al.  NONLINEAR CONTROL FOR UAV FORMATION FLYING , 2008 .

[10]  Jonathan P. How,et al.  Model predictive control of vehicle maneuvers with guaranteed completion time and robust feasibility , 2003, Proceedings of the 2003 American Control Conference, 2003..

[11]  Yeonsik Kang,et al.  Formation control of leader following unmanned ground vehicles using nonlinear model predictive control , 2009, 2009 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[12]  Randal W. Beard,et al.  A decentralized scheme for spacecraft formation flying via the virtual structure approach , 2003, Proceedings of the 2003 American Control Conference, 2003..

[13]  F. Borrelli,et al.  Collision-free UAV formation flight using decentralized optimization and invariant sets , 2004, 2004 43rd IEEE Conference on Decision and Control (CDC) (IEEE Cat. No.04CH37601).

[14]  Derek James Bennet,et al.  Three -Dimensional Formation Flying Using Bifurcating Potential Fields , 2009 .

[15]  J.T. Gravdahl,et al.  UAV formation flight using 3D potential field , 2008, 2008 16th Mediterranean Conference on Control and Automation.

[16]  Prabhakar R. Pagilla,et al.  Distributed Formation Flight Control Using Constraint Forces , 2009 .

[17]  F. Giulietti,et al.  Formation Control Laws for Autonomous Flight Vehicles , 2006, 2006 14th Mediterranean Conference on Control and Automation.

[18]  J.K. Hedrick,et al.  An overview of emerging results in cooperative UAV control , 2004, 2004 43rd IEEE Conference on Decision and Control (CDC) (IEEE Cat. No.04CH37601).

[19]  Maarouf Saad,et al.  Formation path following control of unicycle-type mobile robots , 2008, 2008 IEEE International Conference on Robotics and Automation.

[20]  Haibin Duan,et al.  Receding horizon control for multi-UAVs close formation control based on differential evolution , 2010, Science China Information Sciences.

[21]  Anthony J. Calise,et al.  An Adaptive Vision-Based Approach to Decentralized Formation Control , 2004, J. Aerosp. Comput. Inf. Commun..

[22]  F. Borrelli,et al.  A study on decentralized receding horizon control for decoupled systems , 2004, Proceedings of the 2004 American Control Conference.

[23]  Rafael Fierro,et al.  A dual-mode model predictive controller for robot formations , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[24]  Yuri B. Shtessel,et al.  UAV Formations Control Using High Order Sliding Modes , 2005 .

[25]  David Q. Mayne,et al.  Constrained model predictive control: Stability and optimality , 2000, Autom..

[26]  H. Jin Kim,et al.  Nonlinear Model Predictive Formation Flight , 2009, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[27]  Erfu Yang,et al.  A suboptimal model predictive formation control , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  K. D. Do,et al.  Nonlinear formation control of unicycle-type mobile robots , 2007, Robotics Auton. Syst..

[29]  A. Richards,et al.  A decentralized algorithm for robust constrained model predictive control , 2004, Proceedings of the 2004 American Control Conference.

[30]  A. Richards,et al.  Decentralized model predictive control of cooperating UAVs , 2004, 2004 43rd IEEE Conference on Decision and Control (CDC) (IEEE Cat. No.04CH37601).