State and parameter estimation of suspended load using quadrotor onboard sensors

In this paper, we address the problem of state and parameter estimation of a suspended load using quadrotor onboard sensors. Flying with a suspended load alters the quadrotor flight dynamics, sometimes to a large extent, making it a challenging and hazardous task. Monitoring the state of the suspended load is vital for safe flight operations while parameter estimation decouples the control design from specific parameter-dependent solutions. We take advantage of the fact that the forces and torques the suspended load exerts on the quadrotor can be detected in the aircraft IMU measurements as a low frequency harmonic. Thus, by combining the available measurements and system mass we are able to estimate the state of the suspended load. Since our approach stems from understanding the aircraft-load interaction, we start off by delineating the full system model of the quadrotor with a suspended load. To isolate the natural frequency of the suspended load and determine the length of suspension cable, we employ the Fast Fourier Transform (FFT). The proposed estimation algorithms are validated through extensive numerical simulations and experimentally.

[1]  Julian Förster,et al.  System Identification of the Crazyflie 2.0 Nano Quadrocopter , 2015 .

[2]  Vijay Kumar,et al.  Toward image based visual servoing for aerial grasping and perching , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

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

[4]  Morten Bisgaard,et al.  Input Shaping for Helicopter Slung Load Swing Reduction , 2008 .

[5]  Morten Bisgaard,et al.  VISION AIDED STATE ESTIMATOR FOR HELICOPTER SLUNG LOAD SYSTEM , 2007 .

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

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

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

[9]  Vijay Kumar,et al.  Aggressive Flight With Suspended Payloads Using Vision-Based Control , 2018, IEEE Robotics and Automation Letters.

[10]  T. I. Fossen,et al.  Lagrangian formulation of underwater vehicles' dynamics , 1991, Conference Proceedings 1991 IEEE International Conference on Systems, Man, and Cybernetics.

[11]  Suseong Kim,et al.  Aerial grasping of cylindrical object using visual servoing based on stochastic model predictive control , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Tor Arne Johansen,et al.  Nonlinear Control with Swing Damping of a Multirotor UAV with Suspended Load , 2017, J. Intell. Robotic Syst..

[13]  Stjepan Bogdan,et al.  Dexterous Aerial Robots—Mobile Manipulation Using Unmanned Aerial Systems , 2017, IEEE Transactions on Robotics.

[14]  Anne Goodchild,et al.  Delivery by drone: An evaluation of unmanned aerial vehicle technology in reducing CO 2 emissions in the delivery service industry , 2017, Transportation Research Part D: Transport and Environment.

[15]  Vijay Kumar,et al.  Minimum snap trajectory generation and control for quadrotors , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[17]  Raffaello D'Andrea,et al.  Covariance Correction Step for Kalman Filtering with an Attitude , 2017 .

[18]  David Halliday,et al.  Fundamentals of Physics, Extended 7th Edition , 2004 .

[19]  Vijay Kumar,et al.  Dynamics, Control and Planning for Cooperative Manipulation of Payloads Suspended by Cables from Multiple Quadrotor Robots , 2013, Robotics: Science and Systems.

[20]  Mac Schwager,et al.  Eyes in the Sky: Decentralized Control for the Deployment of Robotic Camera Networks , 2011, Proceedings of the IEEE.

[21]  Haider A. F. Almurib,et al.  Control and path planning of quadrotor aerial vehicles for search and rescue , 2011, SICE Annual Conference 2011.

[22]  G. D. Bergland,et al.  A guided tour of the fast Fourier transform , 1969, IEEE Spectrum.

[23]  Emanuele L. de Angelis,et al.  Swing angle estimation for multicopter slung load applications , 2019, Aerospace Science and Technology.

[24]  Rafael Fierro,et al.  Adaptive Control of a Quadrotor with Dynamic Changes in the Center of Gravity , 2011 .

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

[26]  Karl Henrik Johansson,et al.  Robust acceleration control of a hexarotor UAV with a disturbance observer , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[27]  Raffaello D'Andrea,et al.  Guest Editorial Can Drones Deliver? , 2014, IEEE Trans Autom. Sci. Eng..

[28]  N. Seth,et al.  Vibration reduction in computer controlled machines , 1991, IEEE 1991 International Conference on Systems Engineering.

[29]  Gaurav S. Sukhatme,et al.  Crazyswarm: A large nano-quadcopter swarm , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[30]  Mark W. Mueller,et al.  Fusing ultra-wideband range measurements with accelerometers and rate gyroscopes for quadrocopter state estimation , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[31]  Jianguo Zhao,et al.  Compliant Bistable Gripper for Aerial Perching and Grasping , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[32]  H. Jin Kim,et al.  Autonomous swing-angle estimation for stable slung-load flight of multi-rotor UAVs , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

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

[34]  Tor Arne Johansen,et al.  Cooperative Control for Multirotors Transporting an Unknown Suspended Load Under Environmental Disturbances , 2020, IEEE Transactions on Control Systems Technology.

[35]  Li Li,et al.  The Accuracy and Precision of Position and Orientation Tracking in the HTC Vive Virtual Reality System for Scientific Research , 2017, i-Perception.

[36]  Roberto Celi,et al.  Flight Dynamics of an Articulated Rotor Helicopter with an External Slung Load , 2001 .

[37]  Chao Xu,et al.  ADRC methodology for a quadrotor UAV transporting hanged payload , 2016, 2016 IEEE International Conference on Information and Automation (ICIA).