Abstract
This work aims to develop finite-time stability property for trajectory tracking control system of small-scale unmanned helicopter subjected to uncertainties and external disturbances. The added power integrator method is applied to construct the nominal feedback control part, such that helicopters’ closed-loop system possesses highly tracking performance due to finite-time convergence property. In view of the existence of strong couplings, approximate feedback linearization is initially conducted to simplify and decouple helicopters’ input–output dynamics. Additionally, to guarantee robustness, the composite active disturbance rejection control idea is employed. These unknown perturbations are estimated using high-order sliding mode disturbance observers and compensated for directly in every virtual control law. Finite-time convergence property of the closed-loop system with disturbances is proven through Lyapunov stability theory. Finally, several comparison simulations illustrate the effectiveness and superiority of our proposed methods.
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.Avoid common mistakes on your manuscript.
1 Introduction
Unmanned helicopters have received wide interest in recent decades because of their capabilities, including highly agile maneuvering, vertical taking off and landing, and broad envelope of flight [1, 2]. Helicopters have been widely applied into rescue, surveillance, supervision, defense, and other areas. In most of the practical application scenes, helicopters are required to quickly and accurately track a prescribed trajectory. However, controlling unmanned helicopters, especially small-scale ones, is not an easy task due to their complex aerodynamics, strong nonlinearities and dynamic couplings, and significant parameter and model uncertainties [1,2,3,4]. To date, designing a high-performance controller for helicopters is still an attractive focus.
In the last decades, many meaningful results for helicopter controls have been proposed. Tradition linear control method, such as PID [1], linear quadratic regulation [5], \(H_{\infty }\) control theory [4,5,6], and gain-scheduling controllers [7], is based on the model linearized around the trim points that may utilize synthesis techniques. These techniques are convenient for engineering application. However, guaranteeing satisfying performances of the whole system in full envelope is difficult. Nonlinear control technique, including backstepping [8,9,10,11,12], nonlinear dynamic inversion [13], sliding mode (SM) [14], nonlinear model predictive control [15], and output regulation [16], is applied to conquer this main defect.
Robustness becomes one of the main performance indexes of helicopter given the presence of model uncertainties and external perturbations in its operational environment [1, 4]. Traditional robust control strategies, including \(H_{\infty }\) control, SM, and adaptive control, are applied to “inactively” attenuate the effect of disturbance at the cost of sacrificing their nominal performance [17]. Recently, an alternative approach called “active” disturbance reject control (ADRC), which provides a compound controller composed of a nominal feedback control part and a disturbance compensation part, is proposed [17, 18]. The nominal feedback control part guarantees basic stability and closed-loop performance, and the other part provides strong robustness in large-range operation. The compensation part is often designed based on disturbance observer (DO) idea, where the lumped unknown disturbances are estimated by a DO and counteracted online. The disturbances in helicopter dynamics satisfy the mismatched condition, which increases the difficulties in designing a robust controller. Recently, some literatures have applied the ADRC technique to deal with helicopters’ control problem. In [10], the composite backstepping controller combined with nonlinear DO is applied to ensure robust and highly trajectory tracking. [12] adopts extend DO to estimate and compensate for the unknown disturbances, as well as dynamic surface control to guarantee the nominal performance. Nonlinear MPC is combined with DO in [15] to realize highly tracking performance subjected to the perturbations.
To further improve tracking performance, our work aims to develop finite-time (FT) convergence property to helicopter control system. The FT system provides rapid convergent speed around the equilibrium point remarkable disturbance rejection performance, which is an attractive property of a controller design [19, 20]. There are two main theory frameworks to complete finite-time stability analysis, including homogenous method and Lyapunov-based method [20]. Our work adopts homogeneous domination framework to achieve FT convergence of tracking errors. The added power integrator method [21,22,23] is applied to design the nominal feedback control part, which ensures nominal control performance and possesses FT convergence property of the closed-loop system. Additionally, in the recursive design procedure, disturbances are estimated via high-order SM DO (HOSMDO) [24,25,26] and then feed-forwardly counteracted in virtual control law design of every step. HOSMDO has many excellent properties, such as insensitivity to disturbances and FT convergence. This novel ADRC design guarantees that the tracking error of the closed-loop system converges to zero in FT under disturbances.
The helicopter is a typical multi-input multi-output (MIMO) system, where strong dynamic couplings exist. By approximate feedback linearization, the helicopters’ input–output dynamics enable to be decoupled and simplified [27]. Due to the properties of helicopter model, there exist two subsystems to consist of the decoupled helicopter dynamics, including position system and yaw angle system. Then, the composite FT control strategy is applied to force helicopter’s trajectory to track reference trajectory under internal and external perturbations. The main contributions of our work are summarized as follows:
-
(a)
FT control strategy based on added power integrator method is applied to deal with trajectory tracking problem of small-scale unmanned helicopters subjected to unknown perturbations. Our proposed FT controller enjoys speed and improved robustness.
-
(b)
The composite FT control law based on HOSMDO and added power integrator method, which guarantees FT convergence under disturbances, is proposed. Our work develops FT output regulation technique on MIMO system by combining with the approximate input–output linearization technique.
-
(c)
FT convergence property of tracking errors in the closed-loop system is proven through Lyapunov theory. Comparison simulation results show that the proposed controller features superior performance in trajectory tracking and disturbance rejection.
The configuration of this paper is arranged as follows. Section 2 presents the dynamics of a small-scale helicopter and its linearized model that is obtained by approximated feedback linearization. Section 3 proposes the composite control method, provides the FT stability analysis, and produces practical helicopter control signals. Section 4 discusses the simulations conducted in this work. Section 5 draws the conclusions.
2 Small-scale helicopter model
2.1 Small-scale helicopter dynamics
The helicopter is considered a six-degree-of-freedom rigid body model with simplified force and moment generation process. Firstly, two reference frames are defined: the earth reference frame (ERF) \(\mathbb {I}=\left\{ {Oxyz} \right\} \), which is fixed to the earth, and the body reference frame (BRF) \(\mathbb {B}=\left\{ {O_b x_b y_b z_b } \right\} \) whose origin is located at the helicopter’s center of gravity (c.g.) [3, 4]. Figure 1 shows the definition of the two reference frames.
The dynamics of small-scale unmanned helicopter can be described as follows [3, 4]:
where \(P=\left[ {{\begin{array}{ccc} x&{} y&{} z \\ \end{array} }} \right] ^{T}\) and \(V=\left[ {{\begin{array}{ccc} u&{} v&{} w \\ \end{array} }} \right] ^{T}\) refer to helicopter’s position and velocity vector in the ERF, respectively; m is helicopter’s mass, and g is the gravitational acceleration; \(e_3 =\left[ {{\begin{array}{ccc} 0&{} 0&{} 1 \\ \end{array} }} \right] ^{T}\); \(S\left( \cdot \right) \) is a skew-symmetric matrix that corresponds to the vector \(\left( \cdot \right) \) [8, 9]; and J represents the approximate inertia matrix given as follows:
The rotation matrix from BRF to ERF is
where \(S_{\left( \cdot \right) }\) and \(C_{\left( \cdot \right) }\) denote \(\sin \left( \cdot \right) \) and \(\cos \left( \cdot \right) \), respectively. \(\Theta =\left[ {{\begin{array}{ccc} \phi &{} \theta &{} \psi \\ \end{array} }} \right] ^{T}\) are the Euler angles, which include roll, pitch, and yaw angles. \(\omega =\left[ {{\begin{array}{ccc} p&{} q&{} r \\ \end{array} }} \right] ^{T}\) denote the angular rates in the BRF. Attitude kinematics are expressed as follows:
In Eqs. (2)–(4), F and M denote the external forces and torque exerted on helicopter’s fuselage in BRF, respectively.
where \({u_c} = {\left[ {\begin{array}{cccc} {{\delta _\mathrm{col}}}&{{\delta _\mathrm{lon}}}&{{\delta _\mathrm{lat}}}&\delta _\mathrm{ped} \end{array}} \right] ^\mathrm{T}}\) is helicopter’s control input vector, whose elements denote the main rotor’s collective, longitudinal cyclic, lateral cyclic, and the tail rotor’s collective pitch, respectively. \(F_\Delta \) and \(M_\Delta \) represent lumped force and torque disturbance in BRF, respectively, that involve external perturbations, parameter variations, and model uncertainties. Constant matrices A and B are expressed as follows [10]:
where the coefficients \(L_b\), \(L_a \), \(M_b \), \(M_a \), \(L_\mathrm{lon}\), \(L_\mathrm{lat} \), \(M_\mathrm{lon}\), \(M_\mathrm{lat} \), \(N_\mathrm{col} \), \(N_r \), \(N_\mathrm{ped}\), \(Z_w \), and \(Z_\mathrm{col}\) depend on the helicopter structure, which can be obtained via system identification technique. Along (8) to (9), helicopter dynamics (2) and (4) can be reexpressed as follows:
where \(\Delta F=\frac{1}{m}R\left( \Theta \right) F_\Delta \), and \(\Delta M=J^{-1}M_{\Delta }\).
Given the desired smooth trajectory \(P_d \mathop {=}\limits ^{\Delta } \left[ \begin{array}{ccc} {x_d }&{} {y_d }&{} {z_d } \\ \end{array} \right] ^{T}\) and yaw angle \(\psi _d \), this work aims to develop control signals \(\left[ \begin{array}{cccc}{\delta _\mathrm{col} }&{\delta _\mathrm{lon} }&{\delta _\mathrm{lat}}&{\delta _\mathrm{ped} } \end{array} \right] ^{T}\) for a helicopter model with uncertainties and external disturbances, such that its practical trajectory P and yaw angle \(\psi \) converge to \(P_d\) and \(\psi _d\).
2.2 Approximate feedback linearization
To facilitate controller design and performance analysis, feedback linearization is initially carried out. Traditional exact input–output linearization fails to feedback linearize the whole helicopter system and produces unstable zero dynamics [14, 27]. Thus, approximate feedback linearization is developed to simplify and decouple helicopters’ dynamics. This method requires the second-time derivative of the main rotor thrust \(\ddot{T}_{m}\) as the new input, where \(T_m =m\left( {g-Z_w w-Z_\mathrm{col} \delta _\mathrm{col} } \right) \). The approximated input–output feedback linearization procedure is performed as follows:
First, \(e_{P1} =P-P_d\) is obtained. The derivative of \(e_{p1}\) from (1) is given as follows:
Next, let \(e_{P2} =V-\dot{P}_{d}\). Along (10), its derivative is expressed as follows
Selecting \(e_{P3} =ge_3 +\frac{1}{m}R\left( \Theta \right) T_m -\ddot{P}_{d}\), the derivative of \(e_{P3}\) is derived from (3) as
Define the transition control variables \(\left[ {{\begin{array}{ccc} {M_\phi }&{} {M_\theta }&{} {M_\psi } \\ \end{array} }} \right] ^{T}=-J^{-1}\left( {\omega \times J\omega } \right) +\left( {A\omega +Bu_c } \right) \). Let \(e_{P4} =-\frac{1}{m}R\left( \Theta \right) S\left( \upomega \right) T_m -\frac{1}{m}R\left( \Theta \right) \dot{T}_m-\dddot{P}_{d}\), along (11), its time derivative is obtained as
where
The position error subsystem is approximately feedback-linearized by applying \(\ddot{T}_{M}\) as input. The dynamics of yaw angle errors \(e_{\psi 1} =\psi -\psi _d\) is described in Eq. (7) as follows:
Selecting \(e_{\psi 2} =\frac{S_\phi }{C_\theta }q+\frac{C_\phi }{C_\theta }r-\dot{\psi }_{d}\), its derivative yielded along (11) is as follows:
where
Combining (12)–(17), the complete input–output feedback linearization of helicopter dynamics is given as follows:
where \(u_P\) and \(u_\psi \) are regarded as new inputs. The input–output dynamics of helicopters have been decoupled via approximate feedback linearization. Our objective is changed to design the input \(\left[ {{\begin{array}{cc} {u_P^\mathrm{T} }&{} {u_\psi } \\ \end{array} }} \right] ^{T}\) to ensure that tracking errors of the position and yaw angle will converge to zeros.
In addition, the following assumptions are considered to implement the robust controller for helicopter.
Assumption 1
Disturbances \(\Delta F\), \(\Delta M_p \), and \(\Delta M_\psi \) in (18) satisfy the following condition
where \(\Lambda _F \), \(\Lambda _{M_p } \), and \(\Lambda _{M_\psi }\) are the known constant bound of the third-order time derivative of the disturbances.
Assumption 2
Attitude of the helicopter always lies inside region \(\left| \phi \right| <\frac{\pi }{2}\) and \(\left| {\theta \left( t \right) } \right| <\frac{\pi }{2}\).
Remark 1
In (18), \(\Delta F\), \(\Delta M_p \), and \(\Delta M_\psi \) are lumped disturbances that act on the helicopter model. \(\Delta M_p\) and \(\Delta M_\psi \) are matched disturbances, whereas \(\Delta F\) is an unmatched disturbance. The unmatched disturbance \(\Delta F\) significantly affects tracking precision. Given the existence of unmatched disturbances, various techniques, such as the classic SMC and adaptive control, are restricted.
Remark 2
Assumption 1 ensures the attitude kinematic matrix \(\Psi \left( \varTheta \right) \) in (7) is not singular. This assumption is valid in that the helicopter is considered to operate in hovering or low-velocity flight condition.
2.3 Preliminaries
Preliminary lemmas, which will be used to obtain a FT composite controller later, are illustrated as follows.
Lemma 1
[21]. Let m be a ratio of positive odd integers. If \(0<m\le 1\), the following inequalities hold
\(\square \)
Lemma 2
[21]. Let \(c_1 \), \(c_2\) be positive real numbers, and \(\gamma \left( {x,y} \right) >0\) be a real-valued function. Then,
\(\square \)
Lemma 3
[22]. For \(x_i \in R\), \(i=1,\ldots ,n\), the inequality \(\left( {\left| {x_1 } \right| +\cdots +\left| {x_n } \right| } \right) ^{c_p }\le \left| {x_1 } \right| ^{c_p }+\cdots +\left| {x_n } \right| ^{c_p }\) holds where \(c_p\) is a real number that satisfies \(0<c_p \le 1\). \(\square \)
Theorem 1
[20]. Considering \(\dot{x}=f(x)\), \(x\in {\mathcal {N}}\). Suppose a continuous function \(V\left( x \right) \) exists such that the following conditions hold:
-
(a)
\(V\left( x \right) \) is positive definite.
-
(b)
Real number \(c_v >0\) and \(\alpha \in \left( {0,\,1} \right) \) exist such that
$$\begin{aligned} V\left( x \right) +c_v \left( {V\left( x \right) } \right) ^{\alpha }<0,\,\,x\in {\mathcal {N}}\backslash \left\{ 0 \right\} . \end{aligned}$$Then, the origin is a FT stable equilibrium. \(\square \)
3 Helicopter controller design
This section expresses the design of the proposed helicopter’s FT control. First, HOSMDO is applied to estimate lumped force and moment disturbances. Second, composite control strategy based on DO and FT control is proposed. At the same time, the FT stability analysis is provided in detail. Finally, the practical control signals for helicopter are produced directly. Figure 2 depicts the control system structure.
3.1 HOSMDO
Considering the dynamic system
where \(x_j \in \mathbb {R}^{n}\) denotes the system state; \(f_j \left( t \right) \) is the known nonlinear smooth function; \(d_j \left( t \right) \in \mathbb {R}^{n}\) are unknown bounded perturbation terms due to model uncertainty and external disturbances. Assume that the disturbance \(d_j \left( t \right) \) owns the bounded rth-order time derivative, i.e., \(\left\| d_j^{\left( r \right) } \left( t \right) \right\| <L_j \). To obtain the estimation of disturbance and its high-order derivatives, a HOSMDO of \(d_j \left( t \right) \) is designed as follows [24].
where \(\lambda _0 ,\,\lambda _1 ,\ldots ,\lambda _{r-1} ,\lambda _r\) are the observer parameters. \(z_{0,j} ,z_{1,j} ,\ldots ,z_{r-1,j} ,z_{r,j} \), \(j=1,\,2,\,3\), are the estimates of \(x_j ,d_j ,\ldots ,\,d_j^{\left( {r-2} \right) } ,d_j^{\left( {r-1} \right) } \).
Considering that the estimated variables are vector, the multivariable calculation form is adopted, such as \(\hbox {sign}\left( {\varvec{X}} \right) =\left[ {\frac{x_1 }{\left| {x_1 } \right| },\,\,\ldots ,\,\frac{x_n }{\left| {x_n } \right| }} \right] \), where \(X=\left[ {x_1 ,\,\ldots ,x_n } \right] \), and \(\left| X \right| ^{l}=\left[ {\left| {x_1 } \right| ^{l},\ldots ,\left| {x_n } \right| ^{l}} \right] \). Due to no existence of coupling in (19), the system’s properties and analysis process is the same as the scalar system. Followed from (19)–(20), the observer error dynamics are then governed by:
where the observer errors are denoted as \(\sigma _{0,j} =z_{0,j} -x_j\), \(\sigma _{i,j} =z_{i,j} -d_j^{\left( {i-1} \right) } \), and \(\sigma _{r,j} =z_{r,j} -d_j^{\left( {r-1} \right) } \). The FT convergence of estimation error is given by the following theory.
Theorem 2
[24]. The parameters in (20) are properly selected, and the following equalities are true after a FT transient process
i.e.,
\(\square \)
Remark 3
The selection of \(L_j\) is a trade-off process. Large parameters \(L_j\) mean fast convergence rate of HOSMDO. However, the parameters \(L_j\) with large values cannot be selected to avoid excessive transient peaking in system responses.
Given \(\Delta F\) in Eq. (18), applying HOSMDO its value and high derivatives can be estimated by explicitly defining \(x_1 =e_{P2} \), \(f_1 \left( t \right) =e_{P3} \), and \(d_1 \left( t \right) =\Delta F\). After FT \(t_1 \), we have \(z_{1,\,1} =\Delta F,z_{2,1}=\Delta \dot{F},z_{3,1} =\Delta \ddot{F}\). Similarly, the disturbances \(\Delta M_p \quad \Delta M_\psi \) can be observed by selecting \(x_2 =e_{P4} ,f_2 \left( t \right) =f_{Pe} \left( t \right) ,\)\(d_2 \left( t \right) =\Delta M_p \), and \(x_3 =e_{\psi 2} ,\,f_3 \left( t \right) =f_{\psi e} \left( t \right) ,),\)\(d_3 \left( t \right) =\Delta M_\psi \). After time \(\hbox {max}\left\{ {t_2 ,\,t_3 } \right\} \), \(z_{1,2} =\Delta M_p ,z_{2,2} =\Delta \dot{M}_p ,z_{3,2} =\Delta \ddot{M}_{p}\), and \(z_{1,3} =\Delta M_{\psi } ,z_{2,3} =\Delta \dot{M}_{\psi } ,z_{3,3} =\Delta \ddot{M}_{\psi }\).
3.2 FT controller design
Consider the properties of FT convergence of HOSMDO. After time \(t_{\max } =\max \left\{ {t_1 ,\,t_2 ,t_3 } \right\} \), the dynamics in (18) can be rewritten as
In this subsection, the compound control strategy is proposed based on (23) to simplify the control design. The position error loop in (23) is the vector form with three components, namely, \(e_{Pi} =\left[ {{\begin{array}{ccc} {e_{Pi,1} }&{} {e_{Pi,2} }&{} {e_{Pi,3} } \\ \end{array} }} \right] ^{T},\,z_{1,\,j} =\left[ {{\begin{array}{ccc} {z_{1,\,j,1} }&{} {z_{1,\,j,2} }&{} {z_{1,\,j,3} } \\ \end{array} }} \right] ^{T},\)\(u_P =\left[ {{\begin{array}{ccc} {u_{P,1} }&{} {u_{P,2} }&{} {u_{P,3} } \\ \end{array} }} \right] ^{T},\hbox {and}\,i=1,\ldots ,4,\,\,j=1,2,3\). At the same time, mismatched disturbance exists in the position loop.
Position loop controller design
Step 1 Considering dynamics (23), let a Lyapunov function be
where \(r_1 =1\), \(r_i =r_{i-1} +\tau \), \(-1/5<\tau <0\). \(V_1\) is positive by selecting the parameter \(\tau \) as a ratio of even and odd integers.
The derivative of (24) along (23) is given as
Applying the concept of backstepping, the virtual control law is arranged as
where \(\beta _1>3c+\tilde{\beta }_1 >0\), \(\tilde{\beta }_1 >0\) are the designed controller constant. Introducing (26) into (25)
Step 2 In this step, the Lyapunov function is selected as
Computing its time derivative along (23), (27), and (28) yields
where \(\xi _{2,i} =(e_{P2,i} )^{\frac{1}{r_2 }}-(e_{P2,i}^*)^{\frac{1}{r_2 }}\), \(i=1,2,3\). The following relationships are established by applying Lemmas 1–2 directly.
where the constants \(C_{11} >0\) and \(C_{12} >0\). Substituting the following results into (29), we arrive at
The virtual controller is designed as
where \(\beta _2 >C_{11} +C_{12} +\tilde{\beta }_2 +2c\), \(\tilde{\beta }_2 >0\) are selected. Combining (30) and (31) renders
Step 3 Lyapunov function is defined as
where \(\bar{e}_{P3,i}^*=e_{P3,i}^*+z_{1,\,1,i} =-\beta _2 \left( {\xi _{2,i} } \right) ^{r_3 }\), \(\bar{e}_{P3,i} =e_{P3,i} +z_{1,\,1,i} \), and \(i=1,2,3\). The derivative is obtained along (23) and (32)
where \(\xi _{3,i} =\left( {\bar{e}_{P3,i} } \right) ^{\frac{1}{r_3 }}-(\bar{e}_{P3,i}^*)^{\frac{1}{r_3 }}\). To construct a FT stabilizer, the inequalities are introduced as follows
where
Combining the aforementioned analysis by applying Lemma 2 yields
Then, substituting the aforementioned results into (34) renders
The virtual control is given as
where \(\beta _3 >C_{21} +C_{22} +\tilde{\beta }_3 +c\), \(\tilde{\beta }_3 >0\). Thus, the corresponding Lyapunov function satisfies
Step 4 Lyapunov function is selected as
where \(\bar{e}_{P4,i}^*=e_{P4,i}^*+z_{2,1,i} =-\beta _3 \left( {\xi _{3,i} } \right) ^{r_4 }\), and \(\bar{e}_{P4,i} =e_{P4,i} +z_{2,1,i} \). Similarly, computing the time derivative of (38) yields
where \(\zeta _4 =\frac{\partial (\bar{e}_{P4,i}^*)^{\frac{1}{r_4 }}}{\partial e_{P1,i} }\dot{e}_{P1,i}+\frac{\partial (\bar{e}_{P4,i}^*)^{\frac{1}{r_4 }}}{\partial e_{P2,i} }\dot{e}_{P2,i}+\frac{\partial (\bar{e}_{P4,i}^*)^{\frac{1}{r_4 }}}{\partial e_{P3,i} }\dot{e}_{P3,i}\), \(\xi _{4,i} =\left( {\bar{e}_{P4,i} } \right) ^{\frac{1}{r_4 }}-(\bar{e}_{P4,i}^*)^{\frac{1}{r_4 }}\).
The position controller is designed as
where \(\beta _4>C_{31} +C_{32} +\tilde{\beta }_4 >0\). Substituting (40) into (39) introduces
Yaw angle loop controller design
Step 1 Define a Lyapunov function
Considering (23), the first time derivative is given as
Design the virtual control as
thus
where the constant \(\beta _{1\psi }>c_\psi +\tilde{\beta }_{1\psi } >0\), \(\tilde{\beta }_{1\psi } >0\).
Step 2 The Lyapunov function is selected as
Calculating its derivative yields
where \(\xi _{2\psi } =\left( {e_{\psi 2} } \right) ^{\frac{1}{r_2 }}-(e_{\psi 2}^*)^{\frac{1}{r_2 }}\). Selecting
where the control constant \(\beta _{2\psi }>C_{1\psi } +C_{2\psi } +\tilde{\beta }_{2\psi } >0\), \(\tilde{\beta }_{2\psi } >0\) yields
3.3 Proof of FT stability
Based on the FT Lyapunov theory, FT stability of the whole system is proven. The detailed proof is given in appendix.
Theorem 3
Consider that the simplified helicopter dynamic system satisfies Assumptions 1 and 2. Proposed controller (40) and (48) can guarantee that the closed-loop system is FT stable. \(\square \)
Remark 4
In the position controller \(u_P\) and yaw angle controller \(u_\psi \), the control design parameters include \(\tau \), \(\beta _1 \), \(\beta _2\), \(\beta _3 \), \(\beta _4 \), \(\beta _{1\psi } \), and \(\beta _{2\psi } \). Deciding the value of these parameter is a trade-off process. Larger values mean faster closed-loop system state convergence. However, large values cause excessive inputs and overshoot. For our problem, the principle for selecting parameters depends on the dynamic characteristic of small-scale helicopters.
3.4 Practical helicopter control signal
The practical control signals for helicopter can be calculated from \(u_P\) in (40) and \(u_\psi \) in (48). According to their definitions, one has
Following that, the control commands \(\left[ \begin{array}{cccc} {\delta _\mathrm{col} }&{\delta _\mathrm{lon} }&{\delta _\mathrm{lat} }&{\delta _\mathrm{ped} }\end{array} \right] ^{T}\) can be obtained according to the definition of \(\left[ {{\begin{array}{ccc} {M_\phi }&{} {M_\theta }&{} {M_\psi } \\ \end{array} }} \right] ^{T}\) and \(T_M =\int \int _0^t \ddot{T}_m \hbox {d}t\).
where \(B\left( 1 \right) \) is the first column of matrix B.
The following result is given directly by applying Theorem 3.
Theorem 4
Consider helicopter dynamic models (1)–(4) under Assumptions 1 and 2. If the controller is designed as (52)–(53), then tracking errors of the position and yaw angle FT converge to zero with disturbances. \(\square \)
4 Simulation analysis
Numerical simulations are shown to demonstrate the effectiveness of our proposed FT controller. Table 1 summarizes the corresponding helicopter model parameters [10, 28].
Following [10], the lumped disturbances in (10)–(11) are introduced in the simulation. These disturbances include model uncertainties and external disturbances.
where constant matrix \(\Delta \in R^{6\times 9}\) represents model uncertainty, and \(B_\mathrm{wind}\) denotes the transformation matrix from airspeed to force and moment. All elements of \(\Delta \) are pseudorandomly generated within the open interval \(\left( {-0.5\,0.5} \right) \). Matrices \(\Delta \) and \(B_\mathrm{wind}\) are given as follows:
Wind disturbance \(d_w\) is assumed to possess wind components along \(\left[ {{\begin{array}{cc} {x_b }&{} {y_b } \\ \end{array} }} \right] \) in BRF. This variable is composed of constant and random components, i.e., \(d_w =d_c +d_r \). The constant component is set as \(\left[ {{\begin{array}{cc} 5&{} 5 \\ \end{array} }} \right] ^{T}\) (m/s). Stochastic wind disturbance is modeled as follows [6]:
where \(\tau _c =3.2\,\hbox {s}\) is the time constant; \(q_u\) and \(q_v\)\((\sigma _{q_u } =\sigma _{q_v } =3.6576\,\hbox {m}/\hbox {s})\) are independent with zero mean; \(\rho =1/2\). Figure 3 shows the wind disturbance \(d_w\) used in the helicopter’ simulation.
Additionally, the flapping dynamics model is considered to provide sufficient fidelity for the simulation process. Flapping dynamics are equivalent to the additional dynamics in the servo loop [28]:
where \(\bar{\delta }_\mathrm{lon}\) and \(\bar{\delta }_\mathrm{lat}\) are longitudinal and lateral applied control signals, respectively, and \(\tau _f =0.1\) is the main rotor’s dynamics time constant.
According to the flight characteristic of small-scale helicopters, the parameters of FT controller combined with DO (FT+DO) are selected properly, where \(\tau = -2/31\), \(\beta _1 =2\), \(\beta _2 =5\), \(\beta _3 =20\), \(\beta _4 =50\), \(\beta _{1\psi } =20\), and \(\beta _{2\psi } =50\). The fourth-order SM DO is adopted, and the corresponding parameters are given as \(L_1 =L_2 =10\) and \(L_3 =20\).
To verify our controller’s superiority, the proposed controller is compared with BS and FT controller without DO. All the parameters of the FT controller are the same as that of FT+DO. BS controller has the following form
where \(k_{1,bs} =2\), \(k_{2,bs} =5\), \(k_{3,bs} =k_{1\psi ,bs} =20\), and \(k_{4,bs} =k_{2\psi ,bs} =50\). The comparison of BS controller highlights the benefits of FT method, which provides rapid convergent speed and improved disturbance rejection performance.
The desired “8-shape” reference trajectory is described as:
Firstly, the helicopter vertically climbs for 7s to simulate the takeoff stage. Then, it follows an “8-shaped” path while continuing to lift. Helicopter’s lift, sideslip, and forward performances are evaluated comprehensively through the moderately aggressive maneuver.
The simulation results are illustrated in Figs. 4, 5, 6, 7, and 8. Figure 4 gives the position response curves of helicopter’s closed-loop system based on the three methods. To quantitatively analyze the tracking performance, the integrated time absolute error (ITAE defined as \(\int _0^t t\Vert e\Vert \hbox {d}t\)) of three methods is listed in Table 2. Our proposed FT+DO controller tracks the reference trajectory more accurately under model uncertainties and external disturbances than other controllers. Moreover, the comparison of BS and FT control shows that FT stability property not only enjoys convergence speed but also improves robustness of the closed-loop system. Figure 4 also gives the 3D position trajectory intuitively, and the results agree with this analysis. DO plays a significantly important role in the tracking accuracy of the closed-loop system. It attenuates the effect of perturbations and recurve nominal performance of the control system.
The velocity, angle, and angular rate responses are shown in Figs. 5, 6, and 7. The state responses are a little chattering due to the existence of perturbations and fast tracking the maneuver trajectory. The responses of FT+DO fluctuate heavily to eliminate disturbances rapidly. Violent chattering exists at \(t=7\,\hbox {s}\) due to the switching of reference trajectory. Additionally, Fig. 8 displays the curves of controller commands. One can find that the control signals of FT+DO method have smaller vibration than the other at the time of switching of the desired trajectory.
5 Conclusion
We design a composite FT control law for helicopter. The helicopter dynamics are simplified and decoupled by approximate feedback linearization. ADRC technique is utilized to realize the accurate trajectory tracking under matched and mismatched disturbances. The disturbances are estimated by HOSMDO and then feed-forwardly compensated for. The FT feedback part is designed via added power integrator method. The compound control law guarantees FT convergence of the tracking errors. Numerical simulation demonstrates that with this obtained FT controller in our work, a small-scale unmanned helicopter exhibits excellent tracking performance with disturbances.
References
Mettler, B.: Identification Modeling and Characteristics of Miniature Rotorcraft. Kluwer Academic Publishers, Boston (2003)
Kendoul, F.: Survey of advances in guidance, navigation, and control of unmanned rotorcraft systems. J. Field Robot. 29(2), 315–378 (2012)
Alvarenga, J., Vitzilaios, N.I., Valavanis, K.P., Rutherford, M.J.: Survey of unmanned helicopter model-based navigation and control techniques. J Intell. Robot. Syst. 80(1), 87–138 (2015)
Cai, G.W., Chen, B.M., Lee, T.H.: Unmanned Rotorcraft Systems. Springer, Heidelberg (2011)
Tanner, O.: Modeling, Identification, and Control of Autonomous Helicopters. Ph. D thesis, ETH (2003)
Gadewadikar, J., Chen, B.M., Subbarao, K.: Structured \({\rm H}_{\infty }\) command and control-loop design for unmanned helicopters. J. Guid. Control Dyn. 31(4), 1093–1102 (2008)
Civita, M.L., Papageorgiou, G., Messner, W.C., Kanade, T.: Design and flight testing of a gain-scheduled \({\rm H}_{\infty }\) loop shaping controller for wide-envelope flight of a robotic helicopter. In: Proceedings of American Control Conference, Denver, USA, pp. 4195–4200 (2003)
Raptis, I.A., Valavanis, K.P., Moreno, W.A.: A novel nonlinear backstepping controller design for helicopters using the rotation matrix. IEEE Trans. Control Syst. Technol. 19(2), 465–473 (2011)
Zhu, B., Huo, W.: Robust nonlinear control for a model-scaled helicopter with parameter uncertainties. Nonlinear Dyn. 73(1–2), 1139–1154 (2013)
He, Y.B., Pei, H.L., Sun, T.R.: Robust tracking control of helicopters using backstepping with disturbance observers. Asian J. Control 16(6), 1–16 (2014)
Aboudonia, A., El-Badawy, A., Rashad, R.: Active anti-disturbance control of a quadrotor unmanned aerial vehicle using the command-filtering backstepping approach. Nonlinear Dyn. 90(1), 581–597 (2017)
Shao, X.L., Liu, J., Cao, H.L., Shen, C., Wang, H.L.: Robust dynamic surface trajectory tracking control for a quadrotor UAV via extended state observer. Int. J. Robust Nonlinear Control 28(7), 2700–2719 (2018)
Simplicio, P., Pavel, M.D., Kampen, E.V., Chu, Q.P.: An acceleration measurements-based approach for helicopter nonlinear flight control using Incremental Nonlinear Dynamic Inversion. Control Eng. Pract. 21(9), 1065–1077 (2013)
Xing, F., Wu, A.G., Shang, Y.J., Dong, N.: A novel sliding mode controller for small-scale unmanned helicopters with mismatched disturbance. Nonlinear Dyn. 83(1–2), 1053–1068 (2016)
Liu, C.J., Chen, W.H., Andrews, H.: Tracking control of small-scale helicopters using explicit nonlinear MPC augmented with disturbance observers. Control Eng. Pract. 20(3), 258–268 (2012)
Isidori, A., Marconi, L., Serrani, A.: Robust nonlinear motion control of a helicopter. IEEE Trans. Autom. Control 48(3), 413–426 (2003)
Huang, Y., Xue, W.C.: Active disturbance rejection control: methodology and theoretical analysis. ISA Trans. 53, 963–976 (2014)
Chen, W.H., Yang, J., Guo, L., Li, S.H.: Disturbance-observer-based control and related methods—an overview. IEEE Trans. Ind. Electron. 63(2), 1083–1095 (2016)
Bhat, S.P., Bernstein, D.S.: Continuous finite-time stabilization of the translational and rotational double integrators. IEEE Trans. Autom. Control 43(5), 678–682 (1998)
Bhat, S.P., Bernstein, D.S.: Finite-time stability of continuous autonomous systems. SIAM J. Control Optim. 38(3), 751–766 (2000)
Qian, C.J., Wei, L.: A continuous feedback approach to global strong stabilization of nonlinear systems. IEEE Trans. Autom. Control 46(7), 1061–1079 (2001)
Huang, X.Q., Wei, L., Yang, B.: Global finite-time stabilization of a class of uncertain nonlinear systems. Automatica 41, 881–888 (2005)
Polendo, J., Qian, C.J.: An expanded method to robustly stabilize uncertain nonlinear systems. Commun. Inf. Syst. 6(1), 55–70 (2008)
Levant, A.: Higher-order sliding modes, differentiation and output-feedback control. Int. J. Control 76(9), 924–941 (2003)
Li, S.H., Sun, H.B., Yang, J., Yu, X.H.: Continuous finite-time output regulation for disturbed systems under mismatching condition. IEEE Trans. Autom. Control 1(60), 277–282 (2015)
Sun, H.B., Hou, L.L., Zong, G.D.: Continuous finite time control for static var compensator with mismatched disturbances. Nonlinear Dyn. 85, 2159–2169 (2016)
Koo, T.J., Sastry, S.: Output tracking control design of a helicopter model based on approximate linearization. In: Proceedings of 37th IEEE Decision and Control, Tampa, USA, pp. 3635–3640 (1998)
Gavrilets, V.: Autonomous Aerobatic Maneuvering of Miniature Helicopters. Ph. D thesis, MIT (2003)
Khalil, H.K.: Nonlinear Systems, 3rd edn. Prentice Hall, Upper Saddle River, NJ (2002)
Acknowledgements
Funding was provided by National Natural Science Foundation of China (Grant No. U1613225)
Author information
Authors and Affiliations
Corresponding author
Ethics declarations
Conflict of interest
None.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Appendix
Appendix
1.1 Proof of Theorem 3
The proving course of finite-time (FT) stability is divided into two stages. First, FT stability is established when \(t>t_{\max }\). Second, the states of the whole system are proven to not escape in any FT interval.
a) According to (41) and (49), \({{\dot{V}}_4} + {\dot{V}_{2\psi }} \le \)\( - {\beta _{\max }}\bigg [ \mathop {\sum }\limits _{i = 1}^3 \left( {e_{P1,i}^2 + {{\left( {{\xi _{2,i}}} \right) }^2} + {{\left( {{\xi _{3,i}}} \right) }^2} + {{\left( {{\xi _{4,i}}} \right) }^2}} \right) +{e_{\psi 1}^2} + {{\left( {{\xi _{2\psi }}} \right) }^2} \bigg ] \le 0\)
where \(\beta _{\max } =\hbox {max}\left\{ {{\begin{array}{cccccc} {\tilde{\beta }_1 }&{\tilde{\beta }_2 }&{\tilde{\beta }_3 }&{\tilde{\beta }_4 }&{\tilde{\beta }_{1\psi } }&{\tilde{\beta }_{2\psi } } \end{array} }} \right\} \). In addition, considering the definition of the Lyapunov function, constant \(L>0\) exists such that
Select \(\lambda =\beta _{\max } /2L^{\frac{2}{2-\tau }}\). The use of Lemma 3 produces
By applying Theorem 1, we conclude that the state vector will converge on zero in FT.
b) In this step, proof that the helicopter’s state does not escape to infinite in any FT interval is provided. Combining simplified helicopter dynamic system (18), DO (20), and controllers (40) and (48), the following closed-loop dynamics are introduced
A Lyapunov function is selected as follows:
Its derivative is expressed as follows:
To simplify the analysis, the following inequalities are obtained using Lemmas 1–2.
Similarly,
where \(l_{i,\,j} >0\) is the bounded constant.
The control loop has no effects on the DO loop. When \(t>t_{\max } \), the estimation errors of disturbances converge to zero. Therefore, the errors \(\sigma _{i,\,j}\) are bounded. If \(\max \left\{ \left| {e_{P1,i} } \right| ,\,\left| {\xi _{2,i} } \right| ,\left| {\xi _{3,i} } \right| ,\left| {\xi _{4,i} } \right| ,\left| {e_{\psi 2} } \right| ,\left| {\xi _{2\psi } } \right| \right\} \le 1\), then \(\dot{L}\le B\), where B is a bounded constant. If \(\max \left\{ \left| {e_{P1,i} } \right| ,\left| {\xi _{2,i} } \right| ,\left| {\xi _{3,i} } \right| ,\left| {\xi _{4,i} } \right| ,\left| {e_{\psi 2} } \right| ,\left| {\xi _{2\psi } } \right| \right\} >1\) because \(2+\tau <2\) and \(2-r_2 <2\), then \(\dot{L}\le KL+B\), where K is a bounded constant. Thus,
Reference [29] proves that the system state in (a2) will not escape to infinite in any FT.
According to the two stages of analysis, the proof of the FT stability is completed. \(\square \)
Rights and permissions
About this article
Cite this article
Jiang, T., Lin, D. & Song, T. Finite-time control for small-scale unmanned helicopter with disturbances. Nonlinear Dyn 96, 1747–1763 (2019). https://doi.org/10.1007/s11071-019-04882-1
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11071-019-04882-1