An Improved Method for Swing State Estimation in Multirotor Slung Load Applications
Emanuele L. de Angelis, Fabrizio Giulietti
Abstract
A method is proposed to estimate the swing state of a suspended payload in multirotor drone delivery scenarios. Starting from the equations of motion of the coupled slung load system, defined by two point masses interconnected by a rigid link, a recursive algorithm is developed to estimate cable swing angle and rate from acceleration measurements available from an onboard Inertial Measurement Unit, without the need for extra sensors. The estimation problem is addressed according to the Extended Kalman Filter structure. With respect to the classical linear formulation, the proposed approach allows for improved estimation accuracy in both stationary and maneuvering flight. As an additional contribution, filter performance is enhanced by accounting for aerodynamic disturbance force, which largely affects the estimation accuracy in windy flight conditions. The validity of the proposed methodology is demonstrated as follows. First, it is applied to an octarotor platform where propellers are modeled according to blade element theory and the load is suspended by an elastic cable. Numerical simulations show that estimated swing angle and rate represent suitable feedback variables for payload stabilization, with benefits on flying qualities and energy demand. The algorithm is finally implemented on a small-scale quadrotor and is investigated through an outdoor experimental campaign, thus proving the effectiveness of the approach in a real application scenario.