Online trajectory planning and control of a MAV payload system in dynamic environments

Micro Aerial Vehicles (MAVs) are increasingly being used for aerial transportation in remote and urban spaces where portability can be exploited to reach previously inaccessible and inhospitable spaces. Current approaches to MAV swung payload system path planning have primarily focused on pre-generating (agile) collision-free, or conservative minimal-swing trajectories in static environments. However, these approaches have failed to address the prospect of online re-planning in uncertain and dynamic environments which is a prerequisite for real-world deployability. This article describes a novel Non-Linear Model Predictive Controller (NMPC) for online, agile and closed-loop local trajectory planning and control addressing the limitations mentioned of contemporary approaches. We integrate the controller in a full system framework and demonstrate the algorithm’s effectiveness in simulation and experimental studies. Results show the scalability and adaptability of our method to various dynamic setups with repeatable performance over several complex tasks which include flying through a narrow opening and avoiding moving humans.

[1]  Lydia Tapia,et al.  Automated aerial suspended cargo delivery through reinforcement learning , 2017, Artif. Intell..

[2]  M. Morari,et al.  Stability of model predictive control with mixed constraints , 1995, IEEE Trans. Autom. Control..

[3]  Taeyoung Lee,et al.  Geometric Control of Quadrotor UAVs Transporting a Cable-Suspended Rigid Body , 2018, IEEE Transactions on Control Systems Technology.

[4]  Roland Siegwart,et al.  Fast nonlinear Model Predictive Control for unified trajectory optimization and tracking , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[5]  S. Shankar Sastry,et al.  Nonlinear model predictive tracking control for rotorcraft-based unmanned aerial vehicles , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[6]  Theodor Borangiu,et al.  Quadrotor Black-Box System Identification , 2011 .

[7]  Davide Scaramuzza,et al.  Fast Trajectory Optimization for Agile Quadrotor Maneuvers with a Cable-Suspended Payload , 2017, Robotics: Science and Systems.

[8]  Aaron McFadyen,et al.  Non-linear model predictive control for UAVs with slung/swung load , 2015, ICRA 2015.

[9]  Alexei Yu. Uteshev,et al.  Point-to-ellipse and point-to-ellipsoid distance equation analysis , 2018, J. Comput. Appl. Math..

[10]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[11]  Alexander Domahidi,et al.  FORCES NLP: an efficient implementation of interior-point methods for multistage nonlinear nonconvex programs , 2020, Int. J. Control.

[12]  Anthony Tzes,et al.  Model predictive quadrotor control: attitude, altitude and position experimental studies , 2012 .

[13]  Harold W. Kuhn,et al.  Nonlinear programming: a historical view , 1982, SMAP.

[14]  Anders Forsgren,et al.  Interior Methods for Nonlinear Optimization , 2002, SIAM Rev..

[15]  Yoram Koren,et al.  The vector field histogram-fast obstacle avoidance for mobile robots , 1991, IEEE Trans. Robotics Autom..

[16]  Manfred Morari,et al.  Efficient interior point methods for multistage problems arising in receding horizon control , 2012, 2012 IEEE 51st IEEE Conference on Decision and Control (CDC).

[17]  Lydia E. Kavraki,et al.  Motion Planning , 2011, Springer Handbook of Robotics, 2nd Ed..

[18]  Vijay Kumar,et al.  Trajectory generation and control of a quadrotor with a cable-suspended load - A differentially-flat hybrid system , 2013, 2013 IEEE International Conference on Robotics and Automation.

[19]  L. Derafa,et al.  Dynamic Modelling and Experimental Identification of Four Rotors Helicopter Parameters , 2006, 2006 IEEE International Conference on Industrial Technology.

[20]  J. Maciejowski,et al.  Soft constraints and exact penalty functions in model predictive control , 2000 .

[21]  Lydia Tapia,et al.  A reinforcement learning approach towards autonomous suspended load manipulation using aerial robots , 2013, 2013 IEEE International Conference on Robotics and Automation.

[22]  David Q. Mayne,et al.  Constrained model predictive control: Stability and optimality , 2000, Autom..

[23]  Morten Bisgaard,et al.  Adaptive control system for autonomous helicopter slung load operations , 2010 .

[24]  Alexander Domahidi,et al.  Real-Time Motion Planning for Aerial Videography With Real-Time With Dynamic Obstacle Avoidance and Viewpoint Optimization , 2017, IEEE Robotics and Automation Letters.

[25]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[26]  Mario Sarcinelli-Filho,et al.  Modelling and control of a PVTOL quadrotor carrying a suspended load , 2015, 2015 International Conference on Unmanned Aircraft Systems (ICUAS).

[27]  Felipe Gonzalez,et al.  Nonlinear Model Predictive Control for a multi-rotor with heavy slung load , 2014, 2014 International Conference on Unmanned Aircraft Systems (ICUAS).

[28]  Lydia Tapia,et al.  Learning swing-free trajectories for UAVs with a suspended load , 2013, 2013 IEEE International Conference on Robotics and Automation.

[29]  Ying Feng,et al.  Modeling of a Micro UAVwith Slung Payload , 2014 .

[30]  Morten Bisgaard,et al.  Full State Estimation for Helicopter Slung Load System , 2007 .

[31]  J.K. Hedrick,et al.  A mode-switching path planner for UAV-assisted search and rescue , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[32]  Rafael Fierro,et al.  Trajectory generation for swing-free maneuvers of a quadrotor with suspended payload: A dynamic programming approach , 2012, 2012 IEEE International Conference on Robotics and Automation.

[33]  Tor Arne Johansen,et al.  Nonlinear control of a multirotor UAV with suspended load , 2015, 2015 International Conference on Unmanned Aircraft Systems (ICUAS).

[34]  Steven M. LaValle,et al.  Motion Planning Part I: The Essentials , 2011 .

[35]  Luigi S. Cicolani,et al.  Equations of motion of slung-load systems, including multilift systems , 1992 .

[36]  Vijay Kumar,et al.  Mixed Integer Quadratic Program trajectory generation for a quadrotor with a cable-suspended payload , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[37]  Rafael Fierro,et al.  Agile Load Transportation : Safe and Efficient Load Manipulation with Aerial Robots , 2012, IEEE Robotics & Automation Magazine.

[38]  Oliver Brock,et al.  Real-time re-planning in high-dimensional configuration spaces using sets of homotopic paths , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[39]  Narendra Karmarkar,et al.  A new polynomial-time algorithm for linear programming , 1984, Comb..