Hierarchical Model Predictive Control for Autonomous Vehicle Area Coverage

Abstract Area coverage using autonomous vehicles receives increasing attention due to a widespread range of possible applications. Examples are surveillance and monitoring tasks or search and rescue missions. Efficient and safe area coverage in dynamic environments, however, is challenging. It requires tight integration of the planning and control task to guarantee collision avoidance and optimal coverage. We propose a combination of two coupled model predictive controllers for optimal area coverage with dynamic obstacle avoidance. The planning is based on a mixed integer programming formulation of the predictive controller. It allows to take dynamic objects, such as other autonomous vehicles into account and considers a simplified dynamic model of the autonomous vehicle. The autonomous vehicle itself is controlled by a continuous time nonlinear model predictive path following controller, which obeys detailed dynamic and kinematic constraints and follows the provided path. The design of the controllers takes the interconnections in terms of dynamic constraints and reference definitions between them into account. Simulation results for a quadcopter illustrate the performance and real-time feasibility of the proposed hierarchical predictive control strategy.

[1]  Rolf Findeisen,et al.  Nonlinear Model Predictive Control for Constrained Output Path Following , 2015, IEEE Transactions on Automatic Control.

[2]  Chun-Liang Lin,et al.  On the Complete Coverage Path Planning for Mobile Robots , 2014, J. Intell. Robotic Syst..

[3]  Ioannis M. Rekleitis,et al.  Optimal complete terrain coverage using an Unmanned Aerial Vehicle , 2011, 2011 IEEE International Conference on Robotics and Automation.

[4]  Samuel C. Pinto,et al.  Risk Constrained Navigation Using MILP-MPC Formulation , 2017 .

[5]  Frank Allgöwer,et al.  An Introduction to Nonlinear Model Predictive Control , 2002 .

[6]  Johan Löfberg,et al.  YALMIP : a toolbox for modeling and optimization in MATLAB , 2004 .

[7]  Marc Carreras,et al.  A survey on coverage path planning for robotics , 2013, Robotics Auton. Syst..

[8]  Moritz Diehl,et al.  ACADO toolkit—An open‐source framework for automatic control and dynamic optimization , 2011 .

[9]  Stefano Di Cairano,et al.  Contract-based Predictive Control for Modularity in Hierarchical Systems , 2018 .

[10]  Goldie Nejat,et al.  Robotic Urban Search and Rescue: A Survey from the Control Perspective , 2013, J. Intell. Robotic Syst..

[11]  Arthur Richards Flight Optimization for an Agricultural Unmanned Air Vehicle , 2018, 2018 European Control Conference (ECC).

[12]  Raffaello D'Andrea,et al.  Iterative MILP methods for vehicle-control problems , 2005, IEEE Transactions on Robotics.

[13]  Xu Miao,et al.  Scalable Coverage Path Planning for Cleaning Robots Using Rectangular Map Decomposition on Large Environments , 2018, IEEE Access.

[14]  Jonathan P. How,et al.  Model predictive control of vehicle maneuvers with guaranteed completion time and robust feasibility , 2003, Proceedings of the 2003 American Control Conference, 2003..

[15]  Jonathan P. How,et al.  Aircraft trajectory planning with collision avoidance using mixed integer linear programming , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[16]  Ella M. Atkins,et al.  Optimal coverage trajectories for a UGV with tradeoffs for energy and time , 2014, Auton. Robots.