Decentralized H2 observers for position and velocity estimation in vehicle formations with fixed topologies

Abstract This paper addresses the problem of decentralized state estimation in fixed topology formations of vehicles with applications to Autonomous Underwater Vehicles (AUVs). In the envisioned scenario, each vehicle in the formation estimates its own state relying only on locally available measurements and data communicated by neighboring agents, requiring lower computational and communication loads than centralized solutions. A method for designing local state observers featuring global error dynamics that converge globally asymptotically to zero is detailed, and an algorithm for improving its performance under stochastic disturbances and Gaussian uncertainties is presented. The proposed algorithm minimizes the H 2 norm of the global estimation error dynamics, expressed as an optimization problem subject to Bilinear Matrix Inequality (BMI) constraints. To assess the performance of the solution, realistic simulation results are presented and discussed for several formation topologies.

[1]  A. Jazwinski.  Stochastic Processes and Filtering Theory , 1970 .

[2]  Carlos Silvestre,et al.  Position USBL/DVL sensor-based navigation filter in the presence of unknown ocean currents , 2011, Autom..

[3]  Carlos Silvestre,et al.  A Sensor-based Long Baseline Position and Velocity Navigation Filter for Underwater Vehicles , 2010 .

[4]  Carlos Silvestre,et al.  Position and velocity optimal sensor-based navigation filters for UAVs , 2009, 2009 American Control Conference.

[5]  Joao P. Hespanha,et al.  Estimation and control with relative measurements: algorithms and scaling laws , 2007 .

[6]  Carlos Silvestre,et al.  Decentralized Linear Motion Estimators for AUV Formations with Fixed Topologies , 2011 .

[7]  Vijay Kumar,et al.  Leader-to-formation stability , 2004, IEEE Transactions on Robotics and Automation.

[8]  Carlos Silvestre,et al.  Single range aided navigation and source localization: Observability and filter design , 2011, Syst. Control. Lett..

[9]  Herbert G. Tanner,et al.  Decentralized cooperative control of heterogeneous vehicle groups , 2007, Robotics Auton. Syst..

[10]  J. G. Bender,et al.  An overview of systems studies of automated highway systems , 1991 .

[11]  Richard M. Murray,et al.  Feedback Systems An Introduction for Scientists and Engineers , 2007 .

[12]  W. Wallis.  A Beginner's Guide to Graph Theory , 2000 .

[14]  Ye Yuan,et al.  Sensor Graphs for Guaranteed Cooperative Localization Performance , 2010, Control. Intell. Syst..

[15]  Bengt Lennartson,et al.  Low order multicriteria /spl Hscr//sub /spl infin// design via bilinear matrix inequalities , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[16]  Mario Innocenti,et al.  Autonomous formation flight , 2000 .

[17]  Carlos Silvestre,et al.  Optimal position and velocity navigation filters for autonomous vehicles , 2010, Autom..

[18]  Jason L. Speyer,et al.  Decentralized controllers for unmanned aerial vehicle formation flight , 1996 .

[19]  C. Scherer,et al.  Linear Matrix Inequalities in Control , 2011 .

[20]  M. Sain.  Finite dimensional linear systems , 1972 .

[21]  Paulo Oliveira,et al.  Joint Positioning and Navigation Aiding Systems for Multiple Underwater Robots , 2009 .

[22]  Youxian Sun,et al.  Output feedback decentralized stabilization: ILMI approach , 1998 .

[23]  J. A. Fax.  Optimal and Cooperative Control of Vehicle Formations , 2002 .

[24]  Richard H. Middleton,et al.  String Instability in Classes of Linear Time Invariant Formation Control With Limited Communication Range , 2010, IEEE Transactions on Automatic Control.

[25]  Bonnie Berger,et al.  Approximation alogorithms for the maximum acyclic subgraph problem , 1990, SODA '90.

[26]  O. Toker,et al.  On the NP-hardness of solving bilinear matrix inequalities and simultaneous stabilization with static output feedback , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[27]  A. J. Healey,et al.  Application of formation control for multi-vehicle robotic minesweeping , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

[28]  D. West.  Introduction to Graph Theory , 1995 .

[29]  Ιωαννησ Τσιτσικλησ,et al.  PROBLEMS IN DECENTRALIZED DECISION MAKING AND COMPUTATION , 1984 .

[30]  J. Bellingham,et al.  Autonomous Oceanographic Sampling Networks , 1993 .