Research Article | Open Access

M. A. Santos, B. S. Rego, G. V. Raffo, A. Ferramosca, "Suspended Load Path Tracking Control Strategy Using a Tilt-Rotor UAV", *Journal of Advanced Transportation*, vol. 2017, Article ID 9095324, 22 pages, 2017. https://doi.org/10.1155/2017/9095324

# Suspended Load Path Tracking Control Strategy Using a Tilt-Rotor UAV

**Academic Editor:**Guizhen Yu

#### Abstract

This work proposes a control strategy to solve the path tracking problem of a suspended load carried by a tilt-rotor unmanned aerial vehicle (UAV). Initially, the equations of motion for the multibody mechanical system are derived from the loadâ€™s perspective by means of the Euler-Lagrange formulation, in which the loadâ€™s position and orientation are chosen as degrees of freedom. An unscented Kalman filter (UKF) is designed for nonlinear state estimation of all the system states, assuming that available information is provided by noisy sensors with different sampling rates that do not directly measure the loadâ€™s attitude. Furthermore, a model predictive control (MPC) strategy is proposed for path tracking of the suspended load with stabilization of the tilt-rotor UAV when parametric uncertainties and external disturbances affect the load, the ropeâ€™s length and total system mass vary during taking-off and landing, and the desired yaw angle changes throughout the trajectory. Finally, numerical experiments are presented to corroborate the good performance of the proposed strategy.

#### 1. Introduction

Firstly used mainly for military purposes, recent advances in technology allowed large-scale production of unmanned aerial vehicles (UAVs) and consequently their civilian usage. Nowadays, UAVs receive great interest from engineers and researchers and have a wide range of applications, such as precision agriculture, cargo transportation, cinematographic filming, search-and-rescue missions, surveillance, fire inspection, and archeology. The most commonly found configurations of UAVs are the fixed-wing, helicopter, and quadrotor ones. Due to the vertical take-off and landing (VTOL) and hovering capabilities of helicopter and quadrotor UAVs, they are used in tasks that require high maneuverability in slow velocities. Thereby, fixed-wing UAVs are used in tasks that require improved forward flight, mostly in open environments.

In the last decades, some hybrid aircrafts have drawn substantial attention due to their ability to perform VTOL, hover, and improved forward flights. The tilt-rotor configuration is among the most popular ones, being provided with fixed wings and rotary wings, and is capable of switching between helicopter and airplane flight modes by tilting its thrusters. Inspired by the capabilities of those aircrafts, recent researches are looking into the design of small-scale tilt-rotor UAVs [1â€“3]. Their hybrid characteristics offer advantages over fixed-wing and quadrotor UAVs, which also come with design and control challenges since they are complex underactuated mechanical systems with highly coupled dynamics.

Moreover, an important application of unmanned aerial vehicles is the load transportation in risky and inaccessible zones, allowing dealing with rapid deployment of supplies in search-and-rescue missions [4], vertical replenishment of seaborne vessels [5], and safe landmine detection [6]. However, this kind of task is a challenging subject in terms of modeling and control. Since the payload is often connected to the UAV through a rope, the dynamic behavior of the system varies due to the loadâ€™s swing, which can destabilize the whole system if it is not well attenuated. Moreover, the suspended load by a rope adds unactuated degrees of freedom to the system, increasing its underactuation degree. Apart from the exposed, in order to accomplish the load transportation task, the knowledge on the load position is usually required. The problem of estimating the load position then arises, being mostly addressed through visual systems and state estimators [7, 8].

Therefore, due to its hybrid capabilities, a tilt-rotor UAV becomes a promising platform for aerial load transportation, providing improved forward speed when compared with rotary-wing UAVs, which is a desired feature for missions requiring rapid deployment. Furthermore, missions that demand precise positioning of the load cannot be addressed by fixed-wing UAVs, since they are not able to perform hover flights. Thereby, the tilt-rotor UAV can be used in both scenarios.

In the literature, control objectives for aerial load transportation include path tracking of the aircraft with reduced loadâ€™s swing [9â€“14], obstacle avoidance [15, 16], transportation by multiple aircrafts [17, 18], and path tracking of the suspended load [19â€“24]. Since large load swing may destabilize the aircraft, many works address the problem of swing-free aerial load transportation. In [9], a control strategy based on a cascade structure is proposed for load transportation using an unmanned helicopter. A delayed feedback controller is introduced in an outer loop to reduce loadâ€™s swing, while the inner-loop controller does not take into account the dynamics of the load. Open-loop approaches based on trajectory generation for load transportation using quadrotor UAVs are proposed in [10, 11], in order to obtain reduced loadâ€™s swing motion. In [13], a robust nonlinear control strategy is proposed in order to transport a suspended load by a quadrotor UAV along a predefined trajectory while avoiding loadâ€™s swing. The controller is designed based on nonlinear control theory and Lyapunov redesign taking into account the whole dynamics of the system. Some works have also used tilt-rotor UAVs for load transportation. In [12], a nonlinear cascade control strategy is proposed for path tracking of a tilt-rotor UAV with loadâ€™s swing improvement, which is composed of three levels of feedback linearization controllers. In [14], a model predictive control (MPC) strategy is studied for path tracking of a tilt-rotor UAV while carrying a load.

When precise positioning of the load is of concern, swing-free motion may not be sufficient for the accomplishment of the task; then the problem of path tracking of the suspended load is addressed. For instance, in [19], the authors propose a model-free open-loop approach based on trajectory generation by reinforcement learning for path tracking of the suspended load using a quadrotor UAV. A nonlinear control strategy based on cascade structure and system decoupling is proposed in [20], also for path tracking of a suspended load using a quadrotor UAV. In [22], a nonlinear solution to the suspended load path tracking problem using a quadrotor UAV is presented, in which the authors assume the quadrotor as a system actuated by total thrust and orientation. The control problem is casted into the framework described in [21], which deals with path tracking of underactuated systems driven by directed thrust and angular velocity with a double-integrator structure. By using tilt-rotor UAVs, in [23, 24], the path tracking problem of the suspended load is solved through the design of control and state estimation strategies based on linearized, time-invariant state-space equations, which did not allow yaw angle tracking, neither the occurrence of changes in the loadâ€™s mass and ropeâ€™s length.

This work intends to solve the problem of suspended load path tracking considering a realistic scenario in which the ropeâ€™s length and total system mass are not constant during take-off and landing maneuvers, the desired yaw angle varies during the mission execution, and the sensors embedded in the UAV have different sampling rates and do not measure directly the loadâ€™s position and orientation. Due to the tilt-rotor UAV highly nonlinear dynamic behavior, the unscented Kalman filter is chosen as state estimation strategy since it is not based on model linearization. Further, to perform path tracking while dealing with yaw regulation and the ropeâ€™s length variation without relying only on controllerâ€™s robustness, the MPC strategy is selected because its model-based nature allows dealing with those problems in a simple fashion way. Therefore, the main contributions of this work are as follows: (i) a detailed modeling in which the multibody systemâ€™s equations of motion are obtained from the loadâ€™s point of view, yielding an input-affine state-space representation with the loadâ€™s position and orientation as state variables; (ii) a nonlinear estimation strategy dealing with multirate noisy sensors that do not provide directly information about the loadâ€™s pose; and (iii) a control strategy that is able to cope with the path tracking of the suspended load considering yaw angle regulation, to incorporate the ropeâ€™s length variation to the control problem formulation, and to keep the UAV stabilized while rejecting external disturbances and parametric uncertainties.

The remainder of this paper is organized as follows: Section 2 develops the equations of motion of the tilt-rotor UAV with suspended load from the loadâ€™s perspective, yielding a state-space representation with the loadâ€™s position and orientation represented by state variables; Section 3 presents the unscented Kalman Filter design based on the model and measurement equations given by available sensors; Section 4 describes the model predictive control strategy designed to achieve path tracking of the suspended load based on the linearized time-varying model; Section 5 presents the model and design parameters, besides the simulation scenario used to validate the proposed control strategy; in Section 6, the numerical experiments used to demonstrate the good performance of the controller and filter are presented and discussed; finally, Section 7 concludes the work.

#### 2. Tilt-Rotor UAV with Suspended Load Modeling

This section deals with the development of the equations of motion of the tilt-rotor UAV with suspended load, from the loadâ€™s perspective. The dynamic equations, assuming a multibody system, are obtained through the Euler-Lagrange formulation, in which the coupling between the aircraft and the load is considered naturally.

##### 2.1. System Description

The computer-aided design (CAD) model of the tilt-rotor UAV with suspended load is shown in Figure 1. The system is regarded as a multibody mechanical system composed of four rigid bodies: (i) the aircraftâ€™s main body, composed of Acrylonitrile Butadiene Styrene (ABS) structure, landing gear, batteries, and electronics; (ii) the right thruster group, composed of the right thruster and its tilting mechanism (a revolute joint); (iii) the left thruster group, composed of the left thruster and its tilting mechanism; and (iv) the suspended load group, comprising the load and the rope. The system is actuated through the aircraftâ€™s thrusters and tilting mechanisms. For modeling purposes, the following assumptions are made:(A1) The rope is rigid and has negligible mass.(A2) The rope is connected to the aircraftâ€™s geometric center.(A3) The main bodyâ€™s center of mass does not coincide with the aircraftâ€™s geometric center.(A4) The thrusters groupsâ€™ centers of mass are located at their respective tilting axes.

Regarding the assumptions stated above, it is important to describe the main reasons of assumption (A3), which are as follows: (i) the center of mass is vertically displaced in order to improve the pitch moment; and (ii) the center of mass is displaced with respect to the -axis of the geometric center, allowing obtaining non-null equilibrium points for the angular positions of the tilting mechanisms and pitch angle. This mechanical feature improves the controllability of the system in hover flight, allowing the projection of the thrusts generated by propellers on the -axis without the need to tilt the thrustersâ€™ group.

##### 2.2. Kinematics from the Loadâ€™s Perspective

The loadâ€™s perspective approach consists in formulating the systemâ€™s kinematics regarding the suspended load as a free rigid body, with the aircraft as a multibody mechanical system rigidly coupled to it. Six reference frames are defined, as shown in Figure 2: (i) the inertial reference frame, ; (ii) the aircraftâ€™s geometric center frame, ; (iii) the main body center of mass frame, ; (iv) the right thruster group center of mass frame, ; (v) the left thruster group center of mass frame, ; and (vi) the suspended load group center of mass frame, . The loadâ€™s position with respect to the inertial frame is denoted by . The displacement vector from to corresponds to the rope and is expressed in by , with as the ropeâ€™s length. The displacement vectors from to are model parameters of the tilt-rotor UAV and are denoted by , expressed in , with .

The orientation of the load with respect to is parametrized by Euler angles, , using the convention about local axes. The associated rotation matrix is given by

On the other hand, the orientation of the aircraftâ€™s geometric center frame with respect to , corresponding to the orientation of the UAV with respect to the rope, is parametrized by two angles, , such that

The reference frames and are parallel to each other and attached to the same rigid body; thus the relative orientation is null, that is, (in this work is an identity matrix with dimension , is by zeros matrix, and is by ones matrix). Furthermore, the orientations of the thrustersâ€™ groups with respect to are described bywhere and are the tilting angles of the right and left thrusters, respectively, and is a fixed inclination angle of the thrusters towards the aircraft geometric center, designed to improve the aircraftâ€™s controllability [25]. The angular velocities of the system are given by , , , , and , where, for instance, denotes the angular velocity of with respect to , expressed in , withand .

From the rigid transformations of the system, the forward kinematics of points that belong to each rigid body are given bywhere is the position of a point that belongs to the suspended load body and belongs to the rigid body with attached frame . Taking the time derivatives of (5) and (6) and making use of several properties of skew-symmetric matrices [26] yieldwhere denotes an operator that maps a vector to a skew-symmetric matrix [26].

The generalized coordinates of the system are chosen according to their degrees of freedom. For the equations of motion describing explicitly the time evolution of the loadâ€™s position and orientation, these are included in the generalized coordinates, which are chosen as

Note that, due to the chosen perspective for the system kinematics, the position and orientation of the aircraft with respect to are not degrees of freedom of the system. Thus, they are not included in (9), and consequently their time evolution will not be described explicitly by the developed equations of motion.

##### 2.3. Kinetic and Potential Energies

Initially, in order to derive the equations of motion through the Euler-Lagrange formulation, the kinetic and potential energies of each body of the mechanical system must be obtained. For each th rigid body, these energies can be computed through the volume integrals [27]respectively, where corresponds to its density, to its volume, and to its mass, denotes the gravitational acceleration vector expressed in , and is the position vector obtained from the forward kinematics of the origin of .

The quadratic terms and , are obtained using (7) and (8), respectively. The kinetic energy of the load and the th body of the aircraft are obtained through (10). The total kinetic energy of the system is then computed through Writing the result in the quadratic form , and by defining the inertia tensors and , and taking into account the parallel axis theorem [28], yielding and , we have that the inertia matrix is given bywith denoting terms that are deduced by symmetry, and where , , , and . Note that, from the inertia matrix (12), the four body dynamics are completely coupled, allowing to consider this interaction in the control law design and avoid the need of cascade control structures.

The Coriolis and centripetal forces matrix, , can be calculated via Christoffel symbols of the first kind [26]. The element from its th row and th column is computed throughwhere is an element of the inertia matrix and .

The forward kinematics of each bodyâ€™s center of mass is obtained by making in (5) and in (6). Thereafter, the potential energies of the load and of each body of the aircraft are obtained using (11). The total potential energy of the system is then computed by .

Then, the gravitational force vector is given by

##### 2.4. Generalized Forces

This section obtains the contributions to generalized forces of all nonconservative forces and torques that actuate on the tilt-rotor UAV with suspended load. Let and denote a nonconservative force and a nonconservative torque, respectively, denote the point of application of , and be a reference frame rigidly attached to the body to which is applied. According to [29], the contributions of and to the generalized forces can be computed through the following mappings:where and .

The thrust forces generated by the aircraftâ€™s propellers, denoted by and , and the torques generated by the servomotors composing the tilting mechanisms, denoted by and , correspond to the input forces and torques of the system. Expressed in their respective thrustersâ€™ frames (see Figure 2), they are given by , , , and , where . In the inertial reference frame, these vectors are expressed as , , , and , with .

This work assumes that the thrust forces are applied to the centers of mass of the respective thrustersâ€™ groups, which correspond the origins of and . Making in (6) to obtain and yields

Then, using (16) and (18) yields

The servomotorsâ€™ torques are applied to the respective thrustersâ€™ bodies, and opposite torques due to reaction are also applied to the aircraftâ€™s main body. These pairs of torques are mapped to generalized forces through (17). From the addition of angular velocities [26], we have

Comparing (21), (22), and (23) to , , and , respectively, and using (17) lead to

This work also takes into account drag torques generated by the propellers. These are reaction torques applied to the thrustersâ€™ bodies, due to the bladesâ€™ acceleration and drag [30]. Assuming steady-state for the angular velocity of the blades, the drag torques are given in the thrustersâ€™ reference frames by , , where and are parameters obtained experimentally, and and are given according to the direction of rotation of the corresponding propeller: if counter-clockwise, ; if clockwise, . In the inertial reference frame, we then have and .

As the drag torques are applied to the thrustersâ€™ bodies, through (17), (22), and (23), we have

Finally, the total mapping of the system inputs to generalized forces is obtained by summing up the contributions of the thrust forces, servomotor torques, and drag torques. Then, from (19)-(20) and (24)â€“(27),where

Note that, although in this current work no aerodynamic surfaces are considered in the tilt-rotor UAV (see Figure 1), the system modeling developed here is general enough to describe the dynamics of any tilt-rotor carrying a suspended load. The only constraint is that the aircraft needs to be seen as a multibody system with similar frames definitions as those shown in Figure 2. Further, in presence of aerodynamics surfaces (e.g., wings and horizontal and vertical stabilizers), the lift and drag forces generated by them can be added to the model in a straightforward manner, by including these terms in (28), which will allow dealing with both helicopter and airplane flight modes.

In addition, viscous friction is taken into account at the revolute joints of the tilting mechanisms and also at the point of connection between the rope and the tilt-rotor UAV. It is assumed that the friction torques are mapped to generalized forces aswhere with and being constant parameters.

External disturbances applied to the suspended load are also considered, which may represent wind gusts affecting the system. Defining these disturbances in the inertial reference frame as the force vector , and assuming that is applied to the loadâ€™s center of mass, it can be mapped to generalized forces through (16), yieldingwhere is obtained by making in (7).

##### 2.5. Equations of Motion

From (12), (14), and (15), the equations of motion of the tilt-rotor UAV with suspended load can be written in the Euler-Lagrange formulation as [27]where is the total generalized forces vector, obtained by summing up the contributions from the input forces and torques (28), viscous friction torques (30), and external disturbances (31). Thus, substituting in (32) yields

Finally, by defining the state vectorand recalling the input vector defined in (28), the dynamic equations (33) can be written in the state-space representationwhich is nonlinear and highly coupled. Since the loadâ€™s position and orientation are among the generalized coordinates (9), they are represented by the state variables (34), and, consequently, the loadâ€™s behavior is described explicitly by (35). On the other hand, the aircraftâ€™s position and orientation are described only with respect to the load, thus appearing in (35) only implicitly.

#### 3. Nonlinear State Estimation

This section presents a state estimation strategy to cope with the problem of predicting the states related to the loadâ€™s pose, using the information of noisy sensors with different sampling rates, in order to gather the information necessary to build the state vector (34). The following sensors are assumed to be available: (i) a Global Positioning System (GPS) equipment to measure the and positions of the UAV; (ii) a barometer to measure the UAVâ€™s altitude; (iii) an Inertial Measurement Unit (IMU) that provides the orientation and angular velocity of the UAV; (iv) a camera that gives the position of the load with respect to the UAV; and (v) embedded sensors at the servomotors to provide the tilting angles and their time derivatives.

The measurement model is highly nonlinear and therefore some well-known estimation techniques based on linearized transformations may have limited performance. Thereby, this paper considers the unscented Kalman filter strategy that estimates the mean and covariance of the likelihood distribution by means of the Unscented Transform (UT) and then uses the Kalman Filter (KF) equations to compute the posterior distribution [31, 32].

##### 3.1. Measurement Equation

The relation between the variables measured by the embedded sensors and the state vector at time instant is given by the measurement equation where is the measured vector, corresponds to a nonlinear mapping to be obtained, and is the measurement noise.

Let be the position of the aircraft with respect to (see Figure 3). Then, through forward kinematics, the following holds:

Additionally, let be the aircraft attitude with respect to parametrized by Euler angles using the local roll-pitch-yaw convention. Therefore,

Recalling that the relation holds and considering , it is possible to state that

Furthermore, the angular velocity provided by the IMU is given bywhere the matrices and were defined in (4).

Let denote the displacement vector from to , expressed in , which is the measurement provided by the camera (see Figure 3). Then,

Finally, (37), (39), (40), and (41) along with the systemâ€™s states , , , , and the measurement noise can be grouped into the nonlinear measurement equation

This work assumes synchronized sensors with sampling rates equal to , , and , respectively, for the GPS, camera, and remaining sensors, being the control sampling time. Since not all information is available at time instant , the dimension of the vector , as well as the transformation , will change with time. Thus, from now on, the variables that have different data acquisition rates will be denoted with the subscript .

##### 3.2. Unscented Kalman Filter

In the unscented Kalman filter (UKF), a fixed number of sigma points are chosen deterministically to capture the mean and covariance of the prior distribution. These points are then propagated through a nonlinear transformation to estimate the posterior distribution [32].

Consider the discrete representation of (35) and the measurement equation (42)where is the process noise. Also, let denote estimated variables, denote information at time instant given measurements up to instant , and be the expected value operator. This work assumes that measures of are always available, and the mean and covariance are known. Furthermore, the process and measurement noises are assumed to have zero mean and covariances and , respectively, and the cross-covariance between them is assumed to be null, that is, .

In order to describe the prior statistics using UT, only sigma points are necessary, where is the dimension of the state vector [31]. The sigma points must satisfywhere are weights defined as subject to .

The sigma point matrix is chosen aswhere is the Cholesky square root.

The likelihood distribution statistics can be obtained by propagating the sigma points through the nonlinear measurement equation (42), yieldingsuch that

*Algorithm.* The UKF algorithm is formed by a forecast and a data assimilation step [32]. The operations presented below must be performed at each measurement step .

*(i) Forecast Step*(1) Form the sigma points using (46),(2) Propagate the sigma points through the nonlinear transformation (43) (3) Compute the predicted mean and covariance using (45) together with the process noise covariance (4) Form the sigma point matrix with the estimation of (5) Propagate the sigma points through the measurement model (44)(6) â€‰Compute the measurement statistics using (48) together with the measurement noise covariance and the cross-covariance of the states and measurements

*(ii) Data Assimilation Step*(1)Compute the filter gain and the innovations (2)Compute the corrected mean and covariance conditional on the measurement information

Observe that the UKF algorithm uses at all time instant all available information from the sensors to estimate the posterior distribution. For those time instants in which the measurement vector is full, that is, it has all sensors information, the estimation of will be more accurate and the covariance reduced. On the other hand, when neither GPS nor camera information is available, the data assimilation step will have a less important role on the estimation algorithm, and will be less accurate and bigger.

Finally, the state vector estimated in this section, , will be used by the control strategy presented in the next section to perform the state feedback control.

#### 4. Suspended Load Path Tracking Controller

This section describes the model predictive controller design for performing the suspended load path tracking. The main objectives of the control system are as follows: ensure closed-loop stability, reject constant external disturbances and parametric uncertainties, and satisfy constraints on state deviations and control inputs.

Aiming at an improved path tracking control and recalling the systemâ€™s underactuated behavior, the loadâ€™s position and its yaw angle are chosen to be regulated, while the other degrees of freedom will be only stabilized.

This paper works with the incremental MPC framework [33], for which the prediction model is obtained using a discrete linear time-varying state-space model that is not affine in the parameters. On one hand, the use of this kind of linear system improves the aircraftâ€™s nonlinear dynamics representation, when comparing to time-invariant linearized models, and, particularly for the proposed application, allows yaw movements regulation and copes with the ropeâ€™s length variation during the take-off and landing. On the other hand, because the time-varying linearized model used in this work is non-affine in the time-varying parameters, it is not possible to obtain, for instance, a polytopic representation for the linearized model and, then, use some well-know techniques to improve the MPC robustness.

##### 4.1. Linearized Error Dynamics

Seeking to obtain the discrete linear time-varying state-space model to construct the prediction model, the equations of motion (35) must be linearized around a time-varying trajectory. Additionally, due to limited computational resources, this process needs to be done with most of the physical parameters numerically evaluated. However, it is possible to let some physical parameters be variables in a way that they will appear in the linearized Jacobians after finishing the linearization process.

Let and denote trajectory values and, for linearization purposes, consider (see (31)). This work assumes that the desired trajectory is feasible, that is,

Then, linearizing the state-space equations (35) around these trajectories, through first-order expansion in Taylor series, yieldswhere , , and

In this work, the trajectory values for and are given bywhere denotes the left pseudoinverse of and , , and are provided reference signals with , in which is the stateâ€™s equilibrium value. Notice that , since it is computed using a left pseudoinverse, will be an exact solution to the dynamic equations (33) only if the desired trajectory is feasible.

Therefore, by linearizing the system using (59) with the trajectories defined in (60) and (61) added to the ropeâ€™s length as a time-varying parameter, the linearized Jacobians are and , where is the vector of time-varying parameters.

To improve the trajectory tracking of the regulated variables and provide constant disturbance and parametric uncertainties rejection, the state vector is augmented with integral actions [34], yieldingwhose dynamics are given by

To obtain a discrete prediction model using the incremental form and, thereafter, improve performance with input integrators added to the closed-loop system [33], it will be necessary to map the model (63) from the continuous-time to the discrete-time domain, which yields being the matrices and obtained after discretizing the model using a zero-order hold with sampling time (in this work, variables in continuous-time and discrete-time domain are differentiated by the time variable and the sampling variable ).

Finally, choosing the control increment to be the control input, the extended discrete linearized system can be rewritten in the incremental form as

##### 4.2. Prediction Model

The state-space model (65) gives the one-step ahead prediction and can be used recursively to obtain the prediction model considering a prediction horizon and control horizon . Thus, considering the case where and assuming , the -step ahead prediction yields

Thereby, defining and , it is possible to write the prediction model aswhere the matrices and are given by

##### 4.3. Optimization Problem

Consider the standard quadratic cost functionwhere for , being the reference trajectory at the instant . Moreover, and are, respectively, weighting matrices of states error and control effort.

The cost function (69) can be written in the matrix form by means of the prediction model (67) aswhere and are block diagonal matrices, and .

Finally, (70) can be rewritten in the canonical quadratic form aswhere , , and