Swing angle estimation for multicopter slung load applications

Abstract A filtering technique based on a set of recursive equations is analyzed and applied to swing angle estimation for multicopter slung load applications. Starting from the equations of motion of the coupled slung load system, an observation model is derived to autonomously measure the swing angle by means of the data available from the onboard IMU, without the need to rely on extra sensors. Provided the multicopter is subject to known control inputs, data-fusion is performed through a Fading Gaussian Deterministic approach, whose theoretical background was recently investigated by the author. In particular, the algorithm is based on a two-step set of equations derived from the minimization of a cost function where earlier data are progressively de-weighted by a fading factor, making the estimation less prone to problem unknowns. The validity of the approach is investigated by means of numerical simulations, where a tuning criterion is shown to provide the fading factor that best dampens the modeling errors with respect to the measurement noise. Estimated swing angles are then used in a sample feedback control application with the aim to simultaneously perform trajectory tracking and payload swing damping.

[1]  Hanafy M. Omar.  Designing anti-swing fuzzy controller for helicopter slung-load system near hover by particle swarms , 2013 .

[2]  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).

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

[4]  Konstantin Kondak,et al.  Autonomous transportation and deployment with aerial robots for search and rescue missions , 2011, J. Field Robotics.

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

[6]  Goele Pipeleers,et al.  Two-time-scale control of a multirotor aircraft for suspended load transportation , 2019, Aerospace Science and Technology.

[7]  Mostafa Ghayour,et al.  Swing angle estimation for anti-sway overhead crane control using load cell , 2011 .

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

[9]  Nicholas J. Higham,et al.  The Scaling and Squaring Method for the Matrix Exponential Revisited , 2005, SIAM J. Matrix Anal. Appl..

[10]  Guofan Wu,et al.  Dynamics and control of a quadrotor with a payload suspended through an elastic cable , 2017, 2017 American Control Conference (ACC).

[11]  Felipe Gonzalez,et al.  MPC controlled multirotor with suspended slung Load: System architecture and visual load detection , 2016, 2016 IEEE Aerospace Conference.

[12]  D. Naidu,et al.  Singular Perturbations and Time Scales in Guidance and Control of Aerospace Systems: A Survey , 2001 .

[13]  Aaron M. Dollar,et al.  Grasping from the air: Hovering capture and load stability , 2011, 2011 IEEE International Conference on Robotics and Automation.

[14]  Goele Pipeleers,et al.  Optimal autonomous multirotor motion planning in an obstructed environment , 2019, Aerospace Science and Technology.

[15]  Kazuhiro Shimonomura,et al.  A Multirotor Platform Employing a Three-Axis Vertical Articulated Robotic Arm for Aerial Manipulation Tasks , 2018, 2018 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM).

[16]  Jinling Wang,et al.  GPS RTK Performance Characteristics and Analysis , 2008 .

[17]  R. A. DeCarlo.  Linear Systems: A State Variable Approach With Numerical Implementation , 1989 .

[18]  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).

[19]  Hirohisa Kojima,et al.  Dynamics and command shaping control of quadcopters carrying suspended loads , 2018 .

[20]  Fabrizio Giulietti,et al.  Multirotor aircraft formation flight control with collision avoidance capability , 2018, Aerospace Science and Technology.

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

[22]  Daewon Lee,et al.  Geometric stabilization of a quadrotor UAV with a payload connected by flexible cable , 2013, 2014 American Control Conference.

[23]  B. Bethke,et al.  Real-time indoor autonomous vehicle test environment , 2008, IEEE Control Systems.

[24]  Emanuele L. de Angelis.  Stability analysis of a multirotor vehicle hovering condition , 2018 .

[25]  Ronald Lumia,et al.  Rapid Swing-Free Transport of Nonlinear Payloads Using Dynamic Programming , 2008 .

[26]  Ella M. Atkins,et al.  Cooperative aerial lift and manipulation (CALM) , 2018, Aerospace Science and Technology.

[27]  Byung-Yoon Lee,et al.  Parameter-robust linear quadratic Gaussian technique for multi-agent slung load transportation , 2017 .

[28]  Giulio Avanzini,et al.  Optimal performance and sizing of a battery-powered aircraft , 2016 .

[29]  Fabrizio Giulietti,et al.  Gaussian Deterministic Recursive Estimator with Online Tuning Capabilities , 2015 .

[30]  Cornel Sultan,et al.  Modeling and control of a helicopter slung-load system , 2013 .

[31]  Iman Izadi,et al.  Cooperative load transportation using multiple UAVs , 2019, Aerospace Science and Technology.

[32]  Fabrizio Giulietti,et al.  Terminal height estimation using a Fading Gaussian Deterministic filter , 2016 .

[33]  Daewon Lee,et al.  Geometric control of a quadrotor UAV transporting a payload connected via flexible cable , 2014, 1407.8164.

[34]  Hanafy M. Omar.  New fuzzy-based anti-swing controller for helicopter slung-load system near hover , 2009, 2009 IEEE International Symposium on Computational Intelligence in Robotics and Automation - (CIRA).

[35]  Sergei Lupashin,et al.  A platform for aerial robotics research and demonstration: The Flying Machine Arena , 2014 .

[36]  Robert H. Bishop.  Mechatronic Systems, Sensors, and Actuators: Fundamentals and Modeling , 2007 .

[37]  Norman Morrison,et al.  Introduction to Sequential Smoothing and Prediction , 1969 .

[38]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[39]  Gustaf Hendeby,et al.  Vertical modeling of a quadcopter for mass estimation and diagnosis purposes , 2017, 2017 Workshop on Research, Education and Development of Unmanned Aerial Systems (RED-UAS).

[40]  Sami El-Ferik,et al.  Nonlinear forward path tracking controller for helicopter with slung load , 2017 .

[41]  S. Sul,et al.  Anti-Sway Control of Container Cranes: Inclinometer, Observer, and State Feedback , 2004 .

[42]  Christopher J. Damaren,et al.  Spacecraft Dynamics and Control: An Introduction , 2013 .