# Robust Trajectory-Tracking Control of a Rotorcraft Using Immersion-and-Invariance-Based Adaptive Backstepping Control

Authors: Yoo-Seung Choi; Il-Ryeong Lee; Jun-Young An; Moon-Gyeang Cho; Chang-Joo Kim
Journal: International Journal of Aerospace Engineering
 (2022)

---

## Abstract

This paper investigates an adaptive backstepping control based on the immersion-and-invariance (I&I) method for a rotorcraft’s trajectory-tracking control problem. To effectively cope with both parametric uncertainties and external disturbances affecting all forces and moments of a rotorcraft, the I&I-based disturbance observer is designed and combined with an adaptive backstepping controller. During the design process, a simple form of the observer structure is suggested, and the performance of the observer is analyzed using a candidate Lyapunov function. Then, the closed-loop stability of the adaptive controller is analyzed for both time-invariant and time-varying disturbances. Additionally, the tuning function-based adaptive backstepping controller is designed and used to investigate the outperformance achievable with the proposed method. Finally, comparative simulation results using a high-fidelity rotorcraft math model is provided to show the effectiveness of the proposed strategy.


---

## Body

## 1. Introduction

Due to unique operational capabilities like hovering, vertical take-off, and landing, a rotorcraft plays a crucial role in both military and civilian missions such as terrain survey and surveillance. In the last two decades, many studies have been conducted to use the rotorcraft configuration for the future unmanned aerial vehicle (UAV). In this regard, mission autonomy becomes one of the main topics to provide operational safety and reliability for missions under uncertain and highly complex operational environments. From the flight-control point of view, there exists much effort to adopt the advanced methods rather than the conventional linear feedback-control design. It is well known that the linear feedback control can still provide an excellent control solution and effectively expand its applicable operational flight envelope (OFE) using the gain-scheduling strategy. However, it may fail to obtain strong robustness to model uncertainties and unknown external disturbances, which will be highly demanded in future missions. Furthermore, the gain-scheduling strategy typically requires exhaustive design workloads to extend its applicable area up to OFE [1].As an alternative, various kinds of model-based nonlinear control strategies such as nonlinear dynamic inversion (NDI), backstepping control (BSC), and sliding-mode control (SMC) have been developed and efficiently implemented in the rotorcraft’s configuration in the last few decades [2–5]. A common obstacle to the model-based control design approach is that the method relies on the accuracy of the model dynamics. Among the control strategies mentioned above, NDI is applicable only to the feedback linearizable systems [6]. However, to the authors’ best knowledge, NDI has never been applied directly to the high-fidelity rotorcraft model without resorting to model simplification [2]. On the other hand, BSC and SMC are more flexible than NDI in that their controls can be designed without resorting to full feedback linearization. However, BSC and SMC may still suffer from instability and performance degradation due to unmodeled dynamics and external disturbances.A good way for handling such a problem is to use various modular or integrated online adaptive schemes to estimate unknown parameters or external disturbances [7–12]. Among them, least-square (LS), tuning-function (TF), and immersion-and-invariance (I&I) methods are reported to be well suited to the BSC framework [7]. The LS-based control design is an indirect adaptive method that reduces trajectory-tracking errors by recursively estimating model parameters. It has several advantages related to the independent designs of the modular estimator. However, since LS adopts the certainty equivalence principle, it is difficult to prove the stability of the closed-loop system.On the other hand, the TF method is a direct adaptive scheme, in which the adaptive update laws are designed in an integrated manner [9, 13]. The main advantage of the TF method is that the adaptive laws are designed to guarantee the stability of the closed-loop system. However, in a case where relatively large gains are used to enhance the control robustness, undesirable behavior might occur in the trajectory-tracking solution [14].The I&I approach differs from the TF method in that it adopts an additional nonlinear function to assign stabilized estimation error dynamics [15]. Therefore, the I&I is capable of designing a modular estimator, and the associated controller can also be designed without resorting to the certainty equivalence principle [16]. The main advantage of the I&I method is that the designed I&I estimator guarantees asymptotic convergence of the estimation error. In addition, such a design process allows analyzing the stability of the closed-loop system.Given the dynamics of rotorcraft and its flight characteristics, it is very difficult to consider all unknown parameters in each element of the mathematical model. Also, adaptive estimators may show poor performance in the presence of combined multiple uncertainties. Therefore, it may not be efficient to estimate specific parameters using the adaptive approach mentioned above. In addition, the effects of external disturbances such as wind gusts and wind shears should be considered during autonomous flight. In general, reducing such undesirable effects is one of the most difficult tasks in rotorcrafts’ control problems. An efficient way to deal with both model uncertainties and external disturbances is to design a disturbance observer (DOB) that has been extensively studied and applied to UAVs [17–21]. In these cases, both model uncertainties and external disturbances are expressed in dynamics as a bounded lumped disturbance.Previous studies have been conducted to effectively cope with the rotorcraft’s underactuated system while extending controllers’ robustness against existing uncertainties [22, 23]. Both approaches are based on driving incremental dynamics out of the original dynamics, and the slack variable approach has been used to reduce design parameters and simplify the control structure. In Ref. [22], an adaptive incremental backstepping controller (AIBSC) is designed to estimate the uncertain control effectiveness matrix based on the LS method. While the simulation studies using the AIBSC have validated that the separately designed modular LS estimator can identify the unknown control effectiveness matrix, the main limitation of such an approach is that the stability of the closed-loop system can only be guaranteed under the certainty equivalence principle. In Ref. [23], an adaptive incremental backstepping sliding mode controller (AIBS-SMC) is designed to compensate for mismatched uncertainties in the control effectiveness matrix. In the research, the AIBS-SMC proved its excellent trajectory-tracking performance and the stability of the closed-loop system. However, the suggested adaptive component’s performance is limited by the overestimation problem due to the monotonically increasing switching control input. The suggested solution is to cease the calculation of the adaptive component when the certain limit is reached. However, such a method is limited in its performance since the method can cause the steady-state error. At last, previous studies have dealt only with constant uncertainties while, realistically, uncertainties are generally completely unknown and time-varying in nature.In this regard, this paper focuses on developing an easy-to-tune and effective method to compensate for completely unknown, time-varying disturbances while guaranteeing closed-loop stability. Based on the previous studies mentioned above, this paper adopts the I&I method to design a modular nonlinear DOB that deviates from the certainty equivalence principle. As in the conventional I&I method, the observer state is represented as the sum of a dynamic update law and a continuous nonlinear design function. Here, a very simple form of the design function is present to minimize the tuning parameters of the controller. Even so, the resulting disturbance estimation error dynamics can be stabilized while showing the straightforward relationship between the estimation errors and observer gains. The I&I-based DOB is then combined with an adaptive backstepping control (ABSC). To effectively reduce design parameters and simplify the design process, a slack-variable approach [22–25] is adopted to deal with the underactuated system rather than the traditional hierarchical approach [26] or block-BSC approach [27]. The combined ABSC structure with the I&I-based DOB can effectively decouple the adaptive components and the slack variable update laws. The stability of the composite controller is then proved by Lyapunov’s stability theorem under both time-invariant and time-varying disturbances. In this process, a relation between the control gains that guarantees the convergence of the proposed composite controller is revealed. The usefulness of the proposed controller is demonstrated through comparative simulations with the tuning function adaptive backstepping control (TF-ABSC) and the standard BSC. The simulations are conducted using the helicopter trim, linearization, and simulation (HETLAS) program, which has been developed for rotorcrafts’ fly-by-wire flight control systems [28, 29].This paper is structured as follows: the rotorcraft dynamics suitable for trajectory-tracking control are derived from Euler’s equation in Section2. The TF-ABSC and the I&I-ABSC designs and their stability analysis are addressed in Section 3. Section 4 presents a series of simulation results with discussions. Finally, conclusions are drawn in Section 5.


## 2. Rotorcraft Model Description

The rotorcraft dynamics can be expressed by the following compact form of the Euler equations and the kinematic relations.(1)v̇=fm−ω×v,ω̇=J−1m−ω×Jω,v=Cṙ,ω=Lϕ̇,(2)v=uvw,ω=pqr,r=xyz,ϕ=ϕθψ,where m, v, ω, J, f, m, r, and ϕ denote the mass, linear and angular velocities, moment of inertia matrix, external forces and moments, position, and Euler angles, respectively. The transformation matrices, C and L, are represented using the definition of the trigonometric functions like cα=cosα and sα=sinα for α=ϕ,θ,ψ as
(3)C=cθcψcθsψ−sθsϕsθcψ−cϕsψsϕsθsψ+cϕcψsϕcθcϕsθcψ+sϕsψcϕsθsψ−sϕcψcϕcθ,L=10−sθ0cϕcθsϕ0−sϕcθcϕ.The desired trajectories are typically prescribed by the position and heading angle of the aircraft. Therefore, the dynamics for these trajectory states are straightforwardly used in the control design. Using the kinematics in Equation (1), the second-order dynamics for (r,ϕ) are derived as
(4)r¨=C−1fm−Lϕ̇×Cṙ−Ċṙ,ϕ¨=L−1J−1m−Lϕ̇×JLϕ̇−L−1L̇ϕ̇.The flap and inflow dynamics of the main rotor are omitted in the motion equation since the rotor trim solutions are used considering the separated time scales between the rigid body and the rotor dynamics [30]. In the paper, the Bo-105 helicopter dynamics implemented in HETLAS are used for the control design and validation [31]. Considering the component-based modeling technique adopted in HETLAS, the external forces and moments can be represented by the sum of contributions made by the main rotor (mr), tail rotor (tr), fuselage (fus), stabilizer (stb), and gravity (grv) as shown in the following equations.
(5)f=fmr+ftr+ffus+fstb+fgrv,m=mmr+mtr+mfus+mstb+mgrv.The conventional helicopter typically uses four primary controlsup=δ0,δ1C,δ1S,δTRT consisting the main rotor collective (δ0), the lateral-cyclic (δ1C), the longitudinal-cyclic (δ1S), and the tail rotor collective (δTR) to generate the required control forces and moments, which are directly affected by the flap, lead-lag, and feathering motions of rotors. As in the typical high-fidelity rotorcraft model, HETLAS also applies the blade element method (BEM) to integrate nonlinear air loads over the blades. Therefore, up is implicitly included in the rotor dynamics fmr,ftr,mmr,andmtr rather than explicitly described in Equations (4) and (5). The detailed information of the rotor dynamics can be found in Ref. [30].As a result, the nominal rotorcraft dynamics in Equation (4) can be expressed by the following general form for x=x,y,z,ϕ,θ,ψT:
(6)x¨=r¨ϕ¨=fnx,ẋ,up.To additionally express the mismatching between the physical system and the nominal model, the lumped disturbance vectord is added to the dynamic model as follows.
(7)x¨=fn+∆fn+dexternal=fn+d,d=∆fn+dexternal=dfdm,where df and dm represent vectors composing linear and angular lumped disturbances acting on the aircraft, respectively; ∆fn represents unmodeled dynamics and parameter perturbation; and dexternal represents external disturbances. To be specific, the mismatch between the physical system and the nominal model in the force ∆f, moment ∆m, mass ∆m, moment of inertia matrix ∆J, etc. in Equations (4) and (5) can cause ∆fn. Also, wind gust typically causes the acceleration increment to the aircraft [32]. Thus, the lumped disturbance d can be expressed as the sum of ∆fn and dexternal [33].Nonlinear dynamics represented by Equation (7) generally yield difficulties in the control design process since the system is nonaffine in the control and underactuated. Various methods have been developed to derive the approximated control affine form required for the nonlinear control design [34–36]. In this paper, the state-dependent-coefficient (SDC) factorization method proposed by Yang et al. [36] for the state-dependent-Riccati-equation (SDRE) control design is adopted. The method approximates the control effective matrix by the control Jacobian computed with the temporal states. By applying this concept, Equation (7) can be simply transformed into the desired affine form as
(8)x¨=fax,ẋ,up+Gnx,ẋ,upup+d,where
(9)fa=fn−Gnup,Gn=∂fnx,ẋ,up∂up∈R6×4.Therefore, the system dynamics for the trajectory-tracking control can be rewritten as(10)x¨=fa+Gnup+d,y=x,y,z,ϕ,θ,ψT.The system dimension in Equation (10) is twelve, and there exist four unobservable internal dynamics for ϕ,θ,ϕ̇,θ̇ because the primary control up explicitly appeared from the second derivative of the system output with the relative degree ρr=8. It is well known that the internal attitude dynamics are generally unstable over the most rotorcraft OFE. As it was mentioned in Introduction, this paper adopts the slack-variable method to handle the nonsquare matrix Gn to preserve useful nonlinearities and to reduce the design parameters of the controller at the same time. Padhi et al. [25] introduced a slack variable vector and a slack variable matrix to make the control-effective matrix invertible. The proposed method has been successfully implemented in the SMC design for underactuated systems [24, 36, 37]. After applying the slack-variable approach, Equation (10) can be transformed into the following square dynamics.
(11)x¨=fa+Gu+ν+d,where
(12)G=GnGs,ν=−Gsus,u=upus,us=u5u6.Here,us∈R2 is the slack control, u is the augmented control, and the slack variable matrix Gs∈R6×2 is selected to make G∈R6×6 invertible. The matrix Gs is simply defined by Gs=02×3,I2×3,02×1T, and the following control derivative matrix G is always nonsingular when the rotorcraft has enough control margins for each primary control. Since the main objective of the control problem is to track the desired position and heading angle, the primary control up is assigned to the associated axis. Therefore, the slack control vector us does not affect the closed-loop system in this structure. Even so, ν will be designed using an adaptive update law as it was proposed by Kim et al. [24].By observation, one can notice that the nominal system in Equation (7) has remained throughout the transformation process from Equation (8) to Equation (11). In summary, the above process can be expressed for later use as
(13)x¨=fn+d=fa+Gu+ν+d.In order to deal with the underactuated system, the parameterν is added and subtracted from the dynamics as shown in Equation (11). As a result, the term itself has no effect on the nominal dynamics of the system, whereas the term d represents any deviation from the nominal model. This will be covered in depth in the control design sections.


## 3. Adaptive Backstepping Control Design

### 3.1. Tuning Function Approach

This subsection defines the ABSC structure, and the adaptive update law for the lumped disturbance is designed using the TF approach. The ABSC design starts by defining tracking errors with the continuously differentiable desired trajectoryxd and the virtual control α∈R6 as
(14)z1=x−xd,z2=ẋ−α.The TF method is used to estimate the unknown slack variables and disturbances. The associated estimation errors can be represented by(15)ν~=ν−ν^,d~=d−d^.Then, the following relations can be obtained.(16)ż1=ẋ−ẋd=z2+α−ẋd,ż2=x¨−α̇=fa+Gu+ν+d−α̇,ν~̇=ν̇−ν^̇,d~̇=ḋ−d^̇.Using the control Lyapunov function (CLF) defined with positive definite weight matricesQ,Γν,Γd>0 as shown in Equation (17), the ABSC structure and update laws for estimates ν^,d^ can be derived to meet the Lyapunov stability criteria of Equation (18).
(17)V=Vz1+Vz2+Vν+Vd=12z1TQ−1z1+12z2Tz2+12ν~TΓν−1ν~+12d~TΓd−1d~,(18)V̇=V̇z1+V̇z2+V̇ν+V̇d=z1TQ−1ż1+z2Tż2+ν~TΓν−1ν~̇+d~TΓd−1d~̇≤0.Substituting Equation (16) into Equation (18), Equation (19) is obtained.
(19)V̇=z1TQ−1α−ẋd+z2TQ−1z1+fa+Gu+ν^+d^−α̇+ν~Tz2+Γν−1ν~̇+d~Tz2+Γd−1d~̇.Therefore, the TF-ABSC can be derived as shown in Equation (20), where K1>0 and K2>0 are positive diagonal gain matrices.
(20)α=−QK1z1+ẋd,u=−G−1K2z2+Q−1z1+fa+ν^+d^−α̇.Regarding the adaptive update laws, the slack variable approach typically assumes slow variation ofν. Using this assumption (ν̇≈0), the derivations of the required adaptive laws and update dynamics can be finalized as the following equation:
(21)ν^̇=Γνz2,d^̇=Γdz2.By substituting Equations (20) and (21) to Equation (19), Equation (19) becomes
(22)V̇=−z1TK1z1−z2TK2z2+d~TΓd−1ḋ=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2+∑i=1i=6d~iḋiγi=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2−∑i=1i=612γid~i−ḋi2+∑i=1i=6d~i22γi+ḋi22γi≤−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2+∑i=1i=6d~i∞22γi+∑i=1i=6ḋi∞22γi.Equation (22) states that the TF-ABSC meets input-to-state stability (ISS) with respect to d~ and ḋ. Therefore, it is not only the system that converges to a bounded region, but also, the radius of convergence in the trajectory-tracking solution can arbitrarily be reduced by increasing γi. However, the boundedness of both ḋ and d~ must be guaranteed. If the lumped disturbance is time constant (ḋ=0), the global asymptotic convergence can be guaranteed by the TF approach.As shown in Equation (20), the feedback control is affected by the sum of the estimated slack variables and disturbances. Substituting Equation (21) to Equation (20) yields
(23)u=−G−1K2z2+Q−1z1+fa+Γν+Γd∫z2−α̇.Equation (23) shows that the TF method adopts integral feedback of the trajectory-tracking error z2. From Equation (23), one can observe that two adaptive update laws are excited by the same input z2. Therefore, the total uncertainty acting in each corresponding axis is compensated by the sum of two estimated values ν^+d^. As a result, estimation results for d^4 and d^5 may show poor accuracy, since slack variables are assigned to the roll and pitch axes in this controller. Even so, when the disturbed system is controllable, the performance and the stability for the TF-ABSC can be guaranteed due to the stability proof in Equation (22).The controller gain matrices used throughout the derivation are defined with positive diagonal matrices and can be represented by(24)Q=diagqii=1i=6,Γν=diagΛii=1i=6,K1=diagk1,ii=1i=6,Γd=diagγii=1i=6,K2=diagk2,ii=1i=6.


### 3.2. Immersion-and-Invariance Approach

Details on the I&I using the definition of the invariant manifold can be found in Ref. [15, 38]. Here, a nonlinear DOB based on the I&I method is proposed to estimate the disturbance d expressed in Equation (7). The design of the I&I-based DOB starts by representing the observer state d^ as the sum of the dynamic update law ξ and a continuous nonlinear shaping function β as
(25)d^=ξ+βx,ẋ,up.Then, the estimation error (off-the-manifold coordinate) is defined by(26)d~=d−ξ+βx,ẋ.The estimation error dynamics is derived by taking the time derivative of Equation (26) as
(27)d~̇=ḋ−ξ̇+∂β∂xẋ+∂β∂ẋx¨=ḋ−ξ̇+∂β∂xẋ+∂β∂ẋfnx,ẋ,up+d=ḋ−ξ̇+∂β∂xẋ+∂β∂ẋfnx,ẋ,up+d^+d~.In Equation (27), fnx,ẋ,up is the forces and moments calculated through the stabilized ABSC controller. Assuming that there exists a full-information control law up that satisfies the closed-loop stability, ξ̇ and β can be selected to render Equation (27) stable. This paper proposes the following I&I-based DOB structure:
(28)ξ̇=−∂β∂xẋ−∂β∂ẋfnx,ẋ,up+d^,β=Γdẋ,where Γd>0 is a positive diagonal matrix with observer gains. By substituting Equation (28) into Equation (27), the following estimation error dynamics can be obtained.
(29)d~̇=ḋ−Γdd~.To analyze the performance of the DOB in Equation (26), the following Lyapunov-like function and its time derivative is considered.
(30)W=12d~Td~,(31)Ẇ=d~Td~̇=d~Tḋ−d~TΓdd~≤d~ḋ∞−γmind~,where γmin is the minimum observer gain. Therefore, if ḋ∞ is finite, the estimation converges to a bounded region, and by increasing the observer gain, the estimation error decreases since the region of convergence is bounded by ḋ∞/γmin>d~. Also, when d is time invariant (ḋ=0), the estimation can converge to its real value with the convergence rate depending on the values of Γd.The shaping function proposed in Equation (28) does not use any other terms except for ẋ. Substituting the x-related term in the shaping function may increase the rate of convergence depending on the desired trajectory, but it may be difficult to choose appropriate observer gains, and the computational workload will be increased.Now, the I&I-ABSC can be designed using the defined modular I&I-based DOB. With reference to the CLF shown in Equation (17), W in Equation (30) is substituted to the CLF instead of Vd.
(32)V=Vz1+Vz2+Vν+W=12z1TQ−1z1+12z2Tz2+12ν~TΓν−1ν~+12d~Td~.Using Equations (19) and (31), the time derivative of Equation (32) becomes
(33)V̇=z1TQ−1α−ẋd+z2TQ−1z1+fa+Gu+ν^+d^−α̇+ν~Tz2+Γν−1ν~̇+d~Tz2+d~Td~̇−d~TΓdd~.The I&I-ABSC structure can be summarized as(34)α=−QK1z1+ẋd,u=−G−1K2z2+Q−1z1+fa+ν^+d^−α̇,ν^̇=Γνz2,d^=ξ+β.At this point, it is worth mentioning that the proposed I&I-ABSC differs from the TF-ABSC only in its use of I&I-based DOB for estimatingd^ instead of the TF update law. Thus, both methods are applicable for the same ABSC structure (or the same control gains) regardless of their different approach for handling the disturbances. Note that the same gain matrices in Equation (24) are adopted in the I&I-ABSC. For analyzing the stability of the I&I-ABSC, substituting Equations (34) into Equation (33) yields
(35)V̇=−z1TK1z1−z2TK2z2+d~Tz2+d~Tḋ−d~TΓdd~=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2+∑i=1i=6d~iz2,i+∑i=1i=6d~iḋi−∑i=1i=6γid~i2=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2−z2,i22γi−∑i=1i=6z2,i22γi−d~iz2,i+γid~i22−∑i=1i=6ḋi22γi−d~iḋi+γid~i22+∑i=1i=6ḋi22γi=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,i−12γiz2,i2−∑i=1i=612γiz2,i−γid~i2−∑i=1i=612γiḋi−γid~i2+∑i=1i=6ḋi22γi≤−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,i−12γiz2,i2+∑i=1i=6ḋi∞22γi.Equation (35) proves the ISS of the I&I-ABSC when γi>1/2k2,i. As a result, not only does the system converge to a bounded region, but the radius of convergence in the trajectory-tracking solution can be reduced arbitrarily by increasing γi. Unlike Equation (22), however, the ISS of the I&I-ABSC only requires boundedness of ḋ. When the uncertainties are time-invariant, Equation (35) becomes
(36)V̇=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i−d~i2k2,i2−∑i=1i=6γi−14k2,id~i2.Withγi≥1/4k2,i, the global stability can be guaranteed.The I&I-ABSC design ensures global asymptotic stability for time-invariant disturbances while also improving stability criteria by requiring less stringent conditions on the lumped disturbances when compared to the TF-ABSC.Moreover, unlike TF-ABSC, it is expected that the proposed I&I-ABSC can accurately estimated^ regardless of the estimated ν^ since d^ is calculated through available state values instead of z2. This is possible since the I&I-based DOB only estimates the deviation from the nominal model as in Equation (28) and the term ν^ does not affect the nominal model as demonstrated in Equation (13).The performance of the I&I-ABSC (34) will be compared to the TF-ABSC (20)–(21) and the standard BSC in the simulation section. In this paper, the BSC without the adaptation law for d^ is simply defined as the following equation.
(37)α=−QK1z1+ẋd,u=−G−1K2z2+Q−1z1+fa+ν^−α̇,ν^̇=Γνz2.


## 3.1. Tuning Function Approach

This subsection defines the ABSC structure, and the adaptive update law for the lumped disturbance is designed using the TF approach. The ABSC design starts by defining tracking errors with the continuously differentiable desired trajectoryxd and the virtual control α∈R6 as
(14)z1=x−xd,z2=ẋ−α.The TF method is used to estimate the unknown slack variables and disturbances. The associated estimation errors can be represented by(15)ν~=ν−ν^,d~=d−d^.Then, the following relations can be obtained.(16)ż1=ẋ−ẋd=z2+α−ẋd,ż2=x¨−α̇=fa+Gu+ν+d−α̇,ν~̇=ν̇−ν^̇,d~̇=ḋ−d^̇.Using the control Lyapunov function (CLF) defined with positive definite weight matricesQ,Γν,Γd>0 as shown in Equation (17), the ABSC structure and update laws for estimates ν^,d^ can be derived to meet the Lyapunov stability criteria of Equation (18).
(17)V=Vz1+Vz2+Vν+Vd=12z1TQ−1z1+12z2Tz2+12ν~TΓν−1ν~+12d~TΓd−1d~,(18)V̇=V̇z1+V̇z2+V̇ν+V̇d=z1TQ−1ż1+z2Tż2+ν~TΓν−1ν~̇+d~TΓd−1d~̇≤0.Substituting Equation (16) into Equation (18), Equation (19) is obtained.
(19)V̇=z1TQ−1α−ẋd+z2TQ−1z1+fa+Gu+ν^+d^−α̇+ν~Tz2+Γν−1ν~̇+d~Tz2+Γd−1d~̇.Therefore, the TF-ABSC can be derived as shown in Equation (20), where K1>0 and K2>0 are positive diagonal gain matrices.
(20)α=−QK1z1+ẋd,u=−G−1K2z2+Q−1z1+fa+ν^+d^−α̇.Regarding the adaptive update laws, the slack variable approach typically assumes slow variation ofν. Using this assumption (ν̇≈0), the derivations of the required adaptive laws and update dynamics can be finalized as the following equation:
(21)ν^̇=Γνz2,d^̇=Γdz2.By substituting Equations (20) and (21) to Equation (19), Equation (19) becomes
(22)V̇=−z1TK1z1−z2TK2z2+d~TΓd−1ḋ=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2+∑i=1i=6d~iḋiγi=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2−∑i=1i=612γid~i−ḋi2+∑i=1i=6d~i22γi+ḋi22γi≤−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2+∑i=1i=6d~i∞22γi+∑i=1i=6ḋi∞22γi.Equation (22) states that the TF-ABSC meets input-to-state stability (ISS) with respect to d~ and ḋ. Therefore, it is not only the system that converges to a bounded region, but also, the radius of convergence in the trajectory-tracking solution can arbitrarily be reduced by increasing γi. However, the boundedness of both ḋ and d~ must be guaranteed. If the lumped disturbance is time constant (ḋ=0), the global asymptotic convergence can be guaranteed by the TF approach.As shown in Equation (20), the feedback control is affected by the sum of the estimated slack variables and disturbances. Substituting Equation (21) to Equation (20) yields
(23)u=−G−1K2z2+Q−1z1+fa+Γν+Γd∫z2−α̇.Equation (23) shows that the TF method adopts integral feedback of the trajectory-tracking error z2. From Equation (23), one can observe that two adaptive update laws are excited by the same input z2. Therefore, the total uncertainty acting in each corresponding axis is compensated by the sum of two estimated values ν^+d^. As a result, estimation results for d^4 and d^5 may show poor accuracy, since slack variables are assigned to the roll and pitch axes in this controller. Even so, when the disturbed system is controllable, the performance and the stability for the TF-ABSC can be guaranteed due to the stability proof in Equation (22).The controller gain matrices used throughout the derivation are defined with positive diagonal matrices and can be represented by(24)Q=diagqii=1i=6,Γν=diagΛii=1i=6,K1=diagk1,ii=1i=6,Γd=diagγii=1i=6,K2=diagk2,ii=1i=6.


## 3.2. Immersion-and-Invariance Approach

Details on the I&I using the definition of the invariant manifold can be found in Ref. [15, 38]. Here, a nonlinear DOB based on the I&I method is proposed to estimate the disturbance d expressed in Equation (7). The design of the I&I-based DOB starts by representing the observer state d^ as the sum of the dynamic update law ξ and a continuous nonlinear shaping function β as
(25)d^=ξ+βx,ẋ,up.Then, the estimation error (off-the-manifold coordinate) is defined by(26)d~=d−ξ+βx,ẋ.The estimation error dynamics is derived by taking the time derivative of Equation (26) as
(27)d~̇=ḋ−ξ̇+∂β∂xẋ+∂β∂ẋx¨=ḋ−ξ̇+∂β∂xẋ+∂β∂ẋfnx,ẋ,up+d=ḋ−ξ̇+∂β∂xẋ+∂β∂ẋfnx,ẋ,up+d^+d~.In Equation (27), fnx,ẋ,up is the forces and moments calculated through the stabilized ABSC controller. Assuming that there exists a full-information control law up that satisfies the closed-loop stability, ξ̇ and β can be selected to render Equation (27) stable. This paper proposes the following I&I-based DOB structure:
(28)ξ̇=−∂β∂xẋ−∂β∂ẋfnx,ẋ,up+d^,β=Γdẋ,where Γd>0 is a positive diagonal matrix with observer gains. By substituting Equation (28) into Equation (27), the following estimation error dynamics can be obtained.
(29)d~̇=ḋ−Γdd~.To analyze the performance of the DOB in Equation (26), the following Lyapunov-like function and its time derivative is considered.
(30)W=12d~Td~,(31)Ẇ=d~Td~̇=d~Tḋ−d~TΓdd~≤d~ḋ∞−γmind~,where γmin is the minimum observer gain. Therefore, if ḋ∞ is finite, the estimation converges to a bounded region, and by increasing the observer gain, the estimation error decreases since the region of convergence is bounded by ḋ∞/γmin>d~. Also, when d is time invariant (ḋ=0), the estimation can converge to its real value with the convergence rate depending on the values of Γd.The shaping function proposed in Equation (28) does not use any other terms except for ẋ. Substituting the x-related term in the shaping function may increase the rate of convergence depending on the desired trajectory, but it may be difficult to choose appropriate observer gains, and the computational workload will be increased.Now, the I&I-ABSC can be designed using the defined modular I&I-based DOB. With reference to the CLF shown in Equation (17), W in Equation (30) is substituted to the CLF instead of Vd.
(32)V=Vz1+Vz2+Vν+W=12z1TQ−1z1+12z2Tz2+12ν~TΓν−1ν~+12d~Td~.Using Equations (19) and (31), the time derivative of Equation (32) becomes
(33)V̇=z1TQ−1α−ẋd+z2TQ−1z1+fa+Gu+ν^+d^−α̇+ν~Tz2+Γν−1ν~̇+d~Tz2+d~Td~̇−d~TΓdd~.The I&I-ABSC structure can be summarized as(34)α=−QK1z1+ẋd,u=−G−1K2z2+Q−1z1+fa+ν^+d^−α̇,ν^̇=Γνz2,d^=ξ+β.At this point, it is worth mentioning that the proposed I&I-ABSC differs from the TF-ABSC only in its use of I&I-based DOB for estimatingd^ instead of the TF update law. Thus, both methods are applicable for the same ABSC structure (or the same control gains) regardless of their different approach for handling the disturbances. Note that the same gain matrices in Equation (24) are adopted in the I&I-ABSC. For analyzing the stability of the I&I-ABSC, substituting Equations (34) into Equation (33) yields
(35)V̇=−z1TK1z1−z2TK2z2+d~Tz2+d~Tḋ−d~TΓdd~=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2+∑i=1i=6d~iz2,i+∑i=1i=6d~iḋi−∑i=1i=6γid~i2=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i2−z2,i22γi−∑i=1i=6z2,i22γi−d~iz2,i+γid~i22−∑i=1i=6ḋi22γi−d~iḋi+γid~i22+∑i=1i=6ḋi22γi=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,i−12γiz2,i2−∑i=1i=612γiz2,i−γid~i2−∑i=1i=612γiḋi−γid~i2+∑i=1i=6ḋi22γi≤−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,i−12γiz2,i2+∑i=1i=6ḋi∞22γi.Equation (35) proves the ISS of the I&I-ABSC when γi>1/2k2,i. As a result, not only does the system converge to a bounded region, but the radius of convergence in the trajectory-tracking solution can be reduced arbitrarily by increasing γi. Unlike Equation (22), however, the ISS of the I&I-ABSC only requires boundedness of ḋ. When the uncertainties are time-invariant, Equation (35) becomes
(36)V̇=−∑i=1i=6k1,iz1,i2−∑i=1i=6k2,iz2,i−d~i2k2,i2−∑i=1i=6γi−14k2,id~i2.Withγi≥1/4k2,i, the global stability can be guaranteed.The I&I-ABSC design ensures global asymptotic stability for time-invariant disturbances while also improving stability criteria by requiring less stringent conditions on the lumped disturbances when compared to the TF-ABSC.Moreover, unlike TF-ABSC, it is expected that the proposed I&I-ABSC can accurately estimated^ regardless of the estimated ν^ since d^ is calculated through available state values instead of z2. This is possible since the I&I-based DOB only estimates the deviation from the nominal model as in Equation (28) and the term ν^ does not affect the nominal model as demonstrated in Equation (13).The performance of the I&I-ABSC (34) will be compared to the TF-ABSC (20)–(21) and the standard BSC in the simulation section. In this paper, the BSC without the adaptation law for d^ is simply defined as the following equation.
(37)α=−QK1z1+ẋd,u=−G−1K2z2+Q−1z1+fa+ν^−α̇,ν^̇=Γνz2.


## 4. Simulation Results and Discussion

In this section, simulation results are presented. All simulations are conducted in Intel Fortran software, with the help of Intel Core i7-6700K CPU (4.0 GHz) with 32 GB of RAM. Also, the control sampling rate is set to 0.01 s.To validate both steady and transient performances of each controller, the pirouette maneuver and the helical turn maneuver (extended transient turn maneuver) defined in ADS-33E-PRF [39] are selected for the desired trajectory.The pirouette maneuver is initiated from a stabilized hover over a point above 10 ft from the ground on the circumference of a 100 ft radius circle with the heading angle pointed at the center of the circle during the maneuver. The maneuver is depicted in Figure1. Each simulation starts at the initial hover point and ends at the same point after the steady turn maneuver around the circle with the lateral velocity of 8 knots for 45 seconds. The final hovering maneuver is then applied for 10 seconds at the final point to see if the rotorcraft can stabilize after the maneuver.Figure 1
Pirouette maneuver.The helical turn maneuver is initiated from a 60-knot level flight state and returned to the same flight condition after 900 degrees of heading change with the attitude increase of 400 ft for 60 seconds. The maneuver is depicted in Figure2.Figure 2
Helical turn maneuver.


### 4.1. Case A: Performance under External Disturbances—Pirouette

To compare the performances of the BSC (37), TF-ABSC (20)-(21), and I&I-ABSC (34) under large time-varying disturbances, Equation (39) is applied to the nominal plant from 5 to 45 seconds of the maneuver, allowing 3 cycles of sinusoidal disturbances to be applied during the steady-turn maneuver. The control gains in Equation (38) are uniformly applied to two adaptive controllers, whereas K1, K2, Q, and Γν in Equation (38) are applied to the BSC.
(38)K1=k1,ii=1i=6=0.75,K2=k2,ii=1i=6=2.50,Q=qii=1i=6=1.50,Γd=γii=1i=6=5.00,Γν=0,0,0,1,1,0,(39)df,external=2.5×sinTm/s2,dm,external=114.592×sinTdeg/s2,∗T=3×2πt40s.Figure3 shows that two adaptive controllers have barely discernible differences in their control inputs. On the other hand, for the BSC, the tail rotor collective reaches its limit (20 deg) around 37 s due to the excessive path deviation in the yaw axis. As shown in Figures 4 and 5, the trajectory-tracking performance can be improved by adopting adaptive approaches. Especially when comparing the tracking errors shown in Figure 6 (e subscript denotes error in the corresponding state), one can notice that the I&I-ABSC shows superior tracking performance among the three controllers. Quantitative values of tracking errors can be compared with the root-mean-squared errors in Table 1.Figure 3
Case A: calculated controls of BSC, TF-ABSC, and I&I-ABSC.Figure 4
Case A: position tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 5
Case A: velocity tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 6
Case A: position and velocity tracking errors of BSC, TF-ABSC, and I&I-ABSC.Table 1
Case A: root-mean-squared tracking errors.
Tracking stateControl strategyBSCTF-ABSCI&I-ABSCxm16.748910.09871.8242ym16.643710.23941.9580hm16.649710.03781.6223ψdeg769.8182460.451874.7361ẋm/s7.74595.02380.8362ẏm/s7.79235.10480.9200ḣm/s7.76525.01060.8531ψ̇deg/s363.5249229.559639.2243The main difference between the TF-ABSC and the I&I-ABSC lies in the disturbance estimation results shown in Figures7 and 8. The estimation accuracy of the I&I-ABSC is higher compared to that of the TF-ABSC over the entire flight time when the same gains are applied. Furthermore, the proposed design method using the I&I-based DOB effectively estimates the disturbance acting on the pitch and roll axes, while the estimation of the TF-ABSC on the pitch and roll axes is inaccurate.Figure 7
Case A: estimation results of TF-ABSC.Figure 8
Case A: estimation results of I&I-ABSC.However, since the primary controlup is assigned to the position and heading angle, the compensation for external disturbances for the attitude states does not affect the calculation of up. This is due to the structure of the slack variable matrix suggested in Section 2. A different approach of slack variables can be found in Ref. [24] where the matrix is designed using the reduced row echelon form and the associated slack variables become effective. In this case, the gains for generating the desired values of ϕ and θ should be carefully selected, and the slack variables must be generated adequately. However, if accurate autonomous trajectory tracking is required in harsh environments, it is difficult to find gains that satisfy stability and desired trajectory conditions at the same time. Therefore, the I&I-ABSC combined with the slack variable approach can greatly reduce the design workloads while still providing accurate tracking results.


### 4.2. Case B: Performance under Both Parametric Uncertainties and External Disturbances—Helical Turn

In this subsection, simulations are conducted to verify the performance of the I&I-ABSC under both model uncertainties and external disturbances. The inertial and mass properties of a rotorcraft can be frequently changed for several reasons. Underestimating both properties in the controller can lead to serious performance degradation. Furthermore, underestimating the rotor force necessitates more control effort to compensate for the degradation. In practice, this can happen to varying degrees due to a mismatch between the real physical system and the nominal model. The disturbances and uncertainties shown in Table2 are applied during the helical turn maneuver to validate the performance of the I&I-ABSC under harsh conditions. The same controller gains in Equation (38) are used except for Γd=3.0.Table 2
Case B: disturbances & uncertainties.
UncertaintyPropertyTimeExternal disturbancedf,external=2.0×sinTm/s2dm,external=11.4592×sinTdeg/s2∗T=3×2πt/40s10~50 secMass & moment of inertia uncertainty50% less than the plant model10~60 secRotor force uncertainty20% degraded0~60 secThe results of the helical turn simulation confirm that complex maneuvers can be completed successfully with fixed gains using the proposed controller. According to Figure9, the I&I-ABSC has the most stabilized controls of all. On the other hand, oscillations in the controls of the BSC and the TF-ABSC are frequently observed. Dramatic difference between controllers can be found in Figures 10 and 11. In particular, the TF-ABSC and BSC shows oscillatory behaviors in their velocity states. Overall, the I&I-ABSC exhibits minimal tracking errors, as shown in Figure 12 and Table 3. Again, this is due to the I&I-based DOB’s ability to estimate time-varying disturbances quickly enough, as shown in the I&I estimation results in Figure 13 whereas the TF-ABSC shows poor estimation results in Figure 14. Although the I&I-ABSC cannot estimate exact parameters, the I&I-DOB observes and compensates for the overall effect of the mismatch. As a result, even when the mismatch is severe, the controller can effectively maintain its performance. These simulation results showed that the I&I-ABSC works well for both model uncertainties and external disturbances.Figure 9
Case B: calculated controls of BSC, TF-ABSC, and I&I-ABSC.Figure 10
Case B: position tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 11
Case B: velocity tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 12
Case B: position and velocity tracking errors of BSC, TF-ABSC, and I&I-ABSC.Table 3
Case B: root-mean-squared tracking errors.
Tracking stateControl strategyBSCTF-ABSCI&I-ABSCxm19.101314.467112.7250ym19.557312.194510.0530hm37.81019.41253.1919ψdeg1.1596e+03475.6811170.0442ẋm/s8.35425.10233.2202ẏm/s8.63695.37033.4476ḣm/s9.51254.60231.6852ψ̇deg/s530.3183249.667888.9577Figure 13
Case B: estimation results of I&I-ABSC.Figure 14
Case B: estimation results of TF-ABSC.


## 4.1. Case A: Performance under External Disturbances—Pirouette

To compare the performances of the BSC (37), TF-ABSC (20)-(21), and I&I-ABSC (34) under large time-varying disturbances, Equation (39) is applied to the nominal plant from 5 to 45 seconds of the maneuver, allowing 3 cycles of sinusoidal disturbances to be applied during the steady-turn maneuver. The control gains in Equation (38) are uniformly applied to two adaptive controllers, whereas K1, K2, Q, and Γν in Equation (38) are applied to the BSC.
(38)K1=k1,ii=1i=6=0.75,K2=k2,ii=1i=6=2.50,Q=qii=1i=6=1.50,Γd=γii=1i=6=5.00,Γν=0,0,0,1,1,0,(39)df,external=2.5×sinTm/s2,dm,external=114.592×sinTdeg/s2,∗T=3×2πt40s.Figure3 shows that two adaptive controllers have barely discernible differences in their control inputs. On the other hand, for the BSC, the tail rotor collective reaches its limit (20 deg) around 37 s due to the excessive path deviation in the yaw axis. As shown in Figures 4 and 5, the trajectory-tracking performance can be improved by adopting adaptive approaches. Especially when comparing the tracking errors shown in Figure 6 (e subscript denotes error in the corresponding state), one can notice that the I&I-ABSC shows superior tracking performance among the three controllers. Quantitative values of tracking errors can be compared with the root-mean-squared errors in Table 1.Figure 3
Case A: calculated controls of BSC, TF-ABSC, and I&I-ABSC.Figure 4
Case A: position tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 5
Case A: velocity tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 6
Case A: position and velocity tracking errors of BSC, TF-ABSC, and I&I-ABSC.Table 1
Case A: root-mean-squared tracking errors.
Tracking stateControl strategyBSCTF-ABSCI&I-ABSCxm16.748910.09871.8242ym16.643710.23941.9580hm16.649710.03781.6223ψdeg769.8182460.451874.7361ẋm/s7.74595.02380.8362ẏm/s7.79235.10480.9200ḣm/s7.76525.01060.8531ψ̇deg/s363.5249229.559639.2243The main difference between the TF-ABSC and the I&I-ABSC lies in the disturbance estimation results shown in Figures7 and 8. The estimation accuracy of the I&I-ABSC is higher compared to that of the TF-ABSC over the entire flight time when the same gains are applied. Furthermore, the proposed design method using the I&I-based DOB effectively estimates the disturbance acting on the pitch and roll axes, while the estimation of the TF-ABSC on the pitch and roll axes is inaccurate.Figure 7
Case A: estimation results of TF-ABSC.Figure 8
Case A: estimation results of I&I-ABSC.However, since the primary controlup is assigned to the position and heading angle, the compensation for external disturbances for the attitude states does not affect the calculation of up. This is due to the structure of the slack variable matrix suggested in Section 2. A different approach of slack variables can be found in Ref. [24] where the matrix is designed using the reduced row echelon form and the associated slack variables become effective. In this case, the gains for generating the desired values of ϕ and θ should be carefully selected, and the slack variables must be generated adequately. However, if accurate autonomous trajectory tracking is required in harsh environments, it is difficult to find gains that satisfy stability and desired trajectory conditions at the same time. Therefore, the I&I-ABSC combined with the slack variable approach can greatly reduce the design workloads while still providing accurate tracking results.


## 4.2. Case B: Performance under Both Parametric Uncertainties and External Disturbances—Helical Turn

In this subsection, simulations are conducted to verify the performance of the I&I-ABSC under both model uncertainties and external disturbances. The inertial and mass properties of a rotorcraft can be frequently changed for several reasons. Underestimating both properties in the controller can lead to serious performance degradation. Furthermore, underestimating the rotor force necessitates more control effort to compensate for the degradation. In practice, this can happen to varying degrees due to a mismatch between the real physical system and the nominal model. The disturbances and uncertainties shown in Table2 are applied during the helical turn maneuver to validate the performance of the I&I-ABSC under harsh conditions. The same controller gains in Equation (38) are used except for Γd=3.0.Table 2
Case B: disturbances & uncertainties.
UncertaintyPropertyTimeExternal disturbancedf,external=2.0×sinTm/s2dm,external=11.4592×sinTdeg/s2∗T=3×2πt/40s10~50 secMass & moment of inertia uncertainty50% less than the plant model10~60 secRotor force uncertainty20% degraded0~60 secThe results of the helical turn simulation confirm that complex maneuvers can be completed successfully with fixed gains using the proposed controller. According to Figure9, the I&I-ABSC has the most stabilized controls of all. On the other hand, oscillations in the controls of the BSC and the TF-ABSC are frequently observed. Dramatic difference between controllers can be found in Figures 10 and 11. In particular, the TF-ABSC and BSC shows oscillatory behaviors in their velocity states. Overall, the I&I-ABSC exhibits minimal tracking errors, as shown in Figure 12 and Table 3. Again, this is due to the I&I-based DOB’s ability to estimate time-varying disturbances quickly enough, as shown in the I&I estimation results in Figure 13 whereas the TF-ABSC shows poor estimation results in Figure 14. Although the I&I-ABSC cannot estimate exact parameters, the I&I-DOB observes and compensates for the overall effect of the mismatch. As a result, even when the mismatch is severe, the controller can effectively maintain its performance. These simulation results showed that the I&I-ABSC works well for both model uncertainties and external disturbances.Figure 9
Case B: calculated controls of BSC, TF-ABSC, and I&I-ABSC.Figure 10
Case B: position tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 11
Case B: velocity tracking results of BSC, TF-ABSC, and I&I-ABSC.Figure 12
Case B: position and velocity tracking errors of BSC, TF-ABSC, and I&I-ABSC.Table 3
Case B: root-mean-squared tracking errors.
Tracking stateControl strategyBSCTF-ABSCI&I-ABSCxm19.101314.467112.7250ym19.557312.194510.0530hm37.81019.41253.1919ψdeg1.1596e+03475.6811170.0442ẋm/s8.35425.10233.2202ẏm/s8.63695.37033.4476ḣm/s9.51254.60231.6852ψ̇deg/s530.3183249.667888.9577Figure 13
Case B: estimation results of I&I-ABSC.Figure 14
Case B: estimation results of TF-ABSC.


## 5. Conclusions

In this paper, the I&I-ABSC has been developed for the rotorcraft’s trajectory-tracking control problem. The rotorcraft’s dynamics were transformed into the position and attitude states to match the system states with the prescribed desired trajectory. Instead of adopting a hierarchical approach or block backstepping approach, the slack variable approach is adopted to cope with the rotorcraft’s underactuated system and to simplify the design process. To effectively compensate for the completely unknown lumped disturbance, the I&I-based DOB has been developed under the assumption that the time derivative of the disturbance is bounded. To minimize the design parameters, the observer structure is kept simple. The performance of the I&I-based DOB has been theoretically investigated using the Lyapunov-like function. Then, the I&I-based DOB is combined into the ABSC structure. The stability analysis of the I&I-ABSC’s closed-loop system demonstrates ISS for the time-varying disturbance and shows that Lyapunov’s global stability condition is satisfied when the disturbance is time invariant.Finally, a series of simulations were conducted using the pirouette and helical turn maneuvers as the desired trajectories and the high-fidelity Bo-105 model as the system plant to validate the performance of the proposed controller. To prove the effectiveness of the proposed controller, external disturbances, parameter changes, and modelling errors were considered during simulations. As a result, it has been shown that the I&I-ABSC guarantees superior trajectory tracking and estimation performance compared to the standard BSC and the TF-ABSC under complex disturbances.



---

*Source: 8447125-2022-07-01.xml*