Finite-Time Terminal Sliding Mode Tracking Control of a VTOL UAV via the Generalized NDOB
In this paper, we propose a finite-time sliding mode trajectory tracking control methodology for the vertical takeoff and landing unmanned aerial vehicle (VTOL UAV). Firstly, a system error model of trajectory tracking task is established based on Rodrigues parameters by considering both external and internal uncertainties. According to the cascade property, the system model is divided into translational and rotational subsystems, and a hierarchical control structure is hence proposed. Then, a finite-time generalized nonlinear disturbance observer (NDOB) is proposed, based on which the finite-time convergence result of equivalent disturbance estimation can be acquired. Finally, by introducing a tan-type compensator into the traditional terminal sliding mode control (SMC), the finite-time convergence result of the closed-loop control system is acquired based on Lyapunov stability analysis. Simulation results show the effectiveness of the proposed methodology.
In recent years, vertical takeoff and landing unmanned aerial vehicles (VTOL UAVs) have been widely investigated in the aspects of battlefield rescue, community logistics, scientific exploration, and disaster detection. However, the VTOL UAV system is regarded as an underactuated system with a second-order nonholonomic constraint. It inevitably suffers from parameter perturbation and complicated aerodynamic disturbance. Thus, the trajectory tracking task is a challenge work due to its nonlinearity, strong coupling and underactuated properties, internal and external uncertainties, etc.
Euler angles are widely used to establish the system model in a lot of previous works [1–6]. However, a simplified kinematics is usually expressed aswhere and are the Euler angle and angular velocity of the rigid body, respectively. It is reported in  that equation (1) is the simplified form of the original kinematics under the following two ideal assumptions: (1) the system only rotates in one degree-of-freedom (DOF) at a time, and (2) the roll/pitch DOF changes only if the pitch/roll DOF is horizontal. Meanwhile, dynamics of Euler representation suffers from gimbal lock issue, which results in singularities during large-angle flight maneuvers. The above problems can be solved using quaternion-based representation, but unfortunately, the quaternion-based representation is not unique due to the double-fold covering between mapping of (trispheres) and . In this paper, Rodrigues parameters (RPs) are introduced as the attitude representation, which is a three-dimensional vector without restrictions.
The trajectory tracking accuracy is usually affected by system uncertainties. To solve this problem, numerous approaches have been reported, such as sliding mode control (SMC) [9–14], adaptive control [15, 16], model predictive control [17–20], fuzzy control [21, 22], and neural networks [23–25]. However, the aforementioned works have some disadvantages, which make them difficult to be implemented in practice . To overcome the system uncertainties in motion control, the concept of disturbance estimation methodology has been widely investigated in recent years . For this approach, the disturbance observer (DOB) is usually employed to estimate the total disturbance online based on the control input and system output. Among the existing methods, nonlinear DOB (NDOB) has been widely used recently [27–29]. Most existing results only use the first-order structure to estimate the disturbance. Although this structure can be widely used according to its intuitional structure and simple parameter tuning, the estimation performance of high-order time-varying disturbance is largely limited due to its simple structure. In , a generalized NDOB is proposed to deal with the time-varying disturbance. It is shown that the estimation performance for time-varying disturbances of the generalized NDOB is much better than that of the traditional NDOB; however, it cannot acquire the finite-time convergence result theoretically. In this paper, we propose a modified generalized NDOB to estimate the system uncertainties, based on which finite-time convergence result can be acquired theoretically.
The modified generalized NDOB can only estimate the system uncertainties online for cancelation; thus, it should be used along with the outer-loop controller for the trajectory tracking task. The backstepping technique has been widely used due to the cascade property of the VTOL UAV [31–34]. Although this method can provide strictly stability result, the real-time property will be reduced due to calculation explosion of the backstepping technique. To overcome this problem, the terminal SMC method was introduced in , and a -type feedback term was applied to acquire the finite-time convergence result of the outer-loop controller.
From the descriptions above, a finite-time SMC based on the modified NDOB is proposed for the VTOL UAV in this paper. By selecting RPs to represent the attitude, system error model is established for the trajectory tracking object. Considering the cascade property, hierarchical technique is introduced as the control structure for trajectory tracking. Then, finite-time controllers, which contain modified generalized NDOB and terminal SMC, are proposed for both translational and rotational subsystems. Finally, the global finite-time stability result is achieved based on the bounded property of the coupling term between each subsystem. This work is motivated in the following two aspects. Firstly, since the VTOL UAV is an underactuated system with the nonholonomic constraint, the hierarchical control structure is adopted for control system implementation. Then, the trajectory tracking problem can be separated into the controller design problem for translational and rotational subsystems, respectively. Secondly, to acquire faster convergence rate and higher control accuracy, finite-time convergence theory and DOB-based concept are introduced for the controller design. The finite-time generalized NDOB and terminal SMC methodologies are proposed to formulate the controller for each subsystem. The main contributions of this research are summarized as follows:(1)A modified generalized NDOB is proposed by introducing a nonlinear feedback into the traditional structure to acquire finite-time convergence of disturbance estimation(2)The finite-time terminal SMC method is proposed by using a -type function as a feedback compensator(3)The Rodrigues theorem is employed to analyze the property of coupling term between each subsystem, based on which finite-time stability of the closed-loop system is obtained
This paper is organized as follows. The trajectory tracking task is considered to establish the system error model based on RPs in Section 2. In Section 3, according to the cascade property based on hierarchical technique, the system error model is divided into translational and rotational subsystems, and finite-time generalized NDOB-based terminal SMC is proposed for each subsystem. In Section 4, global finite-time Lyapunov stability is obtained. In Section 5, effectiveness of the proposed methodology is demonstrated by numerical simulations. Conclusions are summarized in Section 6.
2. Problem Formulation
In this section, the finite-time convergence theorem is firstly introduced. Then, the system error model of the VTOL UAV for trajectory tracking task is established based on RPs, and the control object is also presented.
Definition 1. The operator for the vector is defined as
Lemma 1 (see ). Consider the system in the following form:where is a state vector and is a known continuous vector field. Assume that there exists a continuous positive definite Lyapunov function which satisfies the following inequality:where and . Then, the origin of the system is globally stable in finite time :
Lemma 2. (see ). Considering the system in equation (3), assume that there exists a continuous positive definite Lyapunov function which satisfies the following inequality:where , , and . Then, the origin of the system is globally stable in finite time :
2.2. System Description
In this work, we use RPs to establish the system model. Defining and as the unit vector of the rotation axis and the rotation angle, the RPs are given as . The VTOL UAV model is described as follows :where denote the position and velocity of the rigid body, is the unit vector of the -axis, and are the masses of the inertial matrix of the rigid body, and are the control thrust and torque, and denotes the attitude transition matrix. in terms of RPs is expressed aswhere is a third-order identity matrix and the operator denotes the skew symmetric matrix.
In this research, a trajectory tracking task is considered, and the object is used to design the control thrust and torque to make the VTOL UAV to track the desired trajectory quickly and accurately. The vector is the desired trajectory, which contains the desired position, velocity, and acceleration.
The following system error states are introduced aswhere and can be acquired according to the desired rotation matrix, is known as inverse of , which is extracted as , and operator represents the production of RPs, which is expressed as follows with two RPs:and is regarded as the attitude error matrix.
The system error model is given as
Both system uncertainties and external disturbances are considered in this work. It is assumed that the mass and inertia error are defined as
The Euler–Lagrange equations can be written aswhere is the time derivative of . The equivalent disturbances and on system dynamics are expressed aswhere denotes the vector form of the diagonal elements of and , where and denote the skew symmetric matrix and diagonal matrix of a vector.
It is assumed that the first-order time derivative of equivalent disturbances and is bounded as
From the descriptions above, the following control system design procedure is presented based on the Euler–Lagrange equations in equation (14). From equation (10), we can obtain that and when and . Since desired attitudes , , and are obtained by the rotation matrix , the VTOL UAV can obtain the desired acceleration by stabilizing the attitude subsystem. Thus, trajectory tracking control object can be equivalently transformed into the stabilization of the error system in equation (14) with the equivalent disturbances described in equation.(15). Consequently, the control object turns to design the thrust and torque for the stabilization of equilibrium points , , , and , with total disturbance in equation (15).
3. Control System Design
According to the cascade property of the system model and the control object, the hierarchical technique is first adopted to implement the control structure. Then, a finite-time terminal SMC methodology based on the modified NDOB is proposed for both translational and rotational subsystems, respectively.
3.1. Hierarchical Control Structure
From equation (12), we find that the VTOL UAV is a cascade system. Thus, the overall closed-loop system could be divided according to the convergent speed of each part according to the singular perturbation theory. Since the translational subsystem will converge after the convergence of the rotational subsystem, it is regarded that the translational subsystem is a slow subsystem, while the rotational subsystem is a fast subsystem. Thus, hierarchical technique can be introduced to implement the control system. The controllers for translational and rotational subsystems can be designed separately.
Figure 1 shows the hierarchical control structure proposed in this paper. The controller for the translational subsystem is first designed to acquire the desired thrust and desired transition matrix , which make the UAV to track a desired trajectory. Then, the desired attitude of rotational subsystem can be acquired according to rotation matrix . At last, the rotational controller can calculate the desired torque vector to stabilize the rotational subsystem.
In order to separate these two subsystems, the translational error dynamics can be rewritten aswhereis regarded as the coupling term between the two subsystems. During the design of the translational controller, it is assumed that the rotational controller has already converged with . Although it is assumed that during the design of the translational controller, the strict Lyapunov stability is still analyzed based on the original dynamics of equation (14).
To analyze the stability of the closed-loop system, it is necessary to analyze the property of the coupling term . According to the Rodrigues theorem, the Euclidean norm of is given as
Since is a quadratic form, we havewhere operators and denote the minimum and maximum eigenvalue of a matrix. Notice that the characteristic polynomial of is with the roots 0 and ; thus,which means equals 0 after the convergence of the rotational subsystem, and the upper bound of is .
3.2. Modified NDOB
The controller for each subsystem consists of two parts: inner-loop DOB and outer-loop controller. In this section, a modified generalized NDOB is proposed to enable the estimated disturbance to converge in finite time. For the translational dynamics, the traditional generalized NDOB can be designed as follows :
By substituting equation (22) into translational dynamics, we havewhich indicates that the estimation error is bounded with positive definite and . To acquire finite-time stabilization of the estimation error, the generalized NDOB of equation (22) is modified into the following form:where denotes the three axes and and are positive matrices.
Similarly, the modified generalized NDOB for the rotational subsystem is designed as follows:where denotes the three axes and and are positive matrices.
Theorem 1. The modified generalized NDOB in equation (24) for the translational subsystem and equation (25) for the rotational subsystem will enable the disturbance estimation error converge to a sufficiently small region in finite time under assumptions in equation (16).
Proof. For the translational subsystem, by defining the following error variables,it follows thatFor the proposed translational NDOB, Lyapunov function is selected as is defined asThe dynamic equation of is given aswithwhere . For proper defined and , matrix is a Hurwitz matrix. Thus, there exists a positive definite matrix such thatThus, the first-order time derivative of isMatrix can also be expressed asand it follows thatSince is a diagonal matrix and , there existsIf , then , and we haveSubstituting equation (37) into equation (33), we haveWith , there exists a constant such thatNotice that and are adjusted to make sure , letting , and we can obtain thatThus, converges to the region in finite time , defined asIf , then , and we haveSubstituting equation (42) into equation (33), we haveIfis satisfied, there exists such thatThen, we can obtainTherefore, can converge to the regionin finite time .
Notice that if the suitable parameters are selected to make sufficiently large, the defined error variable can converge to a sufficiently small region of 0 in finite time, which indicates that the disturbance estimation error will converge to a sufficiently small region of 0 in finite time.
Similarly, for the rotational subsystem, by defining the following error states,it follows thatThe estimation error dynamics of the rotational subsystem in equation (49) has the same form as equation (27) of the translational subsystem; thus, the finite-time convergence results of the rotational subsystem can be obtained similarly. This completes the proof.
3.3. Finite-Time Terminal SMC
With the disturbance estimation of the DOB, the estimated system uncertainties can be compensated in the outer-loop controller. In this section, a finite-time terminal SMC is proposed to stabilize each subsystem along with the proposed NDOB . The sliding surface for the translational subsystem is defined as follows:where and are positive constants and and are odd positive integers satisfying . With the above form of the sliding surface, if , the convergence time can be calculated as follows :which implies that if the sliding surface equals 0, the system states will converge to the equilibrium point in finite time.
The translational controller is designed as follows:where is a sufficiently small positive constant which reflects the convergence region of the estimation error of the proposed NDOB; is defined aswhere and are positive constants and is a positive constant satisfying . is selected such that .
For the rotational subsystem, the sliding surface is defined aswhere and are positive constants and and are odd positive integers satisfying .
The rotational controller is designed as follows:where is a sufficiently small positive constant which reflects the convergence region of the estimation error of the proposed NDOB; is defined aswhere and are positive constants and is a positive constant which satisfies . is selected such that .
4. Stability Analysis
In this section, we analyze the Lyapunov stability of the overall closed-loop system.
Theorem 2. For original system error model equation (14) satisfying the assumption in equation (16), with the NDOB proposed in equation (24), sliding surface of equation (50), controller equation (52) for the translational subsystem and the NDOB proposed in equation.(25), sliding surface of equation (54), controller equation (55) for the rotational subsystem, the system tracking error will converge in finite time.
Proof. For rotational dynamics, the Lyapunov function is selected as follows:According to the L′Hospital rule, it is shown thatwhich means that the tan-type Lyapunov function reduces to standard quadratic ones if .
The first-order time derivative of is obtained asDifferentiating sliding surface equation (54) with respect to time and then substituting rotational controller equation (55), one can obtainBy substituting rotational controller equation (60) into equation (59), we can obtainAccording to Theorem 1, the estimation error of the NDOB will converge to a sufficiently small region in finite time. Assume that if , the estimation error of the rotational NDOB satisfies ; thus, we can conclude that the second part of the above inequality is negative definite. Thus, we have the following inequality which holds if :According to Lemma 2, the sliding surface of rotation dynamics will converge in finite time asAccording to the definition of , when , the error states and will converge to the equilibrium point in finite time according to equation (51):For the translational dynamics, the Lyapunov function is defined asSimilarly, the first-order time derivative of is obtained aswhen .
Similarly, assume that if , the estimation error of the translational NDOB satisfies . If , we haveAccording to Lemma 2, the sliding surface of translational dynamics will converge in finite time asAccording to the definition of , when , the error states and will converge to the equilibrium point in finite time asThis completes the proof.
In this section, numerical simulations are carried out in Matlab/Simulink to show the effectiveness of our methodology. The VTOL UAV system is considered with the following parameters: , , and . The control parameters are selected as follows: , , , , , , , , , , , , , , , and . Simulation step is .
5.1. Case 1
In this section, a spiral rising trajectory is chosen as the desired trajectory. The adaptive backstepping and PD approaches are considered for comparison. The analytical expression of the desired trajectory is given as
Both aerodynamics disturbances on translational and rotational subsystems are given as
For the comparisons among the proposed method, adaptive backstepping and PD approaches of trajectory tracking performance are demonstrated in Figure 2. We can find that the trajectory tracking accuracy of the proposed methodology is higher than the accuracy of the adaptive backstepping and PD controller. For the adaptive backstepping method, the convergence rate of the adaptive algorithm is less than that of the proposed finite-time generalized NDOB. Notice that the PD controller is an error-based method, and the control output cannot reject the disturbance actively. The traditional PD controller cannot decrease the tracking error effectively under time-varying disturbances. Thus, the accuracy of the PD controller is less than the other two methods. The tracking error of position, velocity, RPs, and angular velocity of the proposed approach is shown in Figures 3–6. It is shown that the proposed methodology can make the tracking error converge quickly and accurately. The estimation errors of both translational and rotational subsystems are shown in Figures 7 and 8. The proposed finite-time generalized NDOB can estimate the system uncertainties accurately. The root mean square (RMS) error of the above methods is shown in Table 1. It is clear that the tracking error of our method is less than that of the other two methods.
5.2. Case 2
In this section, the estimation performance of the proposed generalized NDOB is analyzed in detail. The comparisons with the traditional generalized NDOB  are also carried out. The analytical expression of the desired trajectory is chosen as
The aerodynamics disturbances are the same as Case 1, and we assume that there is an extra external disturbance acting on the translational dynamics at times of and . In Figure 9, the trajectory tracking effect of the proposed method is compared with the traditional method, and the projection of the results on every 2D plane is also presented. The specified tracking error comparisons are expressed in Figures 10 and 11. Figure 12 shows the estimation error of the proposed and traditional NDOB. Simulation results in Figure 9 show that the sudden change of external disturbances brings the system with the tracking error. In the simulation, the same observer gain is chosen for both modified and traditional generalized NDOB. From Figure 12, we can find that, by using the proposed observer, the convergent time is less than , while the convergent time of the traditional observer is more than . Moreover, for the continuous time-varying disturbances, the estimation error of the traditional method is larger than that of the proposed method. This will in turn affect the tracking accuracy. The specified tracking error is depicted in Tables 2 and 3. It is shown that the max cross-tracking error of the proposed approach is less than the traditional method in both steady and transient states.
From the descriptions above, we can conclude that the proposed approach can successfully deal with the trajectory tracking task of a VTOL UAV. With the hierarchical control structure, the translational controller can obtain the desired thrust and attitude to stabilize the trajectory tracking error, while the rotational controller can enable the aircraft to track the desired attitude quickly and accurately. Comparing with the traditional control scheme, our proposed methodology can obtain higher controller accuracy, as well as faster convergence rate. Meanwhile, the proposed NDOB can decrease the estimation error, which will provide higher control accuracy. In a word, comparing with the traditional method, the proposed methodology can acquire less convergence time and higher control accuracy.
In this research, we focus on the trajectory tracking task of a VTOL UAV, and a modified generalized NDOB-based finite-time terminal SMC methodology is proposed. Different from the most existing works, RPs are used in this paper to establish the system error model, based on which the system error model is divided into translational and rotational subsystems according to the cascade property. By introducing the nonlinear feedback, the finite-time generalized NDOB is proposed to acquire better disturbance estimation performance; hence, terminal SMC technique is applied for the desired trajectory tracking performance. Simulations show that the modified generalized NDOB can bring with higher convergent speed and estimation accuracy, and the proposed methodology has better control performance compared with the traditional methods.
The proposed methodology can only deal with the trajectory tracking task for a single VTOL UAV. However, this work does not contain the trajectory planning problem of the aircraft with environmental obstacles. In future works, the trajectory planning problem with complicated obstacles will be considered. Also, the complex tasks that require multiple UAVs will be investigated. Moreover, the experimental setup will be implemented to validate the effectiveness of the corresponding methods.
The simulation data used to support the findings of this study are available from the corresponding author upon request.
Conflicts of Interest
The authors declare that there are no conflicts of interest regarding the publication of this paper.
This work was supported partly by Key Project of National Natural Science Foundation of China under Grant 61633008, the Preeminent Youth Fund of Heilongjiang Province under Grant JJ2018JQ0059, the China Postdoctoral Science Foundation under Grant 2018M641806.
J. H. Ginsberg, Advanced Engineering Dynamics, Cambridge University Press, Cambridge, UK, 1995.
Y. Yu, Y. Guo, X. Pan, and C. Sun, “Robust backstepping tracking control of uncertain MIMO nonlinear systems with application to quadrotor UAVS,” in Proceedings of the International Conference of Information Automation, pp. 2868–2873, IEEE, Lijiang, China, August 2015.View at: Publisher Site | Google Scholar