UAVs Trajectory Planning by Distributed MPC under Radio Communication Path Loss Constraints

In this paper, a distributed linear MPC approach to solve the trajectory planning problem for rotary-wing UAVs is proposed, where the objective of the UAV system is to form a communication network to multiple targets with given radio communication capacities. The approach explicitly incorporates constraints on radio communication path losses, computed by using SPLAT! that is able to take into account terrain models and antenna locations. In order to enhance the online optimization, at each time sample the terrain below each UAV and the communication path losses are approximated with linear functions of the spatial coordinates. This leads to linear MPC sub-problems, which are solved by using convex quadratic programming. An algorithm for automatic initialization and optimal reconfiguration of the communication topology in case of failures or severe radio path loss due to e.g. channel fading, is proposed. The communication network that is provided by the UAVs is considered to be a payload communication capacity that is normally independent of the command and control datalink used to control the UAVs. The performance of the distributed linear MPC trajectory planning and the reconfiguration algorithm is studied on two simulation cases with four UAVs and two targets.

[1]  Jonathan P. How,et al.  Real-Time Motion Planning With Applications to Autonomous Urban Driving , 2009, IEEE Transactions on Control Systems Technology.

[2]  Eric W. Frew,et al.  Optimizing Cascaded Chains of Unmanned Aircraft Acting as Communication Relays , 2012, IEEE Journal on Selected Areas in Communications.

[3]  Jonathan P. How,et al.  Cooperative Distributed Robust Trajectory Optimization Using Receding Horizon MILP , 2011, IEEE Transactions on Control Systems Technology.

[4]  Antonios Tsourdos,et al.  Cooperative Path Planning of Unmanned Aerial Vehicles: Tsourdos/Cooperative Path Planning of Unmanned Aerial Vehicles , 2010 .

[5]  Libor Preucil,et al.  Robot Path Planning using Particle Swarm Optimization of Ferguson Splines , 2006, 2006 IEEE Conference on Emerging Technologies and Factory Automation.

[6]  Vijay Kumar,et al.  Motion planning for robust wireless networking , 2012, 2012 IEEE International Conference on Robotics and Automation.

[7]  Patrick Doherty,et al.  Optimal placement of UV-based communications relay nodes , 2010, J. Glob. Optim..

[8]  Richard M. Murray,et al.  Recent Research in Cooperative Control of Multivehicle Systems , 2007 .

[9]  E. Feron,et al.  Real-time motion planning for agile autonomous vehicles , 2000, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[10]  Youdan Kim,et al.  Trajectory optimization for unmanned aerial vehicle formation reconfiguration , 2014 .

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

[12]  Jaime Llorca,et al.  Nature-Inspired Self-Organization, Control, and Optimization in Heterogeneous Wireless Networks , 2012, IEEE Transactions on Mobile Computing.

[13]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[14]  Z. Kan,et al.  Ensuring network connectivity during formation control using a decentralized navigation function , 2010, 2010 - MILCOM 2010 MILITARY COMMUNICATIONS CONFERENCE.

[15]  A. G. Longley,et al.  PREDICTION OF TROPOSPHERIC RADIO TRANSMISSION LOSS OVER IRREGULAR TERRAIN. A COMPUTER METHOD-1968 , 1968 .

[16]  Edsger W. Dijkstra,et al.  A note on two problems in connexion with graphs , 1959, Numerische Mathematik.

[17]  William B. Dunbar,et al.  Distributed receding horizon control for multi-vehicle formation stabilization , 2006, Autom..

[18]  Sven Koenig,et al.  Improved fast replanning for robot navigation in unknown terrain , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[19]  Tor Arne Johansen,et al.  Distributed MPC-Based Path Planning for UAVs under Radio Communication Path Loss Constraints , 2012, CESCIT.

[20]  Tor Arne Johansen,et al.  Cluster-based communication topology selection and UAV path planning in wireless sensor networks , 2013, 2013 International Conference on Unmanned Aircraft Systems (ICUAS).

[21]  Tor Arne Johansen,et al.  Performance evaluation of cooperative relay and Particle Swarm Optimization path planning for UAV and wireless sensor network , 2013, 2013 IEEE Globecom Workshops (GC Wkshps).

[22]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Autonomous Robot Vehicles.

[23]  M. Shanmugavel,et al.  Cooperative Path Planning of Unmanned Aerial Vehicles , 2010 .

[24]  Emilio Frazzoli,et al.  Real-Time Motion Planning for Agile Autonomous Vehicles , 2000 .

[25]  Tor Arne Johansen,et al.  Path Planning for UAVs Under Communication Constraints Using SPLAT! and MILP , 2012, J. Intell. Robotic Syst..

[26]  Anthony Stentz,et al.  The Focussed D* Algorithm for Real-Time Replanning , 1995, IJCAI.

[27]  Salah Sukkarieh,et al.  Multi-UAV target search using explicit decentralized gradient-based negotiation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[28]  Sean R Eddy,et al.  What is dynamic programming? , 2004, Nature Biotechnology.

[29]  David Gelperin,et al.  The optimality of A , 1988 .

[30]  R.M. Murray,et al.  Motion planning with wireless network constraints , 2005, Proceedings of the 2005, American Control Conference, 2005..

[31]  Zhu Han,et al.  Optimization of MANET connectivity via smart deployment/movement of unmanned air vehicles , 2009, IEEE Transactions on Vehicular Technology.

[32]  Vijay Kumar,et al.  Control of Ensembles of Aerial Robots , 2011, Proceedings of the IEEE.

[33]  Sebastian Thrun,et al.  Anytime Dynamic A*: An Anytime, Replanning Algorithm , 2005, ICAPS.

[34]  Tor Arne Johansen,et al.  Distributed Path Planning for a UAV Communication Chain by Dual Decomposition , 2012 .

[35]  Alejandro Ribeiro,et al.  Adaptive Communication-Constrained Deployment of Unmanned Vehicle Systems , 2012, IEEE Journal on Selected Areas in Communications.

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

[37]  S. Milner,et al.  Autonomous reconfiguration and control in directional mobile ad hoc networks , 2009, IEEE Circuits and Systems Magazine.

[38]  Wei Ren,et al.  Information consensus in multivehicle cooperative control , 2007, IEEE Control Systems.

[39]  Lakhmi C. Jain,et al.  Multiple UAVs path planning algorithms: a comparative study , 2008, Fuzzy Optim. Decis. Mak..

[40]  Anders Rantzer,et al.  Distributed Model Predictive Control with suboptimality and stability guarantees , 2010, 49th IEEE Conference on Decision and Control (CDC).

[41]  Sebastian Thrun,et al.  ARA*: Anytime A* with Provable Bounds on Sub-Optimality , 2003, NIPS.

[42]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[43]  Tor Arne Johansen,et al.  Task assignment for cooperating UAVs under radio propagation path loss constraints , 2012, 2012 American Control Conference (ACC).

[44]  Magnus Egerstedt,et al.  Graph Theoretic Methods in Multiagent Networks , 2010, Princeton Series in Applied Mathematics.

[45]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[46]  Tor Arne Johansen,et al.  Path- and data transmission planning for cooperating UAVs in delay tolerant network , 2012, 2012 IEEE Globecom Workshops.

[47]  Nils J. Nilsson,et al.  A Formal Basis for the Heuristic Determination of Minimum Cost Paths , 1968, IEEE Trans. Syst. Sci. Cybern..

[48]  Zhaodan Kong,et al.  A Survey of Motion Planning Algorithms from the Perspective of Autonomous UAV Guidance , 2010, J. Intell. Robotic Syst..

[49]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[50]  Emmanuel G. Collins,et al.  Motion Planning for Mobile Robots Via Sampling-Based Model Predictive Optimization , 2011 .

[51]  James Kennedy,et al.  Particle swarm optimization , 2002, Proceedings of ICNN'95 - International Conference on Neural Networks.

[52]  Timothy W. McLain,et al.  Small Unmanned Aircraft: Theory and Practice , 2012 .

[53]  Li Wei A Guide to Heuristic-based Path Planning , 2006 .

[54]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[55]  Warren E. Dixon,et al.  Optimizing network topology to reduce aggregate traffic in a system of mobile robots under an energy constraint , 2012, 2012 IEEE International Conference on Communications (ICC).

[56]  Jaime Llorca,et al.  Autonomous Autonomous econfiguration and Reconfiguration and Control in Directional Control in Directional Mobile Ad Hoc Networks Mobile Ad Hoc Networks , 2009 .

[57]  Thierry Siméon,et al.  Sampling-Based Path Planning on Configuration-Space Costmaps , 2010, IEEE Transactions on Robotics.

[58]  Juan Cort Sampling-Based Path Planning on Configuration-Space Costmaps , 2010 .

[59]  Karl Henrik Johansson,et al.  Decentralized connectivity maintenance in mobile networks with bounded inputs , 2008, 2008 IEEE International Conference on Robotics and Automation.