Decentralized MPC based Obstacle Avoidance for Multi-Robot Target Tracking Scenarios

Ahstract- In this work, we consider the problem of decentralized multi-robot target tracking and obstacle avoidance in dynamic environments. Each robot executes a local motion planning algorithm which is based on model predictive control (MPC). The planner is designed as a quadratic program, subject to constraints on robot dynamics and obstacle avoidance. Repulsive potential field functions are employed to avoid obstacles. The novelty of our approach lies in embedding these non-linear potential field functions as constraints within a convex optimization framework. Our method convexifies nonconvex constraints and dependencies, by replacing them as pre-computed external input forces in robot dynamics. The proposed algorithm additionally incorporates different methods to avoid field local minima problems associated with using potential field functions in planning. The motion planner does not enforce predefined trajectories or any formation geometry on the robots and is a comprehensive solution for cooperative obstacle avoidance in the context of multi-robot target tracking. We perform simulation studies for different scenarios to showcase the convergence and efficacy of the proposed algorithm.

[1]  António Paulo Moreira,et al.  Multi-Robot nonlinear model predictive formation control: the obstacle avoidance problem , 2014, Robotica.

[2]  André Dias,et al.  Formation control driven by cooperative object tracking , 2015, Robotics Auton. Syst..

[3]  Dinesh Manocha,et al.  Reciprocal n-Body Collision Avoidance , 2011, ISRR.

[4]  Zhou Chao,et al.  Collision-free UAV formation flight control based on nonlinear MPC , 2011, 2011 International Conference on Electronics, Communications and Control (ICECC).

[5]  Vijay Kumar,et al.  Towards a swarm of agile micro quadrotors , 2012, Robotics: Science and Systems.

[6]  Paul A. Beardsley,et al.  Collision avoidance for aerial vehicles in multi-agent scenarios , 2015, Auton. Robots.

[7]  Fumitoshi Matsuno,et al.  Model Predictive Formation Control Using Branch-and-Bound Compatible With Collision Avoidance Problems , 2013, IEEE Transactions on Robotics.

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

[9]  Hugh H. T. Liu,et al.  Cooperative Tracking a Moving Target Using Multiple Fixed-wing UAVs , 2016, J. Intell. Robotic Syst..

[10]  Gaurav S. Sukhatme,et al.  Cooperative Control for Target Tracking with Onboard Sensing , 2014, ISER.

[11]  Yoram Koren,et al.  Potential field methods and their inherent limitations for mobile robot navigation , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[12]  Paolo Fiorini,et al.  Motion Planning in Dynamic Environments Using Velocity Obstacles , 1998, Int. J. Robotics Res..

[13]  Andreas Zell,et al.  Robust nonlinear control approach to nontrivial maneuvers and obstacle avoidance for quadrotor UAV under disturbances , 2017, Robotics Auton. Syst..

[14]  Pedro U. Lima,et al.  An Online Scalable Approach to Unified Multirobot Cooperative Localization and Object Tracking , 2017, IEEE Transactions on Robotics.

[15]  Jia Pan,et al.  Deep-Learned Collision Avoidance Policy for Distributed Multiagent Navigation , 2016, IEEE Robotics and Automation Letters.

[16]  R. Olfati-Saber,et al.  Collision avoidance for multiple agent systems , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[17]  Heinrich H. Bülthoff,et al.  Deep Neural Network-Based Cooperative Visual Tracking Through Multiple Micro Aerial Vehicles , 2018, IEEE Robotics and Automation Letters.

[18]  Taeyoung Lee,et al.  Geometric tracking control of a quadrotor UAV on SE(3) , 2010, 49th IEEE Conference on Decision and Control (CDC).

[19]  A. Matveev,et al.  Algorithms for collision-free navigation of mobile robots in complex cluttered environments: a survey , 2014, Robotica.

[20]  Antonio Franchi,et al.  Bilateral control of the degree of connectivity in multiple mobile-robot teleoperation , 2013, 2013 IEEE International Conference on Robotics and Automation.

[21]  Javier Alonso-Mora,et al.  Multi-robot navigation in formation via sequential convex programming , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[22]  Soon-Jo Chung,et al.  Swarm Assignment and Trajectory Optimization Using Variable-Swarm, Distributed Auction Assignment and Model Predictive Control , 2015 .

[23]  Angela P. Schoellig,et al.  Generation of collision-free trajectories for a quadrocopter fleet: A sequential convex programming approach , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  António Paulo Moreira,et al.  Nonlinear Model Predictive Formation Control: An Iterative Weighted Tuning Approach , 2015, J. Intell. Robotic Syst..

[25]  Marcelo G. S. Bruno,et al.  Cooperative Target Tracking Using Decentralized Particle Filtering and RSS Sensors , 2013, IEEE Transactions on Signal Processing.

[26]  Stephen P. Boyd,et al.  CVXGEN: a code generator for embedded convex optimization , 2011, Optimization and Engineering.

[27]  John R. Spletzer,et al.  Convex Optimization Strategies for Coordinating Large-Scale Robot Formations , 2007, IEEE Transactions on Robotics.

[28]  Lorenz T. Biegler,et al.  Dynamic Optimization Strategies for Three-Dimensional Conflict Resolution of Multiple Aircraft , 2004 .