Real-time model predictive control for keeping a quadrotor visible on the camera field-of-view of a ground robot

This paper considers a cooperative control design for an aerial/ground robot system, and addresses the problem of maintaining visibility of a quadrotor within the camera field-of-view of a ground robot in the presence of external disturbances. The quadrotor needs to be tracked by the ground robot with a monocular camera, and hence its motion should facilitate the ground vision-based tracking process by remaining in the effective camera sensing area. We design a model predictive controller (MPC) strategy where the visibility constraints of the camera and the control input constraints of the quadrotor are encoded into the cost function via barrier functions, and we adopt a fast MPC solver that is able to solve the optimization problem in real time. We also propose a method to enhance the robustness of the algorithm by suitably defining a restart method for the MPC solver. The applicability of the proposed algorithm is demonstrated through simulations and experimental results on real setups.

[1]  Martin Saska,et al.  Motion planning and control of formations of micro aerial vehicles , 2014 .

[2]  Roland Siegwart,et al.  Full control of a quadrotor , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Vijay Kumar,et al.  Cooperative air and ground surveillance , 2006, IEEE Robotics & Automation Magazine.

[4]  E. Kerrigan,et al.  A Warm-start Interior-point Method for Predictive Control , 2010 .

[5]  John Bagterp Jørgensen,et al.  A primal-dual interior-point linear programming algorithm for MPC , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[6]  Jonathan P. How,et al.  Distributed Robust Receding Horizon Control for Multivehicle Guidance , 2007, IEEE Transactions on Control Systems Technology.

[7]  John Lygeros,et al.  RCopterX - Experimental validation of a distributed leader-follower MPC approach on a miniature helicopter test bed , 2014, 2014 European Control Conference (ECC).

[8]  Edwin Olson,et al.  LCM: Lightweight Communications and Marshalling , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  Alberto Bemporad,et al.  An algorithm for multi-parametric quadratic programming and explicit MPC solutions , 2003, Autom..

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

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

[12]  Anthony Tzes,et al.  Constrained-control of a quadrotor helicopter for trajectory tracking under wind-gust disturbances , 2010, Melecon 2010 - 2010 15th IEEE Mediterranean Electrotechnical Conference.

[13]  Alberto Bemporad,et al.  The explicit linear quadratic regulator for constrained systems , 2003, Autom..

[14]  Gaurav S. Sukhatme,et al.  Adaptive teams of autonomous aerial and ground robots for situational awareness , 2007, J. Field Robotics.

[15]  Jessie Y. C. Chen,et al.  UAV-Guided Navigation for Ground Robot Operations , 2008 .

[16]  Stephen J. Wright,et al.  Warm-Start Strategies in Interior-Point Methods for Linear Programming , 2002, SIAM J. Optim..

[17]  George Nikolakopoulos,et al.  Coordination of Helicopter UAVs for Aerial Forest-Fire Surveillance , 2009 .

[18]  Anthony Tzes,et al.  Switching model predictive attitude control for a quadrotor helicopter subject to atmospheric disturbances , 2011 .

[19]  Stephen P. Boyd,et al.  Fast Model Predictive Control Using Online Optimization , 2010, IEEE Transactions on Control Systems Technology.

[20]  Roland Siegwart,et al.  Towards Estimation and Correction of Wind Effects on a Quadrotor UAV , 2014 .

[21]  Derek A. Paley,et al.  Dynamic control of autonomous quadrotor flight in an estimated wind field , 2013, 52nd IEEE Conference on Decision and Control.

[22]  Aníbal Ollero,et al.  Cooperative Fire Detection using Unmanned Aerial Vehicles , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[23]  Kostas J. Kyriakopoulos,et al.  Model Predictive Control for the navigation of a nonholonomic vehicle with field-of-view constraints , 2013, 2013 American Control Conference.

[24]  Mustafa Unel,et al.  Robust position control of a tilt-wing quadrotor , 2010, 49th IEEE Conference on Decision and Control (CDC).

[25]  Stephen J. Wright,et al.  Primal-Dual Interior-Point Methods , 1997 .

[26]  Jonathan P. How,et al.  Actuator Constrained Trajectory Generation and Control for Variable-Pitch Quadrotors , 2012 .

[27]  Roland Siegwart,et al.  Design and control of an indoor micro quadrotor , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[28]  Zhou Chao,et al.  UAV Formation Flight Based on Nonlinear Model Predictive Control , 2012 .

[29]  Vijay Kumar,et al.  The GRASP Multiple Micro-UAV Testbed , 2010, IEEE Robotics & Automation Magazine.

[30]  Claire J. Tomlin,et al.  Quadrotor Helicopter Trajectory Tracking Control , 2008 .

[31]  Wen-Hua Chen,et al.  Piecewise constant model predictive control for autonomous helicopters , 2011, Robotics Auton. Syst..