Preprint
Article

Trajectory Tracking Control for Quadrotors Using Adaptive Integral Terminal Sliding Mode under External Disturbances

Altmetrics

Downloads

105

Views

37

Comments

0

A peer-reviewed article of this preprint also exists.

This version is not peer-reviewed

Submitted:

08 January 2024

Posted:

08 January 2024

You are already at the latest version

Alerts
Abstract
To address the trajectory tracking issue for quadrotors working under the influence of external disturbances, a control scheme is designed for position and attitude trajectory tracking. Firstly, the quadrotor dynamic model is derived for control design. Secondly, adaptive integral backstepping control (AIBS) is employed in the position loop in which adaptive estimation is used to estimate the upper bounds of disturbances. Subsequently, a new adaptive backstepping fast nonsingular integral terminal sliding mode control (ABFNITSM) is proposed to follow desired Euler angles. The intro-duction of fast nonsingular terminal sliding mode and integral element is to realize fast convergence and accurate tracking. Dead zone technique is applied to minimize estimation errors. Besides, a saturation function is utilized to eliminate chattering phenomenon. Finally, simulation experiments are conducted under the Simulink environment. The proposed control is verified by comparing it with traditional integral terminal sliding mode control (ITSM) and integral backstepping control (IBS).
Keywords: 
Subject: Engineering  -   Aerospace Engineering

1. Introduction

In recent years, quadrotors have been applied in various fields owing to their size, low costs, and capability of VTOL(vertical takeoff and landing) [1,2,3]. These considerable attributes and widespread applications propel significant focus on quadrotors [4,5,6,7]. In reality, external disturbances and measurement errors are inevitably present [8,9,10,11,12]. The key to complete tasks, e.g., power line inspection [13], logistics transportation [14], and pesticide spraying [15] depends on the performance of trajectory tracking. As a result, improving the effectiveness of trajectory tracking control under the influence of external disturbances holds important theoretical significance and practical value, which ensures that quadrotors can meet the flight requirements and avoid uncontrollable crashes.
Nair et al. achieved high-performance tracking for a satellite launch rocket system with time-varying uncertainties by designing an adaptive PID control in reference [16]. In [17], an online identification of aerodynamic parameters using the Kalman filter was utilized, followed by compensating the rotor speed using LQR strategy, resulting in improved control performance for heading and altitude. Such works generally linearize the nonlinear dynamics of quadrotors, which leads to approximation errors and performance limitations. In [18], a fuzzy logic system was used to assess the unmodeled dynamics of the quadrotor. A nonlinear disturbance observer was applied to compensate for external disturbances and assessment error. In reference [19], the authors proposed a radical basis function neural network (RBFNN) to fix the unknown dynamic problem. To increase the convergence speed and control precision, a fractional-order backstepping control was introduced. Sliding mode control is widely applied in practical systems, e.g., robot manipulation [20], linear motor positioning [21], and underwater robots [22], because of its strong robustness, fast response, and low sensitivity to uncertainties and disturbances. Conventional sliding mode (CSM) cannot guarantee the fast convergence of control system [23,24,25]. Terminal sliding mode (TSM) was designed to deal with this situation [26]. Besides, CSM may cause chattering. In [27], a modified second-order sliding mode control was introduced to address the chatting phenomenon. Omid Mofid et al. planed a super-twisting terminal sliding mode control considering input-delay, model uncertainty and wind disturbance for fast response. In [28], the dynamic model was divided into inner loop and outer loop. Nonsingular terminal sliding mode control (NTSM) was utilized to converge to the desired position and attitude in finite time. In [29], Hamid Ghadiri et al. proposed a novel adaptive nonsingular terminal sliding mode control (ANTSM). The control signals’ chattering was eliminated. Adaptive estimation was applied to compensate for unknown disturbance. In [30], the implementation of neural network (NN) approximator was to estimate the model uncertainty. Adaptive algorithms were designed to make up for the approximation error and update the NN weight matrix. Nonsingular fast terminal sliding mode control (NFTSMC) was presented to guarantee the finite-time convergence of the quadrotor to its desired trajectory. An NN-NFTSMC algorithm was formulated to provide the system with robustness in the presence of the model uncertainty and external disturbance. In [31], Mo H et al. took efforts to make comprehensive survey of control techniques for quadrotors. In this study, adaptive terminal sliding mode is the most appropriate method for quadrotor tracking control.
To develop a control scheme for full trajectory tracking of 6 DOF quadrotor’s position and attitude, an adaptive backstepping fast nonsingular integral terminal sliding mode (ABFNITSM) control is proposed to track desired attitude. The position loop is based on adaptive integral backstepping control. The main contributions of this article can be summarized as follows:
  • A new control strategy is introduced for quadrotors under external disturbances.
  • The proposed ABFNITSM control is characterized by strong robustness against nonlinearities and external disturbances compared to traditional control. Furthermore, it is also in possession of capabilities of fast response and precise tracking.
  • The implementation of adaptive estimation enables update of controller parameters online, which simplifies the tuning process. Besides, dead zone technique is employed to compensate for disturbances.
  • A new saturation function, which is differentiable, is utilized to eliminate chattering.
  • Lyapunov theory guarantees the stability of the quadrotor trajectory tracking control system.
This article is organized as follows: the derivation of the quadrotor dynamic model is introduced in Section 2. The adaptive backstepping fast nonsingular integral terminal sliding mode for attitude control and the adaptive integral backstepping for position control are designated in Section 3. Meanwhile, the stability of the control system is proven using Lyapunov theory. In Section 4, the simulation result is presented, followed by the conclusion.

2. Dynamic model of the quadrotor

The quadrotor is an underactuated system. The vector P = ( x , y , z ) T represents the translational motion and the vector Θ = ( ϕ , θ , ψ ) T denotes the Euler angle. Figure 1 shows a schematic diagram of the quadrotor.
This paper adopts the right-hand rule to define body reference frame (BRF) B = { O B , x b , y b , z b } and inertial reference frame (IRF) E = { O E , x e , y e , z e } to describe the 6DOF rigid-body motion of the quadrotor. x, y, and z represent longitudinal, lateral, and vertical translational motion respectively. ϕ , θ , and ψ are roll, pitch, and yaw angle respectively.
According to Newton-Euler principle, the system model can be written:
m P ¨ = F A + F G + F D I Ω ˙ = Ω × I Ω + τ A + τ G + τ D ,
F A is the aerodynamic force in the inertial frame.
F A = R B E 0 0 F T ,
F i is the thrust produced by the i-th motor. R i describes the rotational speed of the motor. k L represents the lift coefficient of the motor.
F T = i = 1 4 F i = k L i = 1 4 R i 2 ,
R B E is the transformation matrix from the BRF to the IRF.
R B E = cos θ cos ψ sin θ sin ϕ cos ψ cos ϕ sin ψ cos ϕ sin θ cos ψ + sin ϕ sin ψ cos θ sin ψ sin θ sin ϕ sin ψ + cos ϕ cos ψ cos ϕ sin θ sin ψ sin ϕ cos ψ sin θ sin ϕ cos θ cos ϕ cos θ ,
F G is the gravitational force. F D represents the force due to air resistance.
F D = k F x ˙ y ˙ z ˙ ,
I is the inertia matrix of the quadrotor. Based on the assumptions in Appendix A, I is defined as follows:
I = d i a g I x x , I y y , I z z ,
The notation [ ] × means the cross-product operator. Based on the vector Ω , it defines a skew-symmetric matrix.
Ω × = 0 r q r 0 p q p 0 ,
τ A denotes the aerodynamic torque produced by motors. d is the distance between the rotation axis of one motor and the center of gravity. k M is the torque coefficient of one motor during rotation.
τ A = F 4 F 2 F 1 F 3 k M R 1 2 R 2 2 + R 3 2 R 4 2 = U ϕ U θ U ψ ,
τ G stands for the torque caused by the gyroscopic effect. τ D reflects the torque owing to air friction.
τ D = k T p 2 q 2 r 2 ,
Actually, a quadrotor undergoes various problems such as inaccurate parametric (mass and inertia) measurement, control effectiveness and external disturbances. These throw obstacles in control design. In order to formulate the control problem, equation (2) is rewritten incorporating matched/unmatched uncertainties as
m + m P ¨ = F A + F A + F G + F G + F D I + I Ω ˙ = Ω × I + I Ω + τ A + τ A + τ G + τ D ,
where m R , I R 3 × 3 , F A R 3 and τ A R 3 represent uncertainty in mass, inertia and control effectiveness, respectively. According to lemma1, the above equation can be re-written as:
m P ¨ = F A + F G + F D + D P Ω ˙ = I 1 Ω × I Ω + τ A + τ D + D A ,
where D P and D A are lumped uncertainties.
  • Lemma 1:
A + B C D 1 = A 1 E + A 1 B C D 1 A 1 B C D A 1 ,
where A R m × m , B R m × n , C R n × p , D R p × m , and E is unit diagonal matrix.
The relationships between the angular velocity of a quadrotor in BRF and the angular velocity in IRF are represented as follows:
ϕ ˙ θ ˙ ψ ˙ = 1 sin ϕ tan θ cos ϕ tan θ 0 cos ϕ sin ϕ 0 sin ϕ sec θ cos ϕ sec θ p q r ,
According the small angle approximation principle, the transformation matrix can be approximated as the identity matrix.
p ˙ q ˙ r ˙ ϕ ¨ θ ¨ ψ ¨ ,
The vector X = ϕ , ϕ ˙ , θ , θ ˙ , ψ , ψ ˙ , x , x ˙ , y , y ˙ , z , z ˙ R 12 denotes the state variables.
The virtual position control inputs are defined as follows:
U x U y U z = F T m 1 cos x 1 sin x 3 cos x 5 + sin x 1 sin x 5 F T m 1 cos x 1 sin x 3 sin x 5 sin x 1 cos x 5 F T m 1 cos x 1 cos x 3 g ,
The equation (13) can be rewritten as follows:
x ˙ 1 x ˙ 2 x ˙ 3 x ˙ 4 x ˙ 5 x ˙ 6 x ˙ 7 x ˙ 8 x ˙ 9 x ˙ 10 x ˙ 11 x ˙ 12 = x 2 a 1 x 4 x 6 + a 2 x 2 2 + b 1 U ϕ + d ϕ x 4 a 3 x 2 x 6 + a 4 x 4 2 + b 2 U θ + d θ x 6 a 5 x 2 x 4 + a 6 x 6 2 + b 3 U ψ + d ψ x 8 a 7 x 8 + U x + d x x 10 a 8 x 10 + U y + d y x 12 a 9 x 12 + U z + d z ,
where:
a 1 a 2 a 3 a 4 a 5 a 6 a 7 a 8 a 9 b 1 b 2 b 3 = I x x 1 ( I y y I z z ) I x x 1 k T I y y 1 ( I z z I x x ) I y y 1 k T I z z 1 ( I x x I y y ) I z z 1 k T m 1 k F m 1 k F m 1 k F I x x 1 d I y y 1 d I z z 1 ,

3. Control design

This section is committed to the design of trajectory tracking control and stability analysis. Taking parametric uncertainties and external disturbances into consideration, a trajectory tracking control strategy is formulated to ensure quick and accurate tracking of reference commands. To achieve this goal, a new control is proposed integrating terminal sliding mode, integral element, backstepping technique and dead zone technique for attitude trajectory tracking. For the sake of chattering elimination, a new saturation function is designed. Additionally, an online adaptive estimation technique is introduced to compensate for parametric uncertainties and external disturbances. Adaptive integral backstepping control is introduced in position loop. Figure 2 illustrates the entire control flow diagram.

3.1. Position tracking control design

The adaptive integral backstepping (AIBS) control exhibits good robustness. It combines the characteristics of integral backstepping control and adaptive estimation to facilitate precise tracking and stable control. The basic idea of backstepping method is to gradually introduce virtual control variables and recursively design control laws to guide the tracking errors from an initial state to zero. An adaptive law is used to compensate for modeling errors, external disturbances, and measurement noise. The design process of AIBS is depicted as follows:
Figure 3. Block diagram of AIBS.
Figure 3. Block diagram of AIBS.
Preprints 95758 g003
  • AIBS control design step 1:
The position tracking error is defined as follows:
e 7 e 9 e 11 = x 7 x 7 d x 9 x 9 d x 11 x 11 d ,
where x 7 d , x 9 d , and x 11 d are desired trajectory. The time derivative of equation (18) is:
e ˙ 7 e ˙ 9 e ˙ 11 = x ˙ 7 x ˙ 7 d x ˙ 9 x ˙ 9 d x ˙ 11 x ˙ 11 d = x 8 x ˙ 7 d x 10 x ˙ 9 d x 12 x ˙ 11 d ,
The Lyapunov function is defined as follows for stable system:
l x 1 l y 1 l z 1 = 1 2 e 7 2 + k 7 Γ 7 2 e 9 2 + k 9 Γ 9 2 e 11 2 + k 11 Γ 11 2 ,
where:
Γ = e d τ 7 , 9 , 11 ,
The time derivative of equation (20) is:
l ˙ x 1 l ˙ y 1 l ˙ z 1 = e 7 e ˙ 7 + k 7 Γ 7 Γ ˙ 7 e 9 e ˙ 9 + k 9 Γ 9 Γ ˙ 9 e 11 e ˙ 11 + k 11 Γ 11 Γ ˙ 11 = e 7 x 8 x ˙ 7 d + k 7 Γ 7 Γ ˙ 7 e 9 x 10 x ˙ 9 d + k 9 Γ 9 Γ ˙ 9 e 11 x 12 x ˙ 11 d + k 11 Γ 11 Γ ˙ 11 ,
The system virtual control input is selected as follows:
x 8 d x 10 d x 12 d = ξ 7 e 7 + x ˙ 7 d k 7 Γ 7 ξ 9 e 9 + x ˙ 9 d k 9 Γ 9 ξ 11 e 11 + x ˙ 11 d k 11 Γ 11 ,
where ξ 7 , ξ 9 , and ξ 11 are positive constants to be designed.
Substituting (23) into (22) yields:
l ˙ x 1 l ˙ y 1 l ˙ z 1 = ξ 7 e 7 2 ξ 9 e 9 2 ξ 11 e 11 2 0 ,
  • AIBS control design step 2:
The second tracking error is given by:
e 8 e 10 e 12 = x 8 x 8 d x 10 x 10 d x 12 x 12 d ,
The Lyapunov function can be defined as follows:
l x 2 l y 2 l z 2 = 1 2 e 7 2 + k 7 Γ 7 2 + e 8 2 e 9 2 + k 9 Γ 9 2 + e 8 2 e 11 2 + k 11 Γ 11 2 + e 12 2 ,
The time derivative of equation (26) is:
l ˙ x 2 l ˙ y 2 l ˙ z 2 = e 7 e ˙ 7 + k 7 Γ 7 Γ ˙ 7 + e 8 e ˙ 8 e 9 e ˙ 9 + k 9 Γ 9 Γ ˙ 9 + e 10 e ˙ 10 e 11 e ˙ 11 + k 11 Γ 11 Γ ˙ 11 + e 12 e ˙ 12 ,
Substituting (19), (23), and (25) into (27) generates:
l ˙ x 2 l ˙ y 2 l ˙ z 2 = ξ 7 e 7 2 + e 8 ( e 7 + e ˙ 8 ) ξ 9 e 9 2 + e 10 ( e 9 + e ˙ 10 ) ξ 11 e 11 2 + e 12 ( e 11 + e ˙ 12 ) ,
To ensure the stability of the position tracking control system, we need to satisfy the following condition:
e 7 + e ˙ 8 e 9 + e ˙ 10 e 11 + e ˙ 12 = ξ ^ 8 e 8 ξ ^ 10 e 10 ξ ^ 12 e 12 ,
where ξ ^ 8 , ξ ^ 10 , and ξ ^ 12 are the estimation of ξ 8 , ξ 10 , and ξ 12 respectively.
From (29), the corresponding position control law can be derived as follows:
U x U y U z = x ¨ 7 d + ξ 7 2 1 k 7 e 7 ξ 7 + ξ ^ 8 e 8 a 7 x 8 + ξ 7 k 7 Γ 7 d x x ¨ 9 d + ξ 9 2 1 k 9 e 9 ξ 9 + ξ ^ 10 e 10 a 8 x 10 + ξ 9 k 9 Γ 9 d y x ¨ 11 d + ξ 11 2 1 k 11 e 11 ξ 11 + ξ ^ 12 e 12 a 9 x 12 + ξ 11 k 11 Γ 11 d z ,
  • Proof of stability of position tracking control:
To prove the stability of the system and determine the parametric values of ξ ^ 8 , ξ ^ 10 , and ξ ^ 12 , ξ ^ 8 is taken as an illustration. The Lyapunov function is formulated as follows:
L P x = 1 2 ( e 7 2 + k 7 Γ 7 2 + e 8 2 + 1 α 8 e ~ ξ 8 2 ) ,
where α 8 is positive constant, e ~ ξ 8 is the estimation error.
The time derivative of equation (31) is:
L ˙ P x = ξ 7 e 7 2 ξ 8 e 8 2 + e ~ ξ 8 e 8 2 1 α 8 ξ ^ ˙ 8 ,
If the third term on the right-hand side of (32) is set to 0, it can be deduced that:
ξ ^ ˙ 8 = α 8 e 8 2 ,
Then,
L ˙ P x = ξ 7 e 7 2 ξ 8 e 8 2 0 ,
Therefore, the subsystem is stable.
For the purpose of establishing a complete proof, the Lyapunov function is defined as follows:
L P = 1 2 ( e 7 2 + k 7 Γ 7 2 + e 8 2 + 1 α 8 e ~ ξ 8 2 + e 9 2 + k 9 Γ 9 2 + e 10 2 + 1 α 10 e ~ ξ 10 2 + e 11 2 + k 11 Γ 11 2 + e 12 2 + 1 α 12 e ~ ξ 12 2 ) ,
The time derivative of the (36) is:
L ˙ P = ξ 7 e 7 2 ξ 8 e 8 2 ξ 9 e 9 2 ξ 10 e 10 2 ξ 11 e 11 2 ξ 12 e 12 2 0 ,
where ξ 7 , ξ 8 , ξ 9 , ξ 10 , ξ 11 , and ξ 12 are positive constants.
The stability proof of the position tracking system is now completed.
  • Adaptive laws:
ξ ^ ˙ 8 ξ ^ ˙ 10 ξ ^ ˙ 12 = α 8 e 8 2 α 10 e 10 2 α 12 e 12 2 ,
where α 8 , α 10 , and α 12 are positive constants under design.
Based on (15), thrust and the desired attitude angle can be calculated as follows:
F T = m U x 2 + U y 2 + U z + g 2 θ d = tan 1 cos ψ d U x + sin ψ d U y U z + g ψ d = tan 1 cos θ d sin ψ d U x cos ψ d U y U z + g ,

3.2. Attitude tracking control design

The previously proposed AIBS control has been effective in position tracking, ensuring the stability of the position subsystem. In this section, a robust adaptive backstepping fast nonsingular integral terminal sliding mode control (ABFNITSM) is proposed for attitude tracking. A new saturation is designed to eliminate chattering. The main objective of this control is to ensure system stability and achieve fast convergence of the Euler angle to the desired trajectory.
Figure 4. Block diagram of ABFNITSM.
Figure 4. Block diagram of ABFNITSM.
Preprints 95758 g004
The saturation function is designed as follows:
s a t x = e x 1 e x + 1 ,
  • ABFNITSM control design step 1:
The attitude tracking error is defined as follows:
e 1 e 3 e 5 = x 1 x 1 d x 3 x 3 d x 5 x 5 d ,
where x 1 d , x 3 d , and x 5 d are desired trajectory. The time derivative of equation (40) is:
e ˙ 1 e ˙ 3 e ˙ 5 = x ˙ 1 x ˙ 1 d x ˙ 3 x ˙ 3 d x ˙ 5 x ˙ 5 d = x 2 x ˙ 1 d x 4 x ˙ 3 d x 6 x ˙ 5 d ,
The Lyapunov function is defined as follows:
l ϕ 1 l θ 1 l ψ 1 = 1 2 e 1 2 e 3 2 e 5 2 ,
The time derivative of the (42) is:
l ˙ ϕ 1 l ˙ θ 1 l ˙ ψ 1 = e 1 e ˙ 1 e 3 e ˙ 3 e 5 e ˙ 5 = e 1 x 2 x ˙ 1 d e 3 x 4 x ˙ 3 d e 5 x 6 x ˙ 5 d ,
The system virtual control input is selected as follows:
x 2 d x 4 d x 6 d = s 1 + x ˙ 1 d ξ 1 e 1 s 3 + x ˙ 3 d ξ 3 e 3 s 5 + x ˙ 5 d ξ 5 e 5 ,
  • ABFNITSM control design step 2:
The sliding mode function is chosen as follows:
s 1 s 3 s 5 = e ˙ 1 + 0 t δ ϕ 1 e 1 η ϕ 1 s a t e 1 + δ ϕ 2 e ˙ 1 η ϕ 2 s a t e ˙ 1 d τ e ˙ 3 + 0 t δ θ 1 e 3 η θ 1 s a t e 3 + δ θ 2 e ˙ 3 η θ 2 s a t e ˙ 3 d τ e ˙ 5 + 0 t δ ψ 1 e 5 η ψ 1 s a t e 5 + δ ψ 2 e ˙ 5 η ψ 2 s a t e ˙ 5 d τ ,
where δ i = ϕ , θ , ψ ; i = 1 , 2 are positive constants to be designed.
With the sliding function s k to be differentiable and the system to exhibit Hurwitz stability for s k = 0 ( k = 1 , 3 , 5 ) , the controller parameters aforementioned must satisfy the following condition:
η ϕ 1 η ϕ 2 η θ 1 η θ 2 η ψ 1 η ψ 2 = exp e 1 + 0.25 1.4 e 1 + 0.2 0.7 + 0.5 2 η ϕ 1 ( 1 + η ϕ 1 ) 1 exp e 3 + 0.25 1.4 e 3 + 0.2 0.7 + 0.5 2 η θ 1 ( 1 + η θ 1 ) 1 exp e 5 + 0.25 1.4 e 5 + 0.2 0.7 + 0.5 2 η ψ 1 ( 1 + η ψ 1 ) 1 ,
The time derivative of equation (45) is:
s ˙ 1 s ˙ 3 s ˙ 5 = e ¨ 1 + δ ϕ 1 e 1 η ϕ 1 s a t e 1 + δ ϕ 2 e ˙ 1 η ϕ 2 s a t e ˙ 1 e ¨ 3 + δ θ 1 e 3 η θ 1 s a t e 3 + δ θ 2 e ˙ 3 η θ 2 s a t e ˙ 3 e ¨ 5 + δ ψ 1 e 5 η ψ 1 s a t e 5 + δ ψ 2 e ˙ 5 η ψ 2 s a t e ˙ 5 ,
To ensure system stability, the following Lyapunov function is defined as follows:
l ϕ 2 l θ 2 l ψ 2 = 1 2 e 1 2 + s 1 2 e 3 2 + s 3 2 e 5 2 + s 5 2 ,
The time derivative of equation (48) is:
l ˙ ϕ 2 l ˙ θ 2 l ˙ ψ 2 = e 1 e ˙ 1 + s 1 s ˙ 1 e 3 e ˙ 3 + s 3 s ˙ 3 e 5 e ˙ 5 + s 5 s ˙ 5 ,
Substituting (44) into (49) derives:
l ˙ ϕ 2 l ˙ θ 2 l ˙ ψ 2 = ξ 1 e 1 2 + s 1 s ˙ 1 + e 1 ξ 3 e 3 2 + s 3 s ˙ 3 + e 3 ξ 5 e 5 2 + s 5 s ˙ 5 + e 5 ,
With the intention of system stability, the second term on the right-hand side of equation (50) is expected to be equal to zero.
s ˙ 1 + e 1 s ˙ 3 + e 3 s ˙ 5 + e 5 = 0 ,
Neglecting the uncertainty term (i.e., D A = 0 ) and substituting (47) into (51), the equivalent control input is calculated as follows:
U ϕ 0 U θ 0 U ψ 0 = b 1 1 ( x ¨ 1 d a 1 x 4 x 6 a 2 x 2 2 δ ϕ 1 e 1 η ϕ 1 s a t e 1 δ ϕ 2 e ˙ 1 η ϕ 2 s a t e ˙ 1 e 1 ) b 2 1 ( x ¨ 3 d a 2 x 2 x 6 a 4 x 4 2 δ θ 1 e 3 η θ 1 s a t e 3 δ θ 2 e ˙ 3 η θ 2 s a t e ˙ 3 e 3 ) b 3 1 ( x ¨ 5 d a 3 x 2 x 4 a 6 x 6 2 δ ψ 1 e 5 η ψ 1 s a t e 5 δ ψ 2 e ˙ 5 η ψ 2 s a t e ˙ 5 e 5 ) ,
Then, the reaching law is selected as follows:
U ϕ 1 U θ 1 U ψ 1 = b 1 1 ( ρ ϕ 1 s 1 + ρ ϕ 2 s 1 σ ϕ s a t s 1 + Q ^ ϕ 1 + Q ^ ϕ 2 x 1 + Q ^ ϕ 3 x 2 s a t s 1 ) b 2 1 ( ρ θ 1 s 3 + ρ θ 2 s 3 σ θ s a t s 3 + Q ^ θ 1 + Q ^ θ 2 x 3 + Q ^ θ 3 x 4 s a t s 3 ) b 3 1 ( ρ ψ 1 s 5 + ρ ψ 2 s 5 σ ψ s a t s 5 + Q ^ ψ 1 + Q ^ ψ 2 x 5 + Q ^ ψ 3 x 6 s a t s 5 ) ,
where ρ i and σ are controller parameters that need to be designed and are greater than zero. Q ^ j is the estimation of the parameters related to uncertainties, which is updated by the following adaptive estimation algorithm ( ϕ , θ , ψ , i 1 , 2 , j { 1 , 2 , 3 } ) :
  • Adaptive estimation algorithm:
Q ^ ˙ ϕ 1 Q ^ ˙ ϕ 2 Q ^ ˙ ϕ 3 Q ^ ˙ θ 1 Q ^ ˙ θ 2 Q ^ ˙ θ 3 Q ^ ˙ ψ 1 Q ^ ˙ ψ 2 Q ^ ˙ ψ 3 = Δ ϕ 1 s 1 Δ ϕ 2 s 1 x 1 Δ ϕ 3 s 1 x 2 Δ θ 1 s 3 Δ θ 2 s 3 x 3 Δ θ 3 s 3 x 4 Δ ψ 1 s 5 Δ ψ 2 s 5 x 5 Δ ψ 3 s 5 x 6 ,
where Δ i ( ϕ , θ , ψ , i { 1 , 2 , 3 } ) are positive constants that need to be confirmed.
  • Dead zone technique:
In practical applications, the sliding variables s 1 , s 3 , and s 5 often encounter chattering due to measurement noise, leading to overestimation of Q . To alleviate this issue, dead-zone technique is used to adjust the adaptive law.
Q ^ ˙ ϕ 1 = Δ ϕ 1 s 1 , s 1 δ 0 , s 1 > δ Q ^ ˙ ϕ 2 = Δ ϕ 2 s 1 x 1 , s 1 δ 0 , s 1 > δ Q ^ ˙ ϕ 3 = Δ ϕ 3 s 1 x 2 , s 1 δ 0 , s 1 > δ Q ^ ˙ θ 1 = Δ θ 1 s 3 , s 3 δ 0 , s 3 > δ Q ^ ˙ θ 2 = Δ θ 2 s 3 x 3 , s 3 δ x , s 3 > δ Q ^ ˙ θ 3 = Δ θ 3 s 3 x 4 , s 3 δ 0 , s 3 > δ Q ^ ˙ ψ 1 = Δ ψ 1 s 5 , s 5 δ 0 , s 5 > δ Q ^ ˙ ψ 2 = Δ ψ 2 s 5 x 5 , s 5 δ 0 , s 5 > δ Q ^ ˙ ψ 3 = Δ ψ 3 s 5 x 6 , s 5 δ 0 ,     s 5 > δ ,
where δ > 0 represents the threshold for the deviation caused by influencing factors (such as sensor noise, uncertainty in estimation and inertia delay of the motor). In this article, δ is set to 0.3.
Adding the equivalent input and the convergence control input together yields the total control input:
U ϕ U θ U ψ = U ϕ 0 + U ϕ 1 U θ 0 + U θ 1 U ψ 0 + U ψ 1 ,
  • Proof of stability of attitude tracking control:
The Lyapunov function is defined as follows:
l ϕ l θ l ψ = 1 2 e 1 2 + s 1 2 + l = 1 3 1 ϕ l Q ~ ϕ l 2 e 3 2 + s 3 2 + m = 1 3 1 θ m Q ~ θ m 2 e 5 2 + s 5 2 + n = 1 3 1 ψ n Q ~ ψ n 2 ,
Q ~ represents the estimation error. The time derivative of equation (57) is given as follows:
l ˙ ϕ l ˙ θ l ˙ ψ = e 1 e ˙ 1 + s 1 s ˙ 1 + l = 1 3 1 ϕ l Q ~ ϕ l Q ~ ˙ ϕ l e 3 e ˙ 3 + s 3 s ˙ 3 + m = 1 3 1 θ m Q ~ θ m Q ~ ˙ θ m e 5 e ˙ 5 + s 5 s ˙ 5 + n = 1 3 1 ψ n Q ~ ψ n Q ~ ˙ ψ n ,
Substituting (44), (47), and (56) into (58) produces:
l ˙ ϕ l ˙ θ l ˙ ψ = ξ 1 e 1 2 ρ ϕ 1 s 1 2 ρ ϕ 2 s 1 σ ϕ + 1 Φ ϕ s 1 ξ 3 e 3 2 ρ θ 1 s 3 2 ρ θ 2 s 3 σ θ + 1 Φ θ s 3 ξ 5 e 5 2 ρ ψ 1 s 5 2 ρ ψ 2 s 5 σ ψ + 1 Φ ψ s 5 0 ,
where:
Φ ϕ Φ θ Φ ψ = Q ϕ 1 + Q ϕ 2 x 1 + Q ϕ 3 x 2 Q θ 1 + Q θ 2 x 3 + Q θ 3 x 4 Q ψ 1 + Q ψ 2 x 5 + Q ψ 3 x 6 ,
Based on the provided information and equations, the stability of system is proven.

4. Results

This section presents simulation results to validate the performance of the proposed control. During simulation tests, the initial position and attitude are set to 0,0 , 0 T m and 0,0 , 0 T rad, respectively. The static parameters and control system parameters are listed in Table 1 and Table 2 respectively.
The proposed control is compared with the integral backstepping control and integral terminal sliding mode. The simulations are performed with external disturbances caused by wind gusts or other factors.
The external disturbances are assumed to follow Gaussian distribution. The "Random Number" block in Simulink is utilized to generate random numbers with a mean of 0 and a standard deviation of 10 as disturbances. The sampling time is set to 2s. To ensure that the disturbances in the position loop stay within the range of -1.5 to 1.5 r a d / s 2 and that the disturbances in the attitude loop stay within the range of -2 to 2 r a d / s 2 , the generated random numbers should be multiplied by appropriate scaling factors.

4.1. Case1

In this case, the quadrotor is demanded to track a simple rectangle trajectory. External disturbances are taken into account. A 3D trajectory plot provides a visual representation of the tracking performance of a control (Figure 5). It allows for a comprehensive view of how well the control is able to follow the desired trajectory in 3D space. The simulation results are presented in Figure 6, Figure 7, Figure 8, Figure 9, Figure 10 and Figure 11. To provide a more intuitive representation of the control performance, error curves for the x , y , z directions and Euler angles are plotted.
The desired trajectory are defined as follows:
x 5 d = π 3 ,     0 x < 40 0 ,     40 x < 80 ,
x 7 d = 5 + 0.5 t 0 t < 20 15 20 t < 40 15 0.5 t 40 40 t < 60 5 60 t < 80 ,
x 9 d = 5 0 t < 20 5 + 0.5 t 20 20 t < 40 15 40 t < 60 15 0.5 t 60 60 t < 80 ,
x 11 d = 11 ,
Due to that the initial position and attitude are set to 0, the quadrotor attempts to approach the desired trajectory quickly, which results in excessively large desired roll and pitch angles during the initial stages of the simulation, leading to significant tracking errors.
The results demonstrate that both controllers track the desired position and attitude in the presence of disturbances in Figure 5 and Figure 9, Figure 10 and Figure 11, while the proposed controller behaves excellently. Even when there is a sudden change in the yaw angle, the proposed controller still rapidly reacts and tracks the new trajectory in Figure 11. Through comparison, it is evident that the proposed controller exhibits better performance.
Finally, by comparing with IBS-ITSM, the proposed controller possesses better performance. The square trajectory used in this case is relatively simple. In the next case, a more complex trajectory will be employed to further demonstrate the supremacy of the proposed controller. 

4.2. Case2

In this scenario, the quadrotor is required to track a sophisticated trajectory under the influence of external disturbances. The simulation results are presented in Figure 12-18.
The desired trajectories are defined as follows:
x 5 d = π 3 ,     0 t < 40 0 ,     40 t < 80 ,
x 7 d = 10 cos 0.5 t ,
x 9 d = 10 sin 0.5 t ,
x 11 d = 10 + 0.5 t
From Figure 13, Figure 14, Figure 15, Figure 16, Figure 17 and Figure 18, it can be observed that the tracking performance of the IBS-ITSM control is not ideal, exhibiting relatively large fluctuations in the presence of disturbances. In contrast, the proposed controller successfully tracked the desired trajectory and attitude faster and more accurately, demonstrating the robustness and superiority of the proposed controller.
Figure 12. 3D position trajectory tracking.
Figure 12. 3D position trajectory tracking.
Preprints 95758 g012

5. Conclusion

In this paper, the quadrotor dynamic model considering parameter uncertainty and external disturbances is derived with the Newton-Euler equation. An AIBS control is proposed in position loop. The desired attitude is derived by decoupling equations based on the desired position. Furthermore, a new ABFNITSM control is proposed for the attitude tracking, utilizing integral element, backstepping, adaptive estimation technique and dead-zone technique based on terminal sliding mode control. A saturation function is introduced to eliminate chattering. The Lyapunov theory is employed to verify the stability of the control system. Finally, the proposed AIBS-ABFNITSM control has better performance and good robustness against external random disturbances through comparing it with IBS-ITSM.

6. Future work

Future work includes validating the performance of the AIBS-ABFNITSM control scheme in trajectory tracking tasks on an actual quadrotor. Considering the limitations of Euler angles, exploring the application of quaternions in quadrotor’s attitude trajectory tracking control is worth investigating.

Author Contributions

Conceptualization, Shipeng Jiao, Jun Wang and Yuchen Hua; Data curation, Shipeng Jiao; Formal analysis, Shipeng Jiao; Investigation, Shipeng Jiao; Methodology, Shipeng Jiao, Jun Wang and Yuchen Hua; Project administration, Ye Zhuang; Resources, Shipeng Jiao, Jun Wang and Yuchen Hua; Software, Shipeng Jiao; Supervision, Jun Wang, Yuchen Hua and Ye Zhuang; Validation, Shipeng Jiao; Visualization, Shipeng Jiao and Xuetian Yu; Writing – original draft, Shipeng Jiao; Writing – review & editing, Jun Wang, Yuchen Hua and Ye Zhuang. All authors have read and agreed to the published version of the manuscript.

Funding

This research received no external funding.

Data Availability Statement

The data is contained within the article.

Conflicts of Interest

The authors declare no conflicts of interest.

Appendix A

Appendix A.1. Assumptions

  • The quadrotor structure is symmetric.
  • The geometric center of the quadrotor coincides with its center of gravity.
  • The forces and torques caused by air friction are proportional to the quadrotor’s velocity and the square of the quadrotor’s angular velocity, respectively.
  • External disturbances enter the system in the form of acceleration.
  • The forces and moments generated by the motors are proportional to the square of the motor speeds.

References

  1. Liang, X.; Yu, H.; Zhang, Z.; Liu, H.; Fang, Y.; Han, J. Unmanned aerial transportation system with flexible connection between the quadrotor and the payload: modeling, controller design, and experimental validation. IEEE T. Ind. Electron. 2022, 70(2), 1870–1882. [Google Scholar] [CrossRef]
  2. Wang, Y.; Lu, Q.; Ren, B. Wind Turbine Crack Inspection Using a Quadrotor with Image Motion Blur Avoided. IEEE Robot. Autom. Lett. 2023, 8(2), 1069–1076. [Google Scholar] [CrossRef]
  3. Huang, T.; Huang, D.; Wang, Z.; Dai, X.; Shah, A. Generic adaptive sliding mode control for a quadrotor UAV system subject to severe parametric uncertainties and fully unknown external disturbance. Int. J. Control Autom. Syst. 2021, 19, 698–711. [Google Scholar] [CrossRef]
  4. Li, B.; Gong, W.; Yang, Y.; Xiao, B.; Ran, D. Appointed fixed time observer-based sliding mode control for a quadrotor UAV under external disturbances. IEEE T. Aero. Elec. Sys. 2021, 58(1), 290–303. [Google Scholar] [CrossRef]
  5. Pan, J.; Shao, B.; Xiong, J.; Zhang, Q. Attitude control of quadrotor UAVs based on adaptive sliding mode. Int. J. Control Autom. Syst. 2023, 1–10. [Google Scholar] [CrossRef]
  6. Pouzesh, M.; Mobayen, S. Event-triggered fractional-order sliding mode control technique for stabilization of disturbed quadrotor unmanned aerial vehicles. Aerosp. Sci. Technol. 2022, 121, 107337. [Google Scholar] [CrossRef]
  7. Sonugür, G. A Review of quadrotor UAV: Control and SLAM methodologies ranging from conventional to innovative approaches. Robot. Auton. Syst. 2023, 161, 104342. [Google Scholar] [CrossRef]
  8. Xiong, J.; Pan, J.; Chen, G.; Zhang, X.; Ding, F. Sliding mode dual-channel disturbance rejection attitude control for a quadrotor. IEEE T. Ind. Electron. 2021, 69(10), 10489–10499. [Google Scholar] [CrossRef]
  9. Labbadi, M.; Cherkaoui, M. Robust adaptive nonsingular fast terminal sliding-mode tracking control for an uncertain quadrotor UAV subjected to disturbances. ISA Trans. 2020, 99, 290–304. [Google Scholar] [CrossRef]
  10. Rojsiraphisal, T.; Mobayen, S.; Asad, J. H.; Vu, M. T.; Chang, A.; Puangmalai, J. Fast terminal sliding control of underactuated robotic systems based on disturbance observer with experimental validation. Mathematics 2021, 9(16), 1935. [Google Scholar] [CrossRef]
  11. Lim, D.; Kim, H.; Yee, K. Uncertainty propagation in flight performance of multirotor with parametric and model uncertainties. Aerosp. Sci. Technol. 2022, 122, 107398. [Google Scholar] [CrossRef]
  12. Kim, H.; Ahn, H.; Chung, Y.; You, K. Quadrotor Position and Attitude Tracking Using Advanced Second-Order Sliding Mode Control for Disturbance. Mathematics 2023, 11(23), 4786. [Google Scholar] [CrossRef]
  13. Li, Z.; Zhang, Y.; Wu, H.; Suzuki, S.; Namiki, A.; Wang, W. Design and Application of a UAV Autonomous Inspection System for High-Voltage Power Transmission Lines. Remote Sens. 2023, 15(3), 865. [Google Scholar] [CrossRef]
  14. Ha, Q. M.; Deville, Y.; Pham, Q. D.; Hà, M. H. On the min-cost traveling salesman problem with drone. Transp. Res. Part C Emerg. Technol. 2018, 86, 597–621. [Google Scholar] [CrossRef]
  15. Wang, C.; Liu, Y.; Zhang, Z.; Han, L.; Li, Y.; Zhang, H.; Wongsuk, S.; Wu, X.; He, X. Spray performance evaluation of a six-rotor unmanned aerial vehicle sprayer for pesticide application using an orchard operation mode in apple orchards. Pest Manag. Sci. 2022, 78(6), 2449–2466. [Google Scholar] [CrossRef]
  16. Nair, A. P.; Selvaganesan, N.; Lalithambika, V. R. Lyapunov based PD/PID in model reference adaptive control for satellite launch vehicle systems. Aerosp. Sci. Technol. 2016, 51, 70–77. [Google Scholar] [CrossRef]
  17. Zhengxi, W; Yang, C; Xiujuan, Z; Lei, C. Quadrotor UAV Control with Disturbance Based on Aerodynamic Parameter Estimation. Inf. Control 2018, 47(6), 663–670.
  18. Li, C.; Wang, Y.; Yang, X. Adaptive fuzzy control of a quadrotor using disturbance observer. Aerosp. Sci. Technol. 2022, 128, 107784. [Google Scholar] [CrossRef]
  19. Guettal, L.; Chelihi, A.; Ajgou, R.; Touba, M. M. Robust tracking control for quadrotor with unknown nonlinear dynamics using adaptive neural network based fractional-order backstepping control. J. Franklin Inst. 2022, 359(14), 7337–7364. [Google Scholar] [CrossRef]
  20. Yu, S.; Yu, X.; Shirinzadeh, B.; Man, Z. Continuous finite-time control for robotic manipulators with terminal sliding mode. Automatica 2005, 41(11), 1957–1964. [Google Scholar] [CrossRef]
  21. Shao, K.; Zheng, J.; Huang, K.; Wang, H.; Man, Z.; Fu, M. Finite-time control of a linear motor positioner using adaptive recursive terminal sliding mode. IEEE T. Ind. Electron. 2019, 67(8), 6659–6668. [Google Scholar] [CrossRef]
  22. Cui, R.; Chen, L.; Yang, C.; Chen, M. Extended state observer-based integral sliding mode control for an underwater robot with unknown disturbances and uncertain nonlinearities. IEEE T. Ind. Electron. 2017, 64(8), 6785–6795. [Google Scholar] [CrossRef]
  23. Labbadi, M.; Muñoz-Vázquez, A. J.; Djemai, M.; Boukal, Y.; Zerrougui, M.; Cherkaoui, M. Fractional-order nonsingular terminal sliding mode controller for a quadrotor with disturbances. Appl. Math. Model. 2022, 111, 753–776. [Google Scholar] [CrossRef]
  24. Lian, S.; Meng, W.; Shao, K.; Zheng, J.; Zhu, S.; Li, H. Full Attitude Control of a Quadrotor Using Fast Nonsingular Terminal Sliding Mode With Angular Velocity Planning. IEEE T. Ind. Electron. 2022, 70(4), 3975–3984. [Google Scholar] [CrossRef]
  25. Labbadi, M.; Cherkaoui, M. Robust adaptive nonsingular fast terminal sliding-mode tracking control for an uncertain quadrotor UAV subjected to disturbances. ISA Trans. 2020, 99, 290–304. [Google Scholar] [CrossRef] [PubMed]
  26. Ebrahimi, N.; Ozgoli, S.; Ramezani, A. Model-free high-order terminal sliding mode controller for Lipschitz nonlinear systems. Implemented on Exoped® exoskeleton robot. Int. J. Syst. Sci. 2021; 52, 1061–1073. [Google Scholar] [CrossRef]
  27. Abaunza, H.; Castillo, P. Quadrotor aggressive deployment, using a quaternion-based spherical chattering-free sliding-mode controller. IEEE T. Aero. Elec. Sys. 2019, 56(3), 1979–1991. [Google Scholar] [CrossRef]
  28. Mofid, O.; Mobayen, S.; Zhang, C.; Esakki, B. Desired tracking of delayed quadrotor UAV under model uncertainty and wind disturbance using adaptive super-twisting terminal sliding mode control. ISA Trans. 2022, 123, 455–471. [Google Scholar] [CrossRef]
  29. Ghadiri, H.; Emami, M.; Khodadadi, H. Adaptive super-twisting non-singular terminal sliding mode control for tracking of quadrotor with bounded disturbances. Aerosp. Sci. and Technol. 2021, 112, 106616. [Google Scholar] [CrossRef]
  30. Huang, S.; Yang, Y. Adaptive neural-network-based nonsingular fast terminal sliding mode control for a quadrotor with dynamic uncertainty. Drones 2022, 6(8), 206. [Google Scholar] [CrossRef]
  31. Mo, H.; Farid, G. Nonlinear and adaptive intelligent control techniques for quadrotor uav–a survey. Asian J. Control 2019, 21(2), 989–1008. [Google Scholar] [CrossRef]
Figure 1. the quadrotor configuration.
Figure 1. the quadrotor configuration.
Preprints 95758 g001
Figure 2. Control scheme for the quadrotor.
Figure 2. Control scheme for the quadrotor.
Preprints 95758 g002
Figure 5. 3D position trajectory tracking.
Figure 5. 3D position trajectory tracking.
Preprints 95758 g005
Figure 6. longitudinal translational motion tracking.
Figure 6. longitudinal translational motion tracking.
Preprints 95758 g006
Figure 7. lateral translational motion tracking.
Figure 7. lateral translational motion tracking.
Preprints 95758 g007
Figure 8. vertical translational motion tracking.
Figure 8. vertical translational motion tracking.
Preprints 95758 g008
Figure 9. roll angle tracking.
Figure 9. roll angle tracking.
Preprints 95758 g009
Figure 10. pitch angle tracking.
Figure 10. pitch angle tracking.
Preprints 95758 g010
Figure 11. yaw angle tracking.
Figure 11. yaw angle tracking.
Preprints 95758 g011
Figure 13. longitudinal translational motion tracking.
Figure 13. longitudinal translational motion tracking.
Preprints 95758 g013
Figure 14. lateral translational motion tracking.
Figure 14. lateral translational motion tracking.
Preprints 95758 g014
Figure 15. vertical translational motion tracking.
Figure 15. vertical translational motion tracking.
Preprints 95758 g015
Figure 16. roll angle tracking.
Figure 16. roll angle tracking.
Preprints 95758 g016
Figure 17. pitch angle tracking.
Figure 17. pitch angle tracking.
Preprints 95758 g017
Figure 18. yaw angle tracking.
Figure 18. yaw angle tracking.
Preprints 95758 g018
Table 1. Static Parameters of the quadrotor.
Table 1. Static Parameters of the quadrotor.
Parameter Value Meaning
m 0.56kg the mass of the quadrotor
g 9.8 m / s 2 gravitational acceleration
d 0.3m distance between the center of gravity and rotation axis of one motor
I x x 3.5 × 10 3   k g · m 2 moment of inertia about x-axis
I y y 3.5 × 10 3   k g · m 2 moment of inertia about x-axis
I z z 7.0 × 10 3   k g · m 2 moment of inertia about x-axis
k L 4.2 × 10−3 force coefficient during one motor rotation
k M 3.8 × 10−2 torque coefficient during one motor rotation
k F 5.6 × 10−4 drag coefficient due to air resistance
k T 5.6 × 10−4 drag torque coefficient due to air resistance
Table 2. Control system parameters
Table 2. Control system parameters
Parameter Value
k 7 , k 9 , k 11 0.01
ξ 7 , ξ 9 , ξ 11 4.25
α 8 , α 10 , α 12 2.5
δ ϕ 1 , δ θ 1 , δ ψ 1 28.5, 50, 28.5
δ ϕ 2 , δ θ 2 , δ ψ 2 6, 6, 12
ρ ϕ 1 , ρ θ 1 , ρ ψ 1 3
ρ ϕ 2 , ρ θ 2 , ρ ψ 2 2.5
σ ϕ , σ θ , σ ψ 1.7
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.
Copyright: This open access article is published under a Creative Commons CC BY 4.0 license, which permit the free download, distribution, and reuse, provided that the author and preprint are cited in any reuse.
Prerpints.org logo

Preprints.org is a free preprint server supported by MDPI in Basel, Switzerland.

Subscribe

© 2024 MDPI (Basel, Switzerland) unless otherwise stated