Dynamics analysis and time-optimal motion planning for unmanned quadrotor transportation systems

Abstract Aerial transportation is enjoying more and more popularity among disaster-oriented tasks, such as fire fighting, delivery of relief supplies, life-saving aid, and so on, which are infeasible for ground robots especially in complex terrains. However, the contradictory between transportation efficiency and payload swing suppression is an annoying problem, which badly limits the application of aerial transportation. In this paper, a time-optimal motion planning (TOMP) scheme is proposed with effective payload antiswing performance. To the best of our knowledge, it is the first minimum-time trajectory planning method designed for unmanned quadrotor transportation systems. Compared with existing methods, the proposed approach presents significant superiority in the sense that both nonlinear dynamics of the system and various constraints are taken into full consideration simultaneously. Specifically, the nonlinear system model is established using Lagrangian mechanics, based on which the augmented system is transformed into a nonlinear affine system regarding the acceleration/jerk as the control input without the need of the linearized system model. After discretization and approximation process, the time-optimal motion planning problem is converted into a standard nonlinear programming problem, wherein various practical constraints are considered, including the bounds of the payload swing, the quadrotor velocity, acceleration, and even jerk. Finally, the nonlinear programming problem is solved by the sequential quadratic programming (SQP) method. Experimental results are exhibited to illustrate the effectiveness and feasibility of the proposed approach.

[1]  Taeyoung Lee,et al.  Robust Adaptive Attitude Tracking on ${\rm SO}(3)$ With an Application to a Quadrotor UAV , 2013, IEEE Transactions on Control Systems Technology.

[2]  Peter I. Corke,et al.  Multirotor Aerial Vehicles: Modeling, Estimation, and Control of Quadrotor , 2012, IEEE Robotics & Automation Magazine.

[3]  Fulvia Quagliotti,et al.  Linear Quadratic Control for Quadrotors UAVs Dynamics and Formation Flight , 2013, J. Intell. Robotic Syst..

[4]  Ning Sun,et al.  Nonlinear Stabilizing Control for Ship-Mounted Cranes With Ship Roll and Heave Movements: Design, Analysis, and Experiments , 2018, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[5]  Robert E. Mahony,et al.  A hierarchical control strategy for the autonomous navigation of a ducted fan flying robot , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[6]  Z. Zuo,et al.  Adaptive trajectory tracking control of output constrained multi-rotors systems , 2014 .

[7]  Abdelhamid Tayebi,et al.  Attitude stabilization of a VTOL quadrotor aircraft , 2006, IEEE Transactions on Control Systems Technology.

[8]  Yisheng Zhong,et al.  Robust Attitude Stabilization for Nonlinear Quadrotor Systems With Uncertainties and Delays , 2017, IEEE Transactions on Industrial Electronics.

[9]  Rogelio Lozano,et al.  Passivity based control for a quadrotor UAV transporting a cable-suspended payload with minimum swing , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[10]  Ning Sun,et al.  Nonlinear Hierarchical Control for Unmanned Quadrotor Transportation Systems , 2018, IEEE Transactions on Industrial Electronics.

[11]  Hyo-Sung Ahn,et al.  Nonlinear Control of Quadrotor for Point Tracking: Actual Implementation and Experimental Tests , 2015, IEEE/ASME Transactions on Mechatronics.

[12]  Q. H. Ngo,et al.  Sliding-Mode Antisway Control of an Offshore Container Crane , 2012, IEEE/ASME Transactions on Mechatronics.

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

[14]  Ning Sun,et al.  Nonlinear Motion Control of Underactuated Three-Dimensional Boom Cranes With Hardware Experiments , 2018, IEEE Transactions on Industrial Informatics.

[15]  Xuebo Zhang,et al.  A Motion Planning-Based Adaptive Control Method for an Underactuated Crane System , 2012, IEEE Transactions on Control Systems Technology.

[16]  Vijay Kumar,et al.  Construction with quadrotor teams , 2012, Auton. Robots.

[17]  Markus Hehn,et al.  A frequency domain iterative learning algorithm for high-performance, periodic quadrocopter maneuvers , 2014 .

[18]  Xu Zhang,et al.  Nonlinear robust sliding mode control of a quadrotor unmanned aerial vehicle based on immersion and invariance method , 2015 .

[19]  Ben M. Chen,et al.  Systems design and implementation with jerk-optimized trajectory generation for UAV calligraphy , 2015 .

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

[21]  Anil V. Rao,et al.  Algorithm 902: GPOPS, A MATLAB software for solving multiple-phase optimal control problems using the gauss pseudospectral method , 2010, TOMS.

[22]  Mac Schwager,et al.  Virtual Rigid Bodies for coordinated agile maneuvering of teams of micro aerial vehicles , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Ali H. Nayfeh,et al.  Dynamics and Control of Cranes: A Review , 2003 .

[24]  Vijay Kumar,et al.  Design, modeling, estimation and control for aerial grasping and manipulation , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Ning Sun,et al.  Minimum-Time Trajectory Planning for Underactuated Overhead Crane Systems With State and Control Constraints , 2014, IEEE Transactions on Industrial Electronics.

[26]  Lorenzo Marconi,et al.  Nested saturation control of an UAV carrying a suspended load , 2014, 2014 American Control Conference.

[27]  Vijay Kumar,et al.  Geometric control and differential flatness of a quadrotor UAV with a cable-suspended load , 2013, 52nd IEEE Conference on Decision and Control.

[28]  Dongkyoung Chwa Nonlinear Tracking Control of 3-D Overhead Cranes Against the Initial Swing Angle and the Variation of Payload Weight , 2009, IEEE Transactions on Control Systems Technology.

[29]  Matt R. Jardin,et al.  Optimized Measurements of Unmanned-Air-Vehicle Mass Moment of Inertia with a Bifilar Pendulum , 2009 .

[30]  Rogelio Lozano,et al.  Hovering Quad-Rotor Control: A Comparison of Nonlinear Controllers using Visual Feedback , 2012, IEEE Trans. Aerosp. Electron. Syst..

[31]  He Chen,et al.  Nonlinear Antiswing Control for Crane Systems With Double-Pendulum Swing Effects and Uncertain Parameters: Design and Experiments , 2018, IEEE Transactions on Automation Science and Engineering.

[32]  Daewon Lee,et al.  Geometric Adaptive Tracking Control of a Quadrotor Unmanned Aerial Vehicle on SE(3) for Agile Maneuvers , 2015 .

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

[34]  Aaron M. Dollar,et al.  Stability of small-scale UAV helicopters and quadrotors with added payload mass under PID control , 2012, Autonomous Robots.

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

[36]  Antonio Franchi,et al.  The flying hand: A formation of UAVs for cooperative aerial tele-manipulation , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[37]  J. Swevers,et al.  Optimal input design for flat systems using B-splines , 2011, Proceedings of the 2011 American Control Conference.

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

[39]  William W. Hager,et al.  A unified framework for the numerical solution of optimal control problems using pseudospectral methods , 2010, Autom..

[40]  A. El Saddik,et al.  Nonlinear adaptive control for quadrotor flying vehicle , 2014 .

[41]  Pedro Albertos,et al.  Predictor-Based Control of a Class of Time-Delay Systems and Its Application to Quadrotors , 2017, IEEE Transactions on Industrial Electronics.

[42]  Yao Zhang,et al.  Nonlinear Robust Adaptive Tracking Control of a Quadrotor UAV Via Immersion and Invariance Methodology , 2015, IEEE Transactions on Industrial Electronics.

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