Distributed Optimization with Pairwise Constraints and its Application to Multi-robot Path Planning

Distributed approaches to constrained optimization problems have immense applications to multi-robot path planning, scheduling, task allocation and other problems requiring multiple robots to optimize a global objective function. The aim of these approaches is to solve a series of smaller optimization problems for each robot while sharing information among the robots, and in the process, solve the global optimization problem, which otherwise would have been intractable. Distributed approaches to separable convex optimization problems with linear constraints have been studied extensively in the past using techniques of dual and Lagrangian decomposition. In the present work, we investigate a distributed implementation of a general separable optimization problem with pair-wise non-linear constraints. On the theoretical side, we show the conditions under which the algorithm converges to an optimal solution. On the experimental side, we demonstrate the utility of the algorithm on the problem of multi-robot path planning with pair-wise distance constraints in large complex 2-D environments with obstacles.

[1]  John N. Tsitsiklis,et al.  Parallel and distributed computation , 1989 .

[2]  Vijay Kumar,et al.  An Optimization-based Approach to Time Critical Cooperative Surveillance and Coverage with Unmanned Aerial Vehicles , 2006 .

[3]  Dima Grigoriev,et al.  Polytime algorithm for the shortest path in a homotopy class amidst semi-algebraic obstacles in the plane , 1998, ISSAC '98.

[4]  Dimitri P. Bertsekas,et al.  Dynamic Programming and Optimal Control, Two Volume Set , 1995 .

[5]  M. Likhachev,et al.  Distributed Path Consensus Algorithm , 2010 .

[6]  Vijay Kumar,et al.  Modeling and control of formations of nonholonomic mobile robots , 2001, IEEE Trans. Robotics Autom..

[7]  Kostas J. Kyriakopoulos,et al.  Closed loop navigation for multiple holonomic vehicles , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Vijay Kumar,et al.  Cooperative Control of UAVs for Search and Coverage , 2006 .

[9]  J. Suykens,et al.  Interior-Point Lagrangian Decomposition Method for Separable Convex Optimization , 2009, 1302.3136.

[10]  Ali-akbar Agha-mohammadi,et al.  Motion Planning Under Uncertainty , 2012 .

[11]  Diego A. Murio,et al.  The Mollification Method and the Numerical Solution of Ill-Posed Problems , 1993 .

[12]  Edmund H. Durfee,et al.  Distributed Problem Solving and Planning , 2001, EASSS.

[13]  Stephen P. Boyd,et al.  Distributed estimation via dual decomposition , 2007, 2007 European Control Conference (ECC).

[14]  Nidhi Kalra,et al.  Market-Based Multirobot Coordination: A Survey and Analysis , 2006, Proceedings of the IEEE.

[15]  Stephen P. Boyd,et al.  Convex Optimization , 2004, Algorithms and Theory of Computation Handbook.