A Distributed Model Predictive Control Strategy for Constrained Multi-Vehicle Systems Moving in Unknown Environments

In this paper, we propose a distributed model predictive control strategy for a team of vehicles moving in an unknown obstacle scenario. In particular, we combine receding horizon control arguments with leader-follower formations in order to design a flexible architecture where the vehicle topology, if needed, can be rearranged to better cope with the presence of obstacles. Each vehicle is equipped with an ad-hoc dual-mode controller in charge of tracking along the leader-follower chain the predecessor vehicle (namely the target for the leader) and ensuring absence of collisions. Moreover, whenever the leader recognizes that the obstacle scenario obstructs its navigation, the current formation is properly reconfigured by preserving recursive feasibility and obstacle avoidance properties. Final numerical results on a team of seven point mobile robots are instrumental to show the main features of the proposed distributed model predictive control algorithm.

[1]  Kuo-Lan Su,et al.  Multi-robot-based intelligent security system , 2011, Artificial Life and Robotics.

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

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

[4]  Karl Berntorp,et al.  Positive Invariant Sets for Safe Integrated Vehicle Motion Planning and Control , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[5]  Christoph Stiller,et al.  Automated Driving in Uncertain Environments: Planning With Interaction and Uncertain Maneuver Prediction , 2018, IEEE Transactions on Intelligent Vehicles.

[6]  Frank L. Lewis,et al.  Leader-to-Formation Stability of Multiagent Systems: An Adaptive Optimal Control Approach , 2018, IEEE Transactions on Automatic Control.

[7]  Panagiotis D. Christofides,et al.  Distributed model predictive control: A tutorial review and future research directions , 2013, Comput. Chem. Eng..

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

[9]  Rüdiger Dillmann,et al.  Learning Driver Behavior Models from Traffic Observations for Decision Making and Planning , 2015, IEEE Intelligent Transportation Systems Magazine.

[10]  Domitilla Del Vecchio,et al.  Least Restrictive Supervisors for Intersection Collision Avoidance: A Scheduling Approach , 2015, IEEE Transactions on Automatic Control.

[11]  Camillo J. Taylor,et al.  A vision-based formation control framework , 2002, IEEE Trans. Robotics Autom..

[12]  Randal W. Beard,et al.  A decentralized scheme for spacecraft formation flying via the virtual structure approach , 2003, Proceedings of the 2003 American Control Conference, 2003..

[13]  Kar-Han Tan,et al.  High Precision Formation Control of Mobile Robots Using Virtual Structures , 1997, Auton. Robots.

[14]  John Dahl,et al.  Collision Avoidance: A Literature Review on Threat-Assessment Techniques , 2019, IEEE Transactions on Intelligent Vehicles.

[15]  Hossein Nourkhiz Mahjoub,et al.  A Learning-Based Stochastic MPC Design for Cooperative Adaptive Cruise Control to Handle Interfering Vehicles , 2018, IEEE Transactions on Intelligent Vehicles.

[16]  Zhiyong Sun,et al.  A General Approach to Coordination Control of Mobile Agents With Motion Constraints , 2018, IEEE Transactions on Automatic Control.

[17]  Aníbal Ollero,et al.  Distributed Service-Based Cooperation in Aerial/Ground Robot Teams Applied to Fire Detection and Extinguishing Missions , 2010, Adv. Robotics.

[18]  Libor Preucil,et al.  Coordination and navigation of heterogeneous MAV–UGV formations localized by a ‘hawk-eye’-like approach under a model predictive control scheme , 2014, Int. J. Robotics Res..

[19]  Matthias Althoff,et al.  Set-Based Prediction of Traffic Participants on Arbitrary Road Networks , 2016, IEEE Transactions on Intelligent Vehicles.

[20]  Petter Ögren,et al.  A control Lyapunov function approach to multi-agent coordination , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

[21]  Norihiro Hagita,et al.  Robotic service coordination for elderly people and caregivers with Ubiquitous Network Robot Platform , 2013, 2013 IEEE Workshop on Advanced Robotics and its Social Impacts.

[22]  Wilfried Sihn,et al.  Roadmapping towards industrial digitalization based on an Industry 4.0 maturity model for manufacturing enterprises , 2019, Procedia CIRP.

[23]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[24]  Lihua Xie,et al.  A New Distributed Model Predictive Control for Unconstrained Double-Integrator Multiagent Systems , 2018, IEEE Transactions on Automatic Control.

[25]  Francesco Borrelli,et al.  Stochastic predictive control for semi-autonomous vehicles with an uncertain driver model , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

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

[27]  M Lega,et al.  Remote sensing in environmental police investigations: aerial platforms and an innovative application of thermography to detect several illegal activities , 2014, Environmental Monitoring and Assessment.

[28]  Baocang Ding,et al.  Distributed RHC for Tracking and Formation of Nonholonomic Multi-Vehicle Systems , 2014, IEEE Transactions on Automatic Control.

[29]  William B. Dunbar,et al.  Distributed Receding Horizon Control of Vehicle Platoons: Stability and String Stability , 2012, IEEE Transactions on Automatic Control.

[30]  Lino Marques,et al.  Robots for Environmental Monitoring: Significant Advancements and Applications , 2012, IEEE Robotics & Automation Magazine.

[31]  Walter Lucia,et al.  A Hybrid Command Governor Scheme for Rotary Wings Unmanned Aerial Vehicles , 2020, IEEE Transactions on Control Systems Technology.

[32]  Michael Defoort,et al.  Cooperation mechanisms in multi-agent robotic systems and their use in distributed manufacturing control: Issues and literature review , 2014, IECON 2014 - 40th Annual Conference of the IEEE Industrial Electronics Society.

[33]  Stephen P. Boyd,et al.  Distributed Optimization and Statistical Learning via the Alternating Direction Method of Multipliers , 2011, Found. Trends Mach. Learn..

[34]  Seng W. Loke,et al.  Cooperative Automated Vehicles: A Review of Opportunities and Challenges in Socially Intelligent Vehicles Beyond Networking , 2017, IEEE Transactions on Intelligent Vehicles.

[35]  Alaa M. Khamis,et al.  Minefield Mapping Using Cooperative Multirobot Systems , 2012, J. Robotics.

[36]  Anne Verroust-Blondet,et al.  Attention Based Vehicle Trajectory Prediction , 2020, IEEE Transactions on Intelligent Vehicles.

[37]  Alessandro Casavola,et al.  Robust fault detection of uncertain linear systems via quasi-LMIs , 2005, Proceedings of the 2005, American Control Conference, 2005..

[38]  Hyo-Sung Ahn,et al.  A survey of multi-agent formation control , 2015, Autom..

[39]  Jonas Sjöberg,et al.  Predictive Threat Assessment via Reachability Analysis and Set Invariance Theory , 2011, IEEE Transactions on Intelligent Transportation Systems.

[40]  Alejandro Ribeiro,et al.  Navigation Functions for Convex Potentials in a Space With Convex Obstacles , 2016, IEEE Transactions on Automatic Control.

[41]  Maki K. Habib,et al.  The Pemex-B autonomous demining robot: perception and navigation strategies , 1995, Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots.

[42]  Walter Lucia,et al.  Multi-vehicle formation control in uncertain environments , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[43]  Yurii Nesterov,et al.  Interior-point polynomial algorithms in convex programming , 1994, Siam studies in applied mathematics.

[44]  David Q. Mayne,et al.  Control of Constrained Dynamic Systems , 2001, Eur. J. Control.

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

[46]  Maja J. Mataric,et al.  Territorial multi-robot task division , 1998, IEEE Trans. Robotics Autom..