Distributed Robust Receding Horizon Control for Multivehicle Guidance

This paper presents a new distributed robust model predictive control algorithm for multivehicle trajectory optimization and demonstrates the approach with numerical simulations and multivehicle experiments. The technique builds on the robust-safe-but-knowledgeable (RSBK) algorithm, which is developed in this paper for the multivehicle case. RSBK uses constraint tightening to achieve robustness to external disturbances, an invariant set to ensure safety in the presence of changes to the environment, and a cost-to-go function to generate an intelligent trajectory around known obstacles. The key advantage of this RSBK algorithm is that it enables the use of much shorter planning horizons while still preserving the robust feasibility guarantees of previously proposed approaches. The second contribution of this paper is a distributed version of the RSBK algorithm, which is more suitable for real-time execution. In the distributed RSBK (DRSBK) algorithm, each vehicle only optimizes for its own decisions by solving a subproblem of reduced size, which results in shorter computation times. Furthermore, the algorithm retains the robust feasibility guarantees of the centralized approach while requiring that each agent only have local knowledge of the environment and neighbor vehicles' plans. This new approach also facilitates the use of a significantly more general implementation architecture for the distributed trajectory optimization, which further decreases the delay due to computation time.

[1]  Yoshiaki Kuwata,et al.  Three Dimensional Receding Horizon Control for UAVs , 2004 .

[2]  Chung Tin,et al.  Robust multi-UAV planning in dynamic and uncertain environments , 2004 .

[3]  Jonathan P. How,et al.  A New Nonlinear Guidance Logic for Trajectory Tracking , 2004 .

[4]  Claire J. Tomlin,et al.  DECENTRALIZED OPTIMIZATION VIA NASH BARGAINING , 2004 .

[5]  S. Shankar Sastry,et al.  Decentralized nonlinear model predictive control of multiple flying robots , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[6]  Steven Skiena,et al.  Implementing discrete mathematics - combinatorics and graph theory with Mathematica , 1990 .

[7]  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..

[8]  Stephen J. Wright,et al.  Plant-Wide Optimal Control with Decentralized MPC , 2004 .

[9]  E. Kerrigan Robust Constraint Satisfaction: Invariant Sets and Predictive Control , 2000 .

[10]  J. Löfberg Minimax approaches to robust model predictive control , 2003 .

[11]  Marios M. Polycarpou,et al.  COOPERATIVE PATH-PLANNING FOR AUTONOMOUS VEHICLES USING DYNAMIC PROGRAMMING , 2002 .

[12]  J. Primbs The analysis of optimization based controllers , 2001, Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251).

[13]  Ilya Kolmanovsky,et al.  Maximal output admissible sets for discrete-time systems with disturbance inputs , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[14]  J. Maciejowski,et al.  Robust feasibility in model predictive control: necessary and sufficient conditions , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

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

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

[17]  Jan M. Maciejowski,et al.  Predictive control : with constraints , 2002 .

[18]  Arthur G. Richards,et al.  Robust constrained model predictive control , 2005 .

[19]  Jonathan P. How,et al.  Receding horizon control of autonomous aerial vehicles , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[20]  Manfred Morari,et al.  Robust constrained model predictive control using linear matrix inequalities , 1994, Proceedings of 1994 American Control Conference - ACC '94.

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

[22]  Yoshiaki Kuwata,et al.  Robust Constrained Receding Horizon Control for Trajectory Planning , 2005 .

[23]  D. Jia,et al.  Min-max feedback model predictive control for distributed control with communication , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[24]  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).

[25]  D. Mayne,et al.  Min-max feedback model predictive control for constrained linear systems , 1998, IEEE Trans. Autom. Control..

[26]  Eduardo Camponogara,et al.  Distributed Model Predictive Control: Synchronous and Asynchronous Computation , 2007, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[27]  Luigi Chisci,et al.  Systems with persistent disturbances: predictive control with restricted constraints , 2001, Autom..

[28]  Mark B. Milam,et al.  A new computational approach to real-time trajectory generation for constrained mechanical systems , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[29]  Eduardo Camponogara,et al.  Distributed model predictive control , 2002 .

[30]  J. How,et al.  Receding horizon path planning with implicit safety guarantees , 2004, Proceedings of the 2004 American Control Conference.

[31]  Y. Kuwata,et al.  Stable trajectory design for highly constrained environments using receding horizon control , 2004, Proceedings of the 2004 American Control Conference.

[32]  Manfred Morari,et al.  An improved approach for constrained robust model predictive control , 2002, Autom..

[33]  Eric Feron,et al.  Decentralized Cooperative Trajectory Planning of Multiple Aircraft with Hard Safety Guarantees , 2004 .

[34]  Edoardo Mosca,et al.  Min-max predictive control strategies for input-saturated polytopic uncertain systems , 2000, Autom..