Stabilization of a Rigid Body Payload with Multiple Cooperative Quadrotors

Stabilization of a Rigid Body Payload with Multiple Cooperative Quadrotors

Farhad A. Goodarzi
\tensf Post Doctoral Fellow
George Washington University
Washington, DC 20052
Email: fgoodarzi@gwu.edu
   Taeyoung Lee
\tensfAssociate Professor
George Washington University
Washington, DC 20052
Email: tylee@gwu.edu
Abstract

This paper presents the full dynamics and control of arbitrary number of quadrotor unmanned aerial vehicles (UAV) transporting a rigid body. The rigid body is connected to the quadrotors via flexible cables where each flexible cable is modeled as a system of arbitrary number of serially-connected links. It is shown that a coordinate-free form of equations of motion can be derived for the complete model without any simplicity assumptions that commonly appear in other literature, according to Lagrangian mechanics on a manifold. A geometric nonlinear controller is presented to transport the rigid body to a fixed desired position while aligning all of the links along the vertical direction. A rigorous mathematical stability proof is given and the desirable features of the proposed controller are illustrated by numerical examples and experimental results.

\@nthm

definitionDefinition \@nthmlemLemma \@nthmpropProposition \@nthmremarkRemark

Nomenclature

 m number of quadrotors

 Number of links in the -th cable

 Inertial frame

 Body-fixed frame of the payload

 Body-fixed frame of the -th quadrotor

 Mass of the -th quadrotor

 Mass of the payload

 Inertia matrix of the -th quadrotor

 Attitude of the -th quadrotor

 Angular velocity of the -th quadrotor

 Position of the -th quadrotor

 Velocity of the -th quadrotor

 Gravitational acceleration

 Special Orthogonal group

 Special Euclidean group

1 Introduction

Quadrotor UAVs are being considered for various missions such as Mars surface exploration, search and rescue, and particularly payload transportation. There are various applications for aerial load transportation such as usage in construction, military operations, emergency response, or delivering packages. Load transportation with UAVs can be performed using a cable or by grasping the payload [?, ?]. There are several limitations for grasping a payload with UAVs such as in situations where the landing area is inaccessible, or, it transporting a heavy/bulky object by multiple quadrotors.

Figure 1: Two quadrotors stabilizing a payload cooperatively.

Load transportation with the cable-suspended load has been studied traditionally for a helicopter [?, ?] or for small unmanned aerial vehicles such as quadrotor UAVs [?, ?, ?].

In most of the prior works, the dynamics of aerial transportation has been simplified due to the inherent dynamic complexities. For example, it is assumed that the dynamics of the payload is considered completely decoupled from quadrotors, and the effects of the payload and the cable are regarded as arbitrary external forces and moments exerted to the quadrotors [?, ?, ?], thereby making it challenging to suppress the swinging motion of the payload actively, particularly for agile aerial transportations.

Recently, the coupled dynamics of the payload or cable has been explicitly incorporated into control system design [?]. In particular, a complete model of a quadrotor transporting a payload modeled as a point mass, connected via a flexible cable is presented, where the cable is modeled as serially connected links to represent the deformation of the cable [?, ?]. In these studies the payload simplified and considered as a point mass without the attitude and the moment of inertia. In another study, multiple quadrotors transporting a rigid body payload has been studied [?], but it is assumed that the cables connecting the rigid body payload and quadrotors are always taut. These assumptions and simplifications in the dynamics of the system reduce the stability of the controlled system, particularly in rapid and aggressive load transportation where the motion of the cable and payload is excited nontrivially.

The other critical issue in designing controllers for quadrotors is that they are mostly based on local coordinates. Some aggressive maneuvers are demonstrated at [?] based on Euler angles. However they involve complicated expressions for trigonometric functions, and they exhibit singularities in representing quadrotor attitudes, thereby restricting their ability to achieve complex rotational maneuvers significantly. A quaternion-based feedback controller for attitude stabilization was shown in [?]. By considering the Coriolis and gyroscopic torques explicitly, this controller guarantees exponential stability. Quaternions do not have singularities but, as the three-sphere double-covers the special orthogonal group, one attitude may be represented by two antipodal points on the three-sphere. This ambiguity should be carefully resolved in quaternion-based attitude control systems, otherwise they may exhibit unwinding, where a rigid body unnecessarily rotates through a large angle even if the initial attitude error is small [?]. To avoid these, an additional mechanism to lift attitude onto the unit-quaternion space is introduced [?].

Recently, the dynamics of a quadrotor UAV is globally expressed on the special Euclidean group, , and nonlinear control systems are developed to track outputs of several flight modes [?]. There are also several studies using the estimations for dynamical objects developed on the special Euclidean group [?, ?]. Several aggressive maneuvers of a quadrotor UAV are demonstrated based on a hybrid control architecture, and a nonlinear robust control system is also considered in [?, ?]. As they are directly developed on the special Euclidean/Orthogonal group, complexities, singularities, and ambiguities associated with minimal attitude representations or quaternions are completely avoided [?, ?]. The proposed control system is particularly useful for rapid and safe payload transportation in complex terrain, where the position of the payload should be controlled concurrently while suppressing the deformation of the cables.

Comparing with the prior work of the authors in [?, ?, ?] and other existing studies, this paper is the first study considering a complete model which includes a rigid body payload with attitude, arbitrary number of quadrotors, and flexible cables. A rigorous mathematical stability analysis is presented, and numerical and experimental validations in presence of uncertainties and disturbances are provided. More explicitly, we present the complete dynamic model of an arbitrary number of quadrotors transporting a rigid body where each quadrotor is connected to the rigid body via a flexible cable. Each flexible cable is modeled as an arbitrary number of serially connected links, and it is valid for various masses and lengths. A coordinate free form of equations of motion is derived according to Lagrange mechanics on a nonlinear manifold for the full dynamic model. These sets of equations of motion are presented in a complete and organized manner without any restrictive assumption or simplification.

Another contribution of this study is designing a control system to stabilize the rigid body at desired position. Geometric nonlinear controllers presented and generalized for the presented model. More explicitly, we show that the rigid body payload is asymptotically transported into a desired location, while aligning all of the links along the vertical direction corresponding to a hanging equilibrium. This paper presents a rigorous Lyapunov stability analysis for the proposed controller to establish stability properties without any timescale separation assumptions or singular perturbation, and a nonlinear integral control term is designed to guarantee robustness against unstructured uncertainties in both rotational and translational dynamics.

In short, new contributions and the unique features of the dynamics model and control system proposed in this paper compared with other studies are as follows: (i) it is developed for the full dynamic model of arbitrary number of multiple quadrotor UAVs on transporting a rigid body connected via flexible cables, including the coupling effects between the translational dynamics and the rotational dynamics on a nonlinear manifold, (ii) the control systems are developed directly on the nonlinear configuration manifold in a coordinate-free fashion. Thus, singularities of local parameterization are completely avoided to generate agile maneuvers in a uniform way, (iii) a rigorous Lyapunov analysis is presented to establish stability properties without any timescale separation assumption, and (iv) an integral control term is proposed to guarantee asymptotical convergence of tracking error variables in the presence of uncertainties, (v) the proposed algorithm is validated with experiments for payload transportation with multiple cooperative quadrotor UAVs. A rigorous and complete mathematical analysis for multiple quadrotor UAVs transporting a payload on with experimental validations for payload transportation maneuvers is unprecedented.

This paper is organized as follows. A dynamic model is presented and the problem is formulated at Section II. Control systems are constructed at Sections III and IV, which are followed by numerical examples in Section V. Finally, experimental results are presented in Section VI.

2 Problem Formulation

Consider a rigid body with the mass and the moment of inertia , being transported with arbitrary number of quadrotors as shown in Figure 2. The location of the mass center of the rigid body is denoted by , and its attitude is given by , where the special orthogonal group is given by . We choose an inertial frame and body fixed frame attached to the payload. We also consider a body fixed frame attached to the -th quadrotor . In the inertial frame, the third axes points downward along the gravity and the other axes are chosen to form an orthonormal frame.

Figure 2: Quadrotor UAVs with a rigid body payload. Cables are modeled as a serial connection of an arbitrary number of links (only 4 quadrotors with 5 links in each cable are illustrated).

The mass and the moment of inertia of the -th quadrotor are denoted by and respectively. The cable connecting each quadrotor to the rigid body is modeled as an arbitrary numbers of links for each quadrotor with varying masses and lengths. The direction of the -th link of the -th quadrotor, measured outward from the quadrotor toward the payload is defined by the unit vector , where , where the mass and length of that link is denoted with and respectively. The number of links in the cable connected to the -th quadrotor is defined as . The configuration manifold for this system is given by .

The -th quadrotor can generate a thrust force of with respect to the inertial frame, where is the total thrust magnitude of the -th quadrotor. It also generates a moment with respect to its body-fixed frame. Also we define and as fixed disturbances applied to the -th quadrotor’s translational and rotational dynamics respectively. It is also assumed that an upper bound of the infinite norm of the uncertainty is known

(0)

for a positive constant . Throughout this paper, the two norm of a matrix is denoted by . The standard dot product is denoted by for any .

2.1 Lagrangian

The kinematics equations for the links, payload, and quadrotors are given by

(0)
(0)
(0)

where is the angular velocity of the -th link in the -th cable satisfying . Also, is the angular velocity of the payload and is the angular velocity of the -th quadrotor, expressed with respect to the corresponding body fixed frame. The hat map is defined by the condition that for all . More explicitly, for a vector , the matrix is given by

(0)

This identifies the Lie algebra with using the vector cross product in . The inverse of the hat map is denoted by the vee map, . The position of the -th quadrotor is given by

(0)

where is the vector from the center of mass of the rigid body to the point that -th cable is connected to the rigid body. Similarly the position of the -th link in the cable connecting the -th quadrotor to the rigid body is given by

(0)

We derive equations of motion according to Lagrangian mechanics. Total kinetic energy of the system is given by

(0)

The gravitational potential energy is given by

(0)

where it is assumed that the unit-vector points downward along the gravitational acceleration as shown at Figure 2. The corresponding Lagrangian of the system is .

2.2 Euler-Lagrange equations

Coordinate-free form of Lagrangian mechanics on the two-sphere and the special orthogonal group for various multi-body systems has been studied in [?, ?]. The key idea is representing the infinitesimal variation of in terms of the exponential map

(0)

for . The corresponding variation of the angular velocity is given by . Similarly, the infinitesimal variation of is given by

(0)

for satisfying . Using these, we obtain the following Euler-Lagrange equations.

{prop}

The equations of motion for the proposed payload transportation system are as follows

(0)
(0)
(0)
(0)

Here the total mass of the system and the mass of the -th quadrotor and its flexible cable are defined as

(0)

and the constants related to the mass of links are given as

(0)

The equations of motion can be rearranged in a matrix form as follow

(0)

where the state vector with is given by

(0)

and matrix is defined as

(0)

where the sub-matrices are defined as

(0)

and the sub-matrix is given by

(0)

The matrix is

(0)

and sub-matrices of matrix are also defined as

  • See Appendix missingA.

These equations are derived directly on a nonlinear manifold without any simplification. The dynamics of the payload, flexible cables, and quadrotors are considered explicitly, and they avoid singularities and complexities associated to local coordinates.

3 Control System Design for Simplified Dynamic Model

3.1 Control Problem Formulation

Let be the desired position of the payload. The desired attitude of the payload is considered as , and the desired direction of links is aligned along the vertical direction. The corresponding location of the -th quadrotor at this desired configuration is given by

(0)

We wish to design control forces and control moments of quadrotors such that this desired configuration becomes asymptotically stable.

3.2 Simplified Dynamic Model

Control forces for each quadrotor is given by for the given equations of motion (2.2), (2.2), (2.2), (2.2). As such, the quadrotor dynamics is under-actuated. The total thrust magnitude of each quadrotor can be arbitrary chosen, but the direction of the thrust vector is always along the third body fixed axis, represented by . But, the rotational attitude dynamics of the quadrotors are fully actuated, and they are not affected by the translational dynamics of the quadrotors or the dynamics of links.

Based on these observations, in this section, we simplify the model by replacing the term by a fictitious control input , and design an expression for to asymptotically stabilize the desired equilibrium. In other words, we assume that the attitude of the quadrotor can be instantaneously changed. Also are ignored in the simplified dynamic model. The effects of the attitude dynamics are incorporated at the next section.

3.3 Linear Control System

The control system for the simplified dynamic model is developed based on the linearized equations of motion. At the desired equilibrium, the position and the attitude of the payload are given by and , respectively. Also, we have and . In this equilibrium configuration, the control input for the -th quadrotor is

(0)

where the total thrust is .

The variation of is given by

(0)

and the variation of the attitude of the payload is defined as

for . The variation of can be written as

(0)

where with . The variation of is given by with . Therefore, the third element of each of and for any equilibrium configuration is zero, and they are omitted in the following linearized equations. The state vector of the linearized equation is composed of , where . The variation of the control input , is given as .

{prop}

The linearized equations of the simplified dynamic model are given by

(0)

where corresponds to the higher order term and the state vector with is given by

and . The matrix are defined as

where the sub-matrices are defined as

(0)
(0)

and the sub-matrix is given by

(0)

The matrix is defined as

where and the sub-matrices are

The matrix is given by

where .

  • See Appendix missingB.

We present the following PD-type control system for the linearized dynamics

(0)

for controller gains . Provided that (3.3) is controllable, we can choose the combined controller gains , such that the equilibrium is asymptotically stable for the linearized equations [?]. Then, the equilibrium becomes asymptotically stable for the nonlinear Euler-Lagrange equation. The controlled linearized system can be written as

(0)

where and

(0)

We can also choose and such that is Hurwitz. Then for any positive definite matrix , there exist a positive definite and symmetric matrix such that according to [?, Thm 3.6].

4 Control System Design for the Full Dynamic Model

The control system designed at the previous section is based on a simplifying assumption that each quadrotor can generates a thrust along any direction. In the full dynamic model, the direction of the thrust for each quadrotor is parallel to its third body-fixed axis always. In this section, the attitude of each quadrotor is controlled such that the third body-fixed axis becomes parallel to the direction of the ideal control force designed in the previous section. Also in the full dynamics model, we considers the in the control design and introduce a new integral term to eliminate the disturbances and uncertainties. The central idea is that the attitude of the quadrotor is controlled such that its total thrust direction , corresponding to the third body-fixed axis, asymptotically follows the direction of the fictitious control input . By choosing the total thrust magnitude properly, we can guarantee asymptotical stability for the full dynamic model.

Let be the ideal total thrust of the -th quadrotor that asymptotically stabilize the desired equilibrium. Therefor, we have

(0)

where and are the total thrust and control input of each quadrotor at its equilibrium respectively. where the following integral term is added to eliminate the effect of disturbance in the full dynamic model

(0)

where is an integral gain. For a positive constant , a saturation function is introduced as

If the input is a vector , then the above saturation function is applied element by element to define a saturation function for a vector. From the desired direction of the third body-fixed axis of the -th quadrotor, namely , is given by

(0)

This provides a two-dimensional constraint on the three dimensional desired attitude of each quadrotor, such that there remains one degree of freedom. To resolve it, the desired direction of the first body-fixed axis is introduced as a smooth function of time. Due to the fact that the first body-fixed axis is normal to the third body-fixed axis, it is impossible to follow an arbitrary command exactly. Instead, its projection onto the plane normal to is followed, and the desired direction of the second body-fixed axis is chosen to constitute an orthonormal frame [?]. More explicitly, the desired attitude of the -th quadrotor is given by

(0)

which is guaranteed to be an element of . The desired angular velocity is obtained from the attitude kinematics equation, .

Define the tracking error vectors for the attitude and the angular velocity of the -th quadrotor as

(0)

and a configuration error function on as follows

(0)

The thrust magnitude is chosen as the length of , projected on to , and the control moment is chosen as a tracking controller on :

(0)
(0)

where , and are positive constants and the following integral term is introduced to eliminate the effect of fixed disturbance

(0)

where