Abstract

This paper presents a highly robust trajectory tracking controller for small unmanned helicopter with model uncertainties and external disturbances. First, a simplified dynamic model is developed, where the model uncertainties and external disturbances are treated as compounded disturbances. Then the system is divided into three interconnected subsystems: altitude subsystem, yaw subsystem, and horizontal subsystem. Second, a disturbance observer based controller (DOBC) is designed based upon backstepping and multivariable super twisting control algorithm to obtain robust trajectory tracking property. A sliding mode observer works as an estimator of the compounded disturbances. In order to lessen calculative burden, a first-order exact differentiator is employed to estimate the time derivative of the virtual control. Moreover, proof of the stability of the closed-loop system based on Lyapunov method is given. Finally, simulation results are presented to illustrate the effectiveness and robustness of the proposed flight control scheme.

1. Introduction

The helicopters have many advantages over ordinary fixed-wing vehicles. With the capability of hovering, vertical taking-off and landing, high levels of agility, and maneuverability, unmanned helicopters have been used in urban and mountainous environment. They have wide application prospects in the field of military and civilian. However, the unmanned helicopter system is a nonlinear, underactuated, and strong coupled system. Consequently, it is a challenging research area to design high-performance controllers [1, 2].

Generally, control methods for unmanned helicopters can be classified into two categories: linear controllers and nonlinear controllers. Traditional methods are based on linear model, such as PID [3], LQR [4], [5, 6], and -synthesis [7]. Nevertheless these linear control methods are only effective when the states of the unmanned helicopter system are near the equilibrium points. In order to overcome these shortcomings, many nonlinear control methods are developed, such as feedback linearization [8], model predictive control [9], intelligent control [10], backstepping control [11ā€“14], and sliding mode control [15ā€“19]. Among these methods, backstepping control algorithm has drawn much attention of many researchers. Backstepping designs can avoid cancellation of useful nonlinearities and often introduce additional nonlinear terms to improve transient performance. Moreover, backstepping is an effective control algorithm for underactuated systems as unmanned helicopter system [13]. The key idea behind the backstepping design technique is that some virtual control inputs are introduced to counterbalance the number of inputs and outputs. However, exact knowledge of the plant model is necessary for backstepping control design. It is practically impossible to obtain the exact model of unmanned helicopter system. Sliding mode control algorithm is known as a robust control method [15, 16]. It is able to make the system keep robustness and stability even in the presence of disturbances. Among all of the sliding mode control algorithms, super twisting control algorithm is the most popular one [17ā€“19]. This algorithm possesses the property of finite time convergence. And it can alleviate chattering phenomena, because the switching control part is hidden into the derivative of the sliding mode variable [20]. However, traditional super twisting control algorithm only keeps robustness with matched disturbances and only can deal with single-input single-output systems.

The combination of backstepping and multivariable super twisting control algorithms makes it possible to control the unmanned helicopters with the high-order, multiple-input multiple-output, underactuated, and disturbance rejection problem effectively. A sliding mode observer is developed to estimate the compounded disturbances including matched and unmatched disturbances [21]. By integrating the observer output into the controller, the compounded disturbances can be compensated for to improve the robust performance. Thus, this disturbance observer based control (DOBC) scheme will be robust with both matched and unmatched disturbances. Furthermore, a first-order exact differentiator is employed to estimate the time derivative of the virtual control, which can avoid large calculation load [22]. It is proved by Lyapunov technique that the closed-loop tracking error is globally asymptotically stable.

The organization of this paper is as follows. Section 2 briefly recalls the full dynamic model of small unmanned helicopters with compounded disturbances. In Section 3, the complete design procedure of the disturbance observer based controller (DOBC) is presented. The stability analysis of the proposed controller is carried out in Section 4. In Section 5, numerical simulations are conducted to demonstrate the robust performance of the proposed control method. Section 6 presents the conclusion.

2. Helicopter Model

The small unmanned helicopter is a highly nonlinear, strong coupled, and underactuated system with model uncertainties and external disturbances [2]. It is difficult to obtain a complete model for its high order and large number of parameters. Moreover, it is unmanageable for us to design a practical controller. Therefore, this paper treats the unmanned helicopter as a six-degrees-of-freedom rigid-body model with simplified force and moment generation process and considers model uncertainties and external disturbances as compounded disturbances [9]. Thus, we will proceed on the flight control design based on the simplified unmanned helicopter model.

The first step to the development of the rigid-body equations of motion is the definition of two reference frames. The first one is the inertial coordinate defined as . The second is the body fixed reference frame defined as . The small unmanned helicopter system can be seen in Figure 1.

The rigid-body dynamics of the unmanned helicopter can be expressed as follows:where is the acceleration due to gravity, is the total mass of the unmanned helicopter, is the diagonal inertia matrix, and . and represent the position and velocity in the inertial frame, and and represent the Euler angles and angular rates in the body frame. The rotation matrix and the attitude kinematic matrix are defined, respectively, as follows:where the compact notation denotes , denotes , and denotes .

and are the external force and moment vectors, generated by the main rotor thrust and the tail rotor thrust, which are the main powers of the unmanned helicopter. and are normalized force and moment disturbances that include internal couplings, unmodelled dynamics, and wind gusts. They are defined, respectively, aswhere is main rotor thrust controlled by collective pitch : , and is the collective pitch of the tail rotor. The parameters , , , , , , can be obtained by system identification. The longitudinal flapping angle and lateral flapping angle , cannot be measured directly, but they are controlled by lateral and longitudinal cyclic , as follows:where the parameters , , , , also can be obtained by system identification.

Substituting (8) into (5), a more compact form of the torque can be obtained as follows:whereThe parameters in these matrices can be given as follows:

The modified unmanned helicopter model combining (1)ā€“(11) can be described in the following form:where is the helicopter state vector, is the control input vector, and and are the compounded disturbances vector acting on the unmanned helicopter.

For convenience of controller design, the following formula will be used:where is a skew symmetric matrix, and it can be defined as follows:Actually, (16) has the same meaning as (14).

According to the feature of the unmanned helicopter model, the system can be divided into three interconnected subsystems: altitude subsystem, yaw subsystem, and horizontal subsystem. The controller for each subsystem can be designed separately. Considerwhere , , , , , , , , ā€‰, , and , and represents the element of th row and th column of the rotation matrix .

3. Controller Design for Small Unmanned Helicopter

3.1. Modified Multivariable Super Twisting Algorithm

Here, a modified multivariable super twisting algorithm is used for our controller design. In order to make the multivariable super twisting algorithm [23] more suitable for the small unmanned helicopter, some modifications are made as follows.

Consider the multivariable systemwhere , , , and are positive constants and , are perturbations.

Assumption 1. The perturbations and are globally bounded byfor some constants , .

Theorem 2. Under Assumption 1, if the parameters and satisfyall the trajectories of system (21) will converge to origin in finite time.

Analysis and Proof. The multivariable super twisting algorithm in Theorem 2 is developed based on the proposal in [23]. Some modifications are made to this algorithm. First, it is assumed that the perturbation satisfies instead of in [23]. Second, the linear control terms are removed in multivariable system (21).

The stability analyses of these two algorithms are similar. And the details of the proof can be found in article [23]. So we only give the outline of the stability analysis below.

We define a Lyapunov function candidate for system (21) as follows:Define a vector . Considering system (21) and perturbations (22), the time derivative of (24) can be obtained as follows:whereIf , then . It is easy to see that this is the case if the parameters satisfyDefine , and note that for all values of and . So we can derive and , where is an appropriate symmetric positive definite matrix. Finally, we can get thatwhere .

Therefore, will converge to . And will converge to in finite time, because the right hand of the first equation in (21) equals zero when and .

Remark 3. The proposed multivariable super twisting algorithm is developed by modifying the algorithm in [23]. Now we will clarify the motivations for these modifications as follows. First, the starting points of these two papers are different. The article [23] is a purely theoretical research work, whose goal is to propose a new algorithm theoretically without considering the particular practical application problem. However, the fundamental purpose of our paper is to develop an appropriate algorithm to control the unmanned helicopters effectively. Thus, we need to modify the existing algorithm to make it applicable for unmanned helicopters. Second, in our helicopter control system, the actual meaning of is the disturbance estimation error, which is a very small perturbation rather than a linearly growing one. Therefore, it will be reasonable to suppose that satisfies instead of in [23]. Moreover, when is small (), we can derive . Therefore, the proposed algorithm in our paper can tolerate stronger perturbations near the origin than the one in [23]. Third, since the perturbations and both are not linearly growing ones, it is not necessary to use the linear control terms in system (21), which deal with the linearly growing perturbations effectively [18, 23]. The proposed algorithm is able to deal with the strong perturbations near the origin, such as and in this situation. And the modified algorithm needs fewer parameters than the one in [23]. Therefore, it is more convenient to be applied for the unmanned helicopter system. Moreover, the simulation results in Section 5 will support our analysis that the modified multivariable super twisting algorithm is very effective in controlling the unmanned helicopter.

3.2. Disturbance Observer Based Controller (DOBC) Design

In this section, a disturbance observer based controller (DOBC) is proposed for the unmanned helicopter system. The composite controller structure is illustrated in Figure 2.

The main control objective of this paper is to design the control inputs in order to track the reference trajectories of , and to stabilize the pitch and roll angles , in the presence of compounded disturbances. To deal with the subsequent control development, some assumptions are made as follows.

Assumption 4. The reference trajectories are available. Moreover, and are functions of time, and and are functions of time.

Assumption 5. It is assumed that and for .

Obviously, this assumption can ensure the attitude kinematic matrix defined in (3) will not be singularity [12ā€“14].

The detailed design process is described as follows.

3.2.1. Multivariable Super Twisting Based Observer

In the controller design procedure, the estimated disturbances and will be used, which are estimated by multivariable super twisting observers.

Considering the following dynamic models:the state-like observers are designed as follows:where and are the outputs of sensors, regarding real values. and are the estimated states of the observers.

State estimation errors can be defined as follows:Combining (29) and (31), we can deriveSimilarly, combining (30) and (32), we can derive

Theorem 6. If the derivatives of disturbances are globally bounded by , , and the parameters in observers (31) and (32) satisfythe estimated disturbances converge to real disturbances in finite time.

Proof. The observer dynamics (34) and (35) can be rewritten as follows:Define , , , so (37) can be rewritten as follows:Considering (38), we can derive that Theorem 6 is the special case of Theorem 2 when (22) turns into Thus, the parameters in (23) will turn into the following form:

3.2.2. Altitude Subsystem

Considering the altitude subsystem dynamics described in (18), the altitude controller can be designed as follows.

Step 1. Define the altitude tracking error as follows:where is the reference altitude trajectory, and define the vertical velocity tracking error as follows:Taking the time derivative of (40), it yieldsSubstituting (41) into (42), the open-loop altitude tracking error dynamics can be written as follows:where is the desired vertical velocity. It can be viewed as virtual control and is designed as follows:where is a positive control gain. Then the closed-loop altitude tracking error dynamics will be obtained as follows:

Step 2. Taking the time derivative of (41), the open-loop vertical velocity tracking error dynamics can be written as follows:Define the collective pitch as follows:where and are equivalent control and switching control, respectively.
The equivalent control is chosen as follows:where is the estimated disturbance in altitude subsystem.
Substituting (47) and (48) into (46), we can obtain the dynamics of as follows:where is the disturbance estimation error.
The sliding variable can be chosen as follows:

3.2.3. Yaw Subsystem

Considering the yaw subsystem dynamics described in (19), the design procedure of the yaw controller is similar to the altitude controller in Section 3.2.2. Thus, the simplified procedure is given as follows.

Step 3. The open-loop yaw tracking error dynamics can be written as follows:where is the virtual control designed as follows:where is a positive control gain. Then the closed-loop yaw tracking error dynamics will be obtained as follows:

Step 4. The open-loop yaw angular velocity error dynamics can be written as follows:Define the collective pitch of the tail rotor as follows:The equivalent control is chosen as follows:where is the estimated disturbance in yaw subsystem.
Substituting (55) and (56) into (54), we can obtain the dynamics of as follows:where is the disturbance estimation error.
The sliding variable can be chosen as follows:

3.2.4. Horizontal Subsystem

Considering the horizontal subsystem dynamics described in (20), the horizontal controller can be designed as follows.

Step 5. Define the horizontal tracking error as follows:where is the reference horizontal trajectory, and define the horizontal velocity tracking error as follows:Taking the time derivative of (59), it yieldsSubstituting (60) into (61), the open-loop horizontal tracking error dynamics can be written as follows:We design the virtual control as follows:where is a diagonal matrix of positive control gain. Then the closed-loop horizontal trajectory tracking error dynamics will be obtained as follows:

Step 6. Taking the time derivative of (60), the open-loop horizontal velocity tracking error dynamics can be written as follows:The orientation error is defined as follows:Substituting (66) into (65), the open-loop horizontal velocity tracking error dynamics can be rewritten as follows:The desired orientation is viewed as virtual control and can be chosen as follows:where is a diagonal matrix of positive control gain, and is the estimated disturbance in horizontal subsystem. Then the closed-loop horizontal velocity tracking error dynamics will be obtained as follows:where is the disturbance estimation error.

Step 7. Taking the time derivative of (66), the open-loop orientation error dynamics can be written as follows:We define the horizontal angular velocity error as follows:Substituting (71) into (70), the open-loop orientation error dynamics can be rewritten as follows:The virtual control can be designed as follows:where is a diagonal matrix of positive control gain. Then the closed-loop orientation error dynamics will be obtained as follows:

Step 8. Taking the time derivative of (71), the open-loop horizontal angular velocity error dynamics can be written as follows:The control law is designed as follows:where and are equivalent control and switching control, respectively.
The equivalent control is chosen as follows:where is the estimated disturbance in horizontal subsystem.
Substituting (76) and (77) into (75), we can obtain the dynamics of as follows:where is the disturbance estimation error.
The sliding variable can be chosen as follows:

3.2.5. Multivariable Super Twisting Control Law

We rewrite (49), (57), and (78) as the following form:

These three sliding mode systems can be summarized to a multivariable canonical form:where is the disturbance estimation error, and , are the sliding variable and control input vector, respectively.

From Theorem 6, we can obtain that will converge to zero in finite time. Thus, it will be reasonable to state the following assumption.

Assumption 7. The disturbance estimation error is globally bounded byfor some constants .
The multivariable super twisting control law can be designed as follows:where , are controller gains.

Theorem 8. Consider system (83) under Assumption 7. If the parameters in control law (85) satisfyall the trajectories of system (83) converge to the origin in finite time.

Proof. Considering (83) and (84), we can derive that Theorem 8 also is the special case of Theorem 2 when (22) turns into Thus, the controller parameters in (23) will turn into the following form:From (80)ā€“(86), we can obtain the control signals , , and . Thus, the switching control inputs , , , and also can be derived. Combining (48), (56), and (77), the control input vector will be derived as follows:

Remark 9. Systems (80) and (81) are both the special cases of multivariable system (83), where the dimension is ; that is to say, the control signals and are the single-variable super twisting control laws.

Remark 10. The discontinuities in control law (85) will only occur when all the components of the vector equal zero, but for decoupled single-variable super twisting algorithm, the discontinuities will occur when any of the components of the vector equals zero. And the observers (31) and (32) have the same characteristic too. Therefore, the proposed nondecoupled multivariable super twisting algorithm has improved chattering reduction properties relative to decoupled single-variable super twisting algorithm in some degree.

3.2.6. Super Twisting Based Differentiator

In the controller design procedure, some derivatives of virtual controls are required. In order to lessen calculative burden, super twisting algorithm based exact differentiators are deigned as follows:where is the estimate of , and is the estimate of . When the parameters and are chosen appropriately, will converge to in finite time. So will be used in the controller instead of .

Among these virtual controls, the derivatives of (68) and (73) are quite complicated, so these two derivatives will be estimated by exact differentiators.

4. Stability Analysis for Unmanned Helicopter System

In this section, we will give the stability analysis for unmanned helicopter system by Lyapunov technique.

The three closed-loop subsystems are displayed as follows:where , , and represent super twisting control laws, and , , , and represent disturbance estimation errors.

Theorem 11. Consider the helicopter model (18)ā€“(20), under Assumptions 1ā€“7. If the disturbance observers are designed as (31) and (32), and the control inputs are chosen as (88), the position and yaw tracking errors globally asymptotic converge to zero.

Proof. From the above analysis, we can conclude that sliding mode variable will converge to manifold in finite time and remain zero for all subsequent time, and disturbance estimation error will converge to zero in finite time too. Therefore, the closed-loop system dynamics are governed by the following reduced order system:Considering the above closed-loop system, we define a Lyapunov function candidate as follows:where , , and can be defined, respectively, asBy taking the time derivation of (92), we can derive the following equation:To sum up, the position and yaw tracking errors will globally asymptotically converge to zero.

5. Simulation Results and Discussion

In order to verify the effectiveness of the proposed control scheme to the unmanned helicopter, simulation tests are presented in this section. The numerical simulations are conducted in the MATLAB. The parameters of unmanned helicopter are shown in Table 1, and the parameters of the proposed controller are shown in Table 2.

The proposed control method will be compared with the control method proposed in [24] to demonstrate the merits of it. Moreover, the control method proposed in [24] is backstepping sliding mode control (BSMC) method without disturbance observer.

The slalom flight path is a typical trajectory to examine the maneuver performance. It can test the tracking accuracy, robustness, and coupling properties. The desired slalom flight path and are designed as follows:In order to demonstrate the excellent tracking performance comprehensively, nonzero initial position and Euler angle are set as and .

During the simulation, the model uncertainties and external disturbances are added to verify the robustness of the proposed controller, where represents the model uncertainty matrix, and all of its elements are pseudorandom values on the interval . The external disturbance is .

The simulation results are illustrated in Figures 3ā€“6. Figure 3 shows the position tracking responses, while Figure 4 depicts the Euler angle tracking responses. Through these figures, one can see that the proposed controller is superior to the BSMC in [24] for its tracking performance, which is specific in its gentler dynamic process, faster tracking ability, and smaller overshoot. Moreover, the control inputs of the proposed method are smoother than the BSMC proposed in [24] which suffer from chattering phenomena seriously (see Figure 5). Finally, Figure 6 illustrates the effectiveness of the designed disturbance observer. One can see that the observer can estimate the compounded disturbances accurately.

From the simulation results, we can obtain that the proposed controller is very effective in controlling the unmanned helicopter in the presence of both matched and unmatched disturbances. However, some limitations of the controller should be discussed here. First, the proposed control scheme is a hierarchical control strategy. The controller structure is somewhat complex, so we need to design it very carefully. Second, there are still many parameters to be known in the helicopter model and controller.

6. Conclusion

A disturbance observer based controller using backstepping and multivariable super twisting control technique is developed for small unmanned helicopters. The compounded disturbances and the time derivatives of the virtual controls are estimated by super twisting based observer and differentiator. The proposed controller possesses the robustness with both matched and unmatched disturbances. The finite time stability of the modified multivariable super twisting algorithm and global asymptotic stability of the closed-loop helicopter system are proved by Lyapunov theory. Finally, numerical simulation results demonstrate the effectiveness of the proposed flight control scheme, which is superior to the BSMC in [24] for its accurate tracking performance and chattering attenuation ability. The proposed control method will be tested on the experimental helicopter platform in future work.

Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

Acknowledgments

This work is supported by the Natural Science Foundation of China (61403274) and the Application Base and Frontier Technology Research Project of Tianjin of China (13JCQNJC03600).