Preprint
Article

This version is not peer-reviewed.

Adaptive Sliding Mode Control for Trajectory Tracking of Quadrotor UAV under Input Saturation and Disturbances

A peer-reviewed article of this preprint also exists.

Submitted:

13 September 2024

Posted:

16 September 2024

You are already at the latest version

Abstract
The paper addresses the challenging issue of trajectory tracking for uncertain quadrotor UAVs, particularly under the constraints of input saturation and external disturbances. It introduces adaptive laws for managing uncertainties in mass and inertia moments without requiring prior knowledge, ensuring effective control even with varying system parameters. To counteract the effects of input saturation, the study incorporates an auxiliary system designed to compensate for these limitations. Additionally, a disturbance observer(DO) is utilized to manage and mitigate the impact of time-varying external disturbances. The proposed control strategy integrates a sliding mode adaptive control approach with an inner-outer loop structure, enhancing robustness and adaptability. Numerical simulations demonstrate the effectiveness of the designed control strategy.
Keywords: 
;  ;  ;  ;  

1. Introduction

In recent years, the UAVs has gained widespread applications in areas such as aerial photography [1], emergency communication [2], and agricultural irrigation [3]. Its popularity arises from its small size, affordability, and simple structure. Nevertheless, the demanding task scenarios faced by these quadrotor UAVs improved performance against internal and external disturbances. Moreover, as an underactuated and nonlinear coupled system, traditional control methods face challenges in achieving high-precision control amidst disturbances. Consequently, there is a critical emphasis on developing anti-disturbance methods in control theory and application.
In parallel, the sliding mode control method, known for its robust characteristics, insensitivity to disturbances, and rapid response, offers another avenue for achieving precise control in UAVs [4]. Recent studies, such as [5,6,7,8,9], have explored and demonstrated the effectiveness of sliding mode control algorithms in addressing trajectory tracking challenges and improving the overall robustness of quadrotor UAVs. This control method facilitates system movement along the designated sliding mode surface, with an adjustable convergence rate by selecting the sliding mode surface parameter matrix. Owing to the model’s lower precision, this control method has been user-friendly and widely applied in UAV control [10]. A novel fractional-order non-singular fast terminal sliding mode surface is proposed In [11], specifically designed for precise quadrotor trajectory tracking. Through simulations, the approach demonstrates its enhanced performance in suppressing external disturbances, significantly improving the quadrotor’s stability during flight. Additionally, the method ensures accurate trajectory following, even in the presence of uncertainties, making it an effective solution for high-precision applications. In [12], an iterative learning sliding mode control algorithm was developed, with experimental results confirming its effectiveness in achieving precise trajectory tracking while maintaining robustness against disturbances.
The disturbance observer technique, first introduced in 1987 [13], has proven to be an effective method for suppressing external disturbances in various control systems. Its design involves constructing a dynamic system that estimates unknown disturbances based on known system parameters and behavior. By accurately estimating these disturbances in real-time, the observer allows for the design of a robust compensation term that actively counteracts their effects. This proactive disturbance rejection mechanism greatly enhances the overall performance and stability of control systems, making the technique particularly valuable in environments with significant external disruptions. Due to its clear physical significance and simple design structure, combining disturbance observers with other control methods has become a crucial approach for addressing system uncertainty issues. A comprehensive method and fundamental framework for handling disturbance in nonlinear systems using a disturbance observer were introduced in [14], and the approach extends the traditional disturbance observer-based control strategy, which is typically applied to linear systems, to more complex nonlinear systems. In [15], a composite controller that integrates a disturbance observer with the backstepping method, specifically designed for nonlinear systems subjected to bounded disturbances was developed, enhancing overall system performance and disturbance rejection. An anti-disturbance control strategy was implemented in [16] for an indoor quadrotor UAV system, incorporating a disturbance observer to manage and counteract external disturbances, effectively mitigating the effects of modeling errors and external disturbances to improve system stability and accuracy.
In many cases, the output of an actuator cannot consistently increase due to its physical constraints, resulting in an input saturation problem. Prolonged influence of input saturation accelerates the damage to the actuator, necessitating consideration of this factor in controller design. Currently, there are three primary approaches to address the input saturation problem: The first approach involves using a small gain controller to reduce the amplitude of control inputs, effectively preventing the system from reaching saturation limits [17]. The second approach approximates the nonlinear behavior of input saturation with a smooth function, allowing for a more continuous and manageable control response [18]. Finally, a dynamic auxiliary system can be designed to compensate for saturation effects, actively adjusting the control signals to maintain performance even when inputs are constrained [19]. Based on the boundedness of the hyperbolic tangent function, a quasi-proportion-integral-derivative (PID) control strategy was proposed in [17], ensuring that the sum of the control gains is kept below the saturation upper limit to avoid input saturation. However, determining appropriate control gains remains a highly challenging task. An Nussbaum function was incorporated into the design process of the backstepping method [18], addressing input saturation and avoiding potential singularities during attitude stabilization. Nonetheless, the physical structure and design process of this controller are exceedingly complex. An anti-saturation scheme employing a dynamic auxiliary system that effectively mitigates the impact of input saturation within finite time, ensuring system convergence and stability, was designed in [19]. Moreover, the dynamic auxiliary system does not compromise controller performance when input saturation is absent.
During the flight of quadrotor UAVs, challenges arise not only from wind disturbances and mismatched disturbances but also from model uncertainties, posing a potential threat to overall system stability. Utilizing adaptive control laws offers a solution by approximating unknown upper bounds, enabling compensation for model parameter uncertainties within the controlled system. In [20], an adaptive sliding mode control method that integrated smooth and continuous integrators was explored. This method was specifically crafted for tracking control amid uncertainties and disturbances in aircraft. In [21], a control approach was implemented to enhance the resistance of quadrotor UAVs to wind disturbances. This study implements an adaptive fuzzy PID control system aimed at improving both the stability and tracking performance of the quadrotor UAV. In summary, the adaptive rate provides a promising avenue for UAVs to address model uncertainties.
Building upon the preceding discussions on control methodologies, the present study investigates the trajectory tracking challenges faced by a quadrotor UAV amid input saturation, external disturbances and parametric uncertainty. The key contributions of this article are as follows.
  • An adaptive sliding mode trajectory tracking controller is proposed for the uncertain QUAV, ensuring globally uniformly ultimate boundedness(UUB) despite disturbances, input saturation, and parameter uncertainties.
  • To address parameter uncertainties, adaptive laws are developed to estimate the quadrotor’s mass and unknown constants related to the moment of inertia. These adaptive laws are integrated into the control scheme, allowing the controller to compensate for external disturbances and input saturation without requiring prior knowledge of the quadrotor’s physical properties.
  • The method also incorporates disturbance observers and auxiliary systems, designed to function without prior knowledge of the quadrotor’s mass and moments of inertia. This enables the system to effectively handle unknown disturbances and input saturation, ensuring robust adaptive path tracking performance under uncertain conditions.
The paper is structured as follows: Section 2 lays the foundation by establishing the mathematical model for the quadrotor UAV, providing the necessary framework for control system design. Section 3 develops sliding mode control laws for both position and attitude loops, addressing key challenges such as input saturation, external disturbances, and parametric uncertainties, followed by a subsequent stability analysis. Section 4 presents the simulation results, demonstrating the practical performance of the proposed control strategies in overcoming these challenges, with conclusions drawn in the dedicated section 5.

2. Mathematical Model of Quadrotor

The position of the UAV is represented by the vector P = x y z T , while the attitude angles are expressed by the vector η = [ θ ϕ ψ ] T , where P denotes the spatial coordinates, and η represents the pitch, roll, and yaw angles, respectively. Considering the external disturbance, the nonlinear dynamic system of quadrotor can be expressed as follows [22]
x ¨ y ¨ z ¨ = 0 0 g + 1 m cos ϕ sin θ cos ψ + sin ϕ sin ψ cos ϕ sin θ sin ψ sin ϕ cos ψ cos ϕ cos θ U 1 + d x ( t ) d y ( t ) d z ( t ) ϕ ¨ θ ¨ ψ ¨ = θ ˙ ψ ˙ J y J z J x ϕ ˙ ψ ˙ J z J x J y ϕ ˙ θ ˙ J x J y J z + l U ϕ J x l U θ J y U ψ J z + d ϕ ( t ) d θ ( t ) d ψ ( t )
where m is the mass of the UAV, g is the gravitational acceleration, l is the distance of the quadrotor’s center of mass to any of the rotor’s rotation axis, J x , J y , and J z are airframe inertia of roll, pitch and yaw, respectively, d i ( t ) represents the external disturbances of each channel.
The definition of the virtual control input is provided herewith U δ = U 1 R e 3 = [ U x U y U z ] T for the purpose of facilitating the design of control rates. In practical scenarios, the rotor moment of a quadrotor UAV is subject to physical constraints during flight, limiting the extent to which control inputs can be applied. To accurately reflect these limitations, the following saturation function is used in the control strategy to ensure that the control inputs remain within the feasible range [23]
u ( t ) = s a t ( U i ( t ) ) = s a t ( U i ( t ) ) u i M , U i ( t ) u i M U i ( t ) , U i ( t ) < u i M
where U i is the ith control input of the system, u i M is the upper bound of the ith control input and i = x , y , z , ϕ , θ , ψ .
Define δ 1 = [ x y z ] T , δ 2 = [ x ˙ y ˙ z ˙ ] T . Then, the position subsystem of the quadrotor is written as the following affine nonlinear form
δ ˙ 1 = δ 2 δ ˙ 2 = f δ + g δ u δ + d δ y δ = δ 1
where u δ = s a t U x ( t ) s a t U y ( t ) s a t U z ( t ) T represent the saturation input to the position subsystem, d δ = [ d x ( t ) d y ( t ) d z ( t ) ] T represent the unknown external disturbances in position subsystem, f δ = 0 0 g T and g δ = 1 = 1 m m is the system state vector and the control gain, respectively.
Similarly, define ξ 1 = [ ϕ θ ψ ] T , ξ 2 = [ ϕ ˙ θ ˙ ψ ˙ ] T , the attitude subsystem of the quadrotor is written as
ξ ˙ 1 = ξ 2 ξ ˙ 2 = f ξ + g ξ u ξ + d ξ y ξ = ξ 1
where u ξ = s a t U ϕ ( t ) s a t U θ ( t ) s a t U ψ ( t ) T represent the saturation input to the attitude subsystem, d ξ = d ϕ ( t ) d θ ( t ) d ψ ( t ) T represent the unknown external disturbances in attitude subsystem. The system state vector is
f ξ = θ ˙ ψ ˙ a 1 ϕ ˙ ψ ˙ a 2 ϕ ˙ θ ˙ a 3 T
Control gain matrix is
g ξ = I ϕ 0 0 0 I θ 0 0 0 I ψ
And a 1 , a 2 , a 3 , I ϕ , I θ and I ψ are constants in (5) and (6), which are written as follows
a 1 = J y J z J x , I ϕ = l J x a 2 = J z J x J y , I θ = l J y a 3 = J x J y J z , I ψ = 1 J z
Due to the difficulty in accurately measuring the mass and inertia moments of a quadrotor UAV, g ^ δ is used in place of g δ and g ^ ξ is used in place of g ξ in the subsequent controller design stages. Meanwhile, the development of adaptive sliding mode tracking controllers for QUAV relies on the following specific lemmas and assumptions.
Lemma 1.
[24] Consider the following equation which describes an affine nonlinear system
x ˙ = f x + η 1 ( x ) u + η 2 ( x ) d y = ϖ ( x )
where x R n is the vector of state, d R l is the vector of disturbance, u R m and y R s are the system input and output, respectively. Disturbance observer is designed as
z ˙ = τ ( x ) η 2 ( x ) z τ ( x ) [ η 2 ( x ) p ( x ) + f ( x ) + η 1 ( x ) u ] d ^ = z + p ( x )
where z, u, d ^ and p ( x ) are auxiliary variable, control input, disturbance estimation, and nonlinear function, respectively. The gain τ ( x ) are calculated as
τ ( x ) = p ( x ) x
choosing p ( x ) to make it satisfied p ( x ) x g 2 ( x ) > 0 , then the disturbance estimation error , as defined below
d ˜ = d d ^
is guaranteed to converge globally exponentially.
Lemma 2.
The command filter is [25]
h ˙ 1 = g n h 2 h ˙ 2 = 2 ϖ g n h 2 g n h 1 α 1
The signal α 1 satisfies α ˙ 1 o 1 and α ¨ 1 o 2 , where o 1 , o 2 are positive constants and the initial conditions are set as h 1 ( 0 ) = α 1 ( 0 ) , h 2 ( 0 ) = 0 . Under these conditions, for any ε > 0 , there exist 0 ϖ 1 , g n > 0 , such that h 1 α 1 κ , along with the first and second derivatives h ˙ 1 a n d h ¨ 1 are bounded.
Assumption 1.
[26] Assuming that the external disturbance d δ and d ξ are slow time-varying signals. They are bounded by positive constant D δ and D ξ , respectively, that is d δ D δ , d ξ D ξ for t 0 , and d ˙ δ 0 , d ˙ ξ 0 .
Assumption 2.
[27] The reference signals x d , y d , z d and ψ d , along with their derivatives, are continuous and bounded.

3. Control Design

The quadrotor UAVs are inherently characterized by their high nonlinearity and underactuation. Therefore, it is impossible for quadrotor UAVs to simultaneously track all six degrees of freedom. Accordingly, the primary control objective for the UAV is to accurately track a specified trajectory P = x y z T and yaw angle ψ , while ensuring the stability of the other two angles.

3.1. Position Subsystem Adaptive Control

For position subsystem described by (4), Its tracking target is designed as x x d , y y d , z z d . Assuming that the desired signal are δ d = x d y d z d T , δ ˙ d = x ˙ d y ˙ d z ˙ d T . To overcome the adverse effects of external disturbance, it is first necessary to design a DO to compensate for it. A generalized form of DO is designed according to Lemma 1, which requires the calculations for p ( x ) . Choose
p δ = λ δ δ 2
where
λ δ = λ x 0 0 0 λ y 0 0 0 λ z
is the designed parameter and satisfies λ i > 0 ( i = x , y , z ) . Then, invoking (4) and (13) in Equation (9), the DO is written as
z ˙ δ = λ δ ( z δ + p δ + f δ + g ^ δ u δ ) d ^ δ = z δ + p δ
Combining Assumption 1 with Equation (11), the derivative of the disturbance estimation error is derived as
d ˜ ˙ δ = d ˙ δ d ^ ˙ δ = z ˙ δ p δ δ 2 δ ˙ 2 = λ δ ( z δ + p δ + f δ + g ^ δ u δ ) λ δ ( f δ + g δ u δ + d δ ) = λ δ ( d ^ δ d δ + ( g ^ δ g δ ) u δ ) = λ δ ( d ˜ δ + g ˜ δ u δ )
To address the issue of input saturation in the uncertain UAV position subsystem (3), the detrimental effects of input saturation are tackled by constructing the following auxiliary systems [28]
β ˙ 1 = h 1 β 1 + β 2 β ˙ 2 = h 2 β 2 β 1 + g ^ δ Δ u δ
where β j R 3 ( j = 1 , 2 ) is the state, h j R 3 × 3 is the designed positive definite matrix and Δ u δ = u δ U δ . In the real world, actuators have finite energy, making it necessary to ensure that Δ u δ is constrained by Δ u δ ν , where ν is a positive parameter. This finite energy constraint ensures that the control inputs remain within feasible limits, allowing the system to remain controllable while protecting the actuators from excessive load.
A sliding mode surface is proposed as
σ δ = c δ e δ + e ˙ δ
where e δ = δ 1 δ d β 1 and
c δ = c x 0 0 0 c y 0 0 0 c z
The designed parameter matrix c δ satisfies condition c δ T = c δ > 0 . The aim is to get the error e δ as close to zero as possible. Taking the derivative of Equation (19)
σ ˙ δ = c δ e ˙ δ + e ¨ δ = c δ e ˙ δ + δ ¨ 1 δ ¨ d ( β ˙ 2 h 1 β ˙ 1 ) = c δ e ˙ δ + f δ + g δ u δ + d δ δ ¨ d ( g ^ δ Δ u δ h 2 β 2 β 1 h 1 ( h 1 β 1 + β 2 ) ) = c δ e ˙ δ + f δ + g ^ δ u δ + g ˜ δ u δ + d δ δ ¨ d g ^ δ Δ u δ + h 2 β 2 + β 1 + h 1 ( h 1 β 1 + β 2 ) = c δ e ˙ δ + f δ + g ^ δ U δ + d δ δ ¨ d + h 2 β 2 + β 1 + h 1 ( h 1 β 1 + β 2 ) + g ˜ δ u δ
According to (20), the virtual controller is designed as
U δ = 1 g ^ δ ( c δ e ˙ δ + f δ + δ ¨ d α δ σ δ d ^ δ h 2 β 2 β 1 h 1 ( h 1 β 1 + β 2 ) )
where α δ = α x 0 0 0 α y 0 0 0 α z is the parameter matrix to be designed, g ^ δ and d ^ δ represents the estimate of the inverse of the mass and the output of the DO, respectively. The estimation error of the mass inverse is
g ˜ δ = g δ g ^ δ
The adaptive law is designed as [29]
g ^ ˙ δ = Pro j [ g δ min , g δ max ] γ 1 ( σ δ T u δ β 2 Δ u δ o 1 g ^ δ )
where γ 1 > 0 and o 1 > 0 are the constant to be designed. The estimate g ^ δ is projected to the interval [ g δ min , g δ max ] using the projection operator, which is expressed as
Pro j [ g δ min , g δ max ] γ 1 ( a ) = γ 1 a , if g ^ δ = g δ max and a < 0 0 , if g ^ δ = g δ max and a 0 γ 1 a , if g δ min g ^ δ g δ max 0 , if g ^ δ = g δ min and a 0 γ 1 a , if g ^ δ = g δ min and a > 0
Redefine a variable Θ δ that includes the estimation error d ˜ δ and g ˜ δ as follows
Θ δ = d ˜ δ g ˜ δ
And the derivative of (25) can be obtained from (11) and (22) as
Θ ˙ δ = d ˜ ˙ δ g ^ ˙ δ
Consider the Lyapunov function candidate
V δ ( σ δ , β 1 , β 2 , Θ δ ) = 1 2 σ δ T σ δ + 1 2 β 1 T β 1 + 1 2 β 2 T β 2 + Θ δ T 1 2 0 0 1 2 γ 1 Θ δ
Invoking (4), (17), (18), (21), (22) and (24), the time derivative of V δ is
V ˙ δ = σ δ T σ ˙ δ + β 1 T β ˙ 1 + β 2 T β ˙ 2 + Θ δ T 1 0 0 1 γ 1 Θ ˙ δ = σ δ T α δ σ δ + σ δ T d ˜ δ + σ δ T g ˜ δ u δ β 1 T h 1 β 1 β 2 T h 2 β 2 + β 2 T g ^ δ Δ u δ d ˜ δ T λ δ d ˜ δ d ˜ δ T λ δ u δ g ˜ δ 1 γ 1 g ˜ δ g ^ ˙ δ = σ δ T α δ σ δ d ˜ δ T λ δ d ˜ δ β 1 T h 1 β 1 β 2 T h 2 β 2 + σ δ T d ˜ δ + β 2 T g δ Δ u δ d ˜ δ T λ δ u δ g ˜ δ + g ˜ δ ( σ δ T u δ β 2 T Δ u δ g ^ ˙ δ γ 1 ) σ δ T ( α δ 1 2 I 3 × 3 ) σ δ β 1 T h 1 β 1 β 2 T ( h 2 1 2 I 3 × 3 ) β 2 Θ δ T λ δ 1 2 I 3 × 3 λ δ u δ 0 o 1 2 Θ δ + g δ 2 ν 2 4 + o 1 2 g δ 2 κ 1 V δ + C 1
where
κ 1 = min λ min α δ 1 2 I 3 × 3 , λ min h 1 , λ min h 2 1 2 I 3 × 3 , λ min λ δ 1 2 I 3 × 3 , o 1 2 C 1 = ν 2 4 m 2 + o 1 2 m 2
To ensure system stability, it is essential to ensure that the appropriate design matrices and parameters α δ 1 2 I 3 × 3 > 0 , h 1 > 0 , h 2 1 2 I 3 × 3 > 0 , λ δ 1 2 I 3 × 3 > 0 , o 1 > 0 .
In conclusion, the signals σ δ , the estimate errors d ˜ δ , g ˜ δ , the variables of the auxiliary system states β 1 , β 2 are all bounded, the drone’s position is able to keep up with the desired signals.

3.2. Attitude Subsystem Adaptive Control

To achieve the desired tracking targets, namely θ θ d , ψ ψ d , ϕ ϕ d , the actual lift U 1 and attitude subsystem intermediate command signals ϕ d and ψ d must first be calculated. The inverse solution according to (2) yields written as follows [27]
θ d = arctan U x cos ψ d + U y sin ψ d U z ϕ d = arctan cos θ d U x sin ψ d U y cos ψ d U z U 1 = U z cos ϕ d cos θ d
Defining that the desired signal are ξ d = [ ϕ d θ d ψ d ] T , ξ ˙ d = [ ϕ ˙ d θ ˙ d ψ ˙ d ] T . where the derivative of ξ d can be obtain from Lemma 2. According to Lemma 1, we have
p ξ = λ ξ ξ 2
where
λ ξ = λ ϕ 0 0 0 λ θ 0 0 0 λ ψ
is the designed parameter matrix and satisfies λ i > 0 ( i = ϕ , θ , ψ ) . Invoking (5) and (30) in (10), the DO is written as
z ˙ ξ = λ ξ ( z ξ + p ξ + f ξ + g ^ ξ u ξ ) d ^ ξ = z ξ + p ξ
where
g ^ ξ = I ^ ϕ 0 0 0 I ^ θ 0 0 0 I ^ ψ
Similarly, the attitude subsystem is susceptible to input saturation, which can be addressed by constructing a system in the same form as the auxiliary system described above. This approach can effectively compensate for the effects of input saturation.[28]
β ˙ 3 = h 3 β 3 + β 4 β ˙ 4 = h 4 β 4 β 3 + g ^ ξ Δ u ξ
where β j = [ β j ϕ β j θ β j ψ ] T ( j = 3 , 4 ) is the state, h j = h j ϕ 0 0 0 h j θ 0 0 0 h j ψ ( j = 3 , 4 ) is the designed positive definite matrix and Δ u ξ = u ξ U ξ . The sliding mode surface is also defined in the form of (19)
σ ξ = c ξ e ξ + e ˙ ξ
where e ξ = ξ ξ d β 3 and
c ξ = c ϕ 0 0 0 c θ 0 0 0 c ψ
The designed parameter matrix c ξ satisfies condition c ξ T = c ξ > 0 . The controller of the attitude subsystem is proposed as
U ξ = 1 g ^ ξ ( c ξ e ˙ ξ f ξ + ξ ¨ d α ξ σ ξ d ^ ξ h 4 β 4 β 3 h 3 ( h 3 β 3 + β 4 ) )
where α ξ = α ϕ 0 0 0 α θ 0 0 0 α ψ is the parameter matrix to be designed, g ^ ξ and d ^ ξ represents the estimate of the inverse of the inertia matrix and the output of the DO, respectively. In this control rate, the derivatives of the two intermediate control signals ϕ d and ψ d generated by the outer loop can be derived from Lemma 2. The estimation error of the inverse of the inertia are defined as follows
I ˜ i = I i I ^ i , i = ϕ , θ , ψ
The adaptive law is designed as [29]
I ^ ˙ i = Pro j [ I ^ i min , I ^ i max ] γ i ( σ i u i β 4 i Δ u i o i I ^ i )
where γ i and o i are designed positive constants. The estimate I ^ i is projected to the interval [ I i min , I i max ] using the projection operator, which is expressed as
Pro j [ I i min , I i max ] γ i ( a ) = γ i a , if I ^ i = I i max and a < 0 0 , if I ^ i = I i max and a 0 γ i a , if I i min I ^ i I i max 0 , if I ^ i = I i min and a 0 γ i a , if I ^ i = I i min and a > 0
Redefine Θ i that includes the estimation error d ˜ i and I ˜ i as follows
Θ i = d ˜ i I ˜ i , i = ϕ , θ , ψ
For the whole attitude subsystem, taking the following Lyapunov function
V ξ ( σ ξ , β 3 , β 4 , Θ i ) = i = ϕ , θ , ψ ( 1 2 σ i 2 + 1 2 β 3 i 2 + 1 2 β 4 i 2 + Θ i T 1 2 0 0 1 2 γ i Θ i )
Then
V ˙ ξ = i = ϕ , θ , ψ ( α i σ i 2 + σ i d ˜ i + σ i I ˜ i u i h 3 i β 3 i 2 h 4 i β 4 i 2 + β 4 i I ^ i Δ u i λ i d ˜ i 2 d ˜ i λ i u i I ˜ i 1 γ i I ˜ i I ^ ˙ i ) = i = ϕ , θ , ψ ( α i σ i 2 λ i d ˜ i 2 h 3 i β 3 i 2 h 4 i β 4 i 2 + σ i d ˜ i + β 4 i I i Δ u i d ˜ i λ i u i I ˜ i + I ˜ i ( σ i u i β 4 i Δ u i 1 γ i I ^ ˙ i ) ) i = ϕ , θ , ψ ( ( α i 1 2 ) σ i 2 h 3 i β 3 i 2 ( h 4 i 1 2 ) β 4 i 2 Θ i T λ i 1 2 λ i u i 0 o i 2 Θ i + ν i 2 4 I i 2 + o i 2 I i 2 ) κ 2 V ξ + C 2
where
κ 2 = min i = ϕ , θ , ψ α i 1 2 , h 3 i , h 4 i 1 2 , λ i 1 2 , o i 2 C 2 = i = ϕ , θ , ψ ( ν i 2 4 I i 2 + o i 2 I i 2 )
Thus, the signal e ξ , d ˜ ξ and g ˜ ξ are all bounded. To conduct comprehensive stability analysis of the quadrotor, a stability function is defined as
V = V δ + V ξ
Taking derivative of (46), we can obtain
V ˙ = V ˙ δ + V ˙ ξ κ V + C
where
κ = min ( κ 1 , κ 2 ) C = C 1 + C 2
Accordingly, the UAV is able to perform trajectory tracking tasks and achieve control objectives.

4. Simulation Study

Numerical simulations were performed to validate the proposed control strategy, employing a quadrotor UAV model that was subjected to both input saturation and two distinct types of external disturbances. These simulations provided a rigorous test of the control strategy’s performance under challenging conditions. The UAV and controller parameters used in the simulations are comprehensively detailed in Table 1 and Table 2, respectively. The parameters presented in the table are all expressed in International System of Units.

A. Robustness to Constant Disturbances

The reference trajectory signals are expected trajectory P d and expected yaw Angle ψ d are
P d = 0.5 cos ( 0.5 t ) 0.5 sin ( 0.5 t ) 2 + 0.1 t ψ d = π 4
The initial position and attitude states of the quadrotor are assumed to be δ ( 0 ) = [ 0 0 0 ] T , ξ ( 0 ) = [ 0 0 0 ] T . The external disturbances conforming to the hypothesis are: d x = 1 at t = 1 s ; d y = 1 at t = 3 s ; d z = 8 at t = 5 s ; d ϕ = 20 at t = 1 s ; d θ = 20 at t = 3 s ;, d ψ = 30 N at t = 5 s . The thrust U 1 and the torque U ξ of the UAV are limited in 0 , 30 and 10 , 2 , respectively.
Figure 1 presents a three-dimensional plot showing the expected trajectory tracking of the quadrotor UAV in accordance with the methodology proposed in this paper. Figure 2 and Figure 3 depict the position and attitude tracking processes of the UAV, highlighting the controller’s ability to maintain performance even in the presence of disturbances. It can be observed that when the disturbances are small, the tracking performance is not significantly affected. However, under larger disturbances, the UAV’s z and ψ channels deviate noticeably from the desired trajectory but quickly realign. Overall, the designed controller effectively counters external disturbances and achieves the intended tracking objectives, ensuring stable and accurate performance under varying conditions.
Figure 4 presents the input torques of the UAV, while Figure 5 illustrates the outputs of the disturbance observers across the six channels. The disturbance observer is shown to accurately capture the magnitude of the disturbances affecting the system. These observations confirm the effectiveness of the disturbance observer in mitigating the adverse impacts of external disturbances on the quadrotor UAV. As a result, the disturbance observer enhances the UAV’s overall performance and stability, ensuring more reliable and robust operation under challenging conditions. All the results show that the UAV is able to overcome the effects of constant value disturbances and perform the trajectory tracking task with limited inputs.

B. Robustness to Time-Varying Disturbances

In most cases, the external disturbances are variable. Therefore, a second experimental test with the following objectives is designed
P d = R π π 20 20 1.2 cos ( 0.6 t ) sin ( 0.6 t ) 1.2 sin ( 0.6 t ) 1.2 ψ d = π 4
where
R π π 20 20 = 1 0 0 0 sin ( π π 20 20 ) cos ( π π 20 20 ) 0 cos ( π π 20 20 ) sin ( π π 20 20 )
And
d δ = 1 + 0.1 sin ( 0.1 π t ) 1 + 0.1 cos ( 0.1 π t ) 3 + 0.1 cos ( 0.1 π t ) T d ξ = 0.1 sin ( 0.1 π t ) 0.1 cos ( 0.1 π t ) 0.1 sin ( 0.1 π t )
The initial position and input limits of the UAV in this experiment are consistent with those used in previous tests. The experimental outcomes, illustrated in Figure 6, Figure 7 and Figure 8, highlight the UAV’s ability to maintain accurate trajectory tracking even in the presence of time-varying disturbances. Despite these dynamic disturbances, the UAV successfully maintains accurate tracking of the target path. The conclusions drawn from this experiment confirm the robustness and stability of the UAV’s control strategy, demonstrating its effectiveness in managing external disturbances while ensuring precise and reliable trajectory tracking.
The output of the drone torque is also well limited to the preset range as seen in Figure 9. Additionally, Figure 10 highlights the capability of the disturbance observer to accurately estimate both the amplitude and frequency of time-varying disturbances, despite their dynamic nature. These findings confirm that the control system successfully maintains the drone’s torque within specified limits and that the disturbance observer provides precise estimations of dynamic disturbances. As a result, the overall robustness and performance of the UAV are significantly enhanced, demonstrating the effectiveness ofthe integrated control and estimation strategies.
The combination of the two aforementioned cases leads to the conclusion that, in the absence of knowledge regarding the mass and moment of inertia of the UAV, and in the presence of input saturation, the force and torque required by the UAV remain within a reasonable range, irrespective of whether the disturbance in question is constant or time-varying. Furthermore, the DO is capable of accurately estimating the magnitude of external disturbances and compensating for them in a manner that is relayed to the controller. This ultimately renders the UAV both robust and capable of excelling in the completion of trajectory tracking tasks.

5. Conclusions

The paper presents a tracking control method for quadrotor UAVs that effectively handles parametric uncertainties, external disturbances, and input saturation, without requiring prior knowledge of the UAV’s mass or moments of inertia. This adaptability allows the control system to perform well under various conditions. Simulations validate the effectiveness of the proposed approach and demonstrate its robustness to various disturbances and uncertainties. Furthermore, the method offers significant advantages over existing control techniques by addressing multiple factors simultaneously, providing a more comprehensive solution for ensuring reliable and accurate trajectory tracking in real-world applications.

Author Contributions

Conceptualization, J.K. and M.C.; methodology, J.K.; software, J.K.; validation, J.K. and M.C.; writing—original draft preparation, J.K.; writing—review and editing, M.C.; supervision, M.C. 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 are contained within the article.

Conflicts of Interest

The authors declare no conflicts of interest.

References

  1. Kendoul, F.; Yu, Z.; Nonami, K. "Guidance and nonlinear control system for autonomous flight of minirotorcraft unmanned aerial vehicles". Journal of Field Robotics 2010, 27, 311–334. [CrossRef]
  2. Nagaty, A.; Saeedi, S.; Thibault, C.; Seto, M.; Li, H. "Control and navigation framework for quadrotor helicopters". Journal of intelligent & robotic systems 2013, 70, 1–12. [CrossRef]
  3. Gupte, S.; Mohandas, P.I.T.; Conrad, J.M. "A survey of quadrotor unmanned aerial vehicles". 2012 Proceedings of IEEE Southeastcon 2012, pp. 1–6. [CrossRef]
  4. Antonio-Toledo, M.E.; Sanchez, E.N.; Alanis, A.Y.; Flórez, J.; Perez-Cisneros, M.A. "Real-time integral backstepping with sliding mode control for a quadrotor UAV". IFAC-PapersOnLine 2018, 51, 549–554. [CrossRef]
  5. Jia, Z.; Yu, J.; Mei, Y.; Chen, Y.; Shen, Y.; Ai, X. "Integral backstepping sliding mode control for quadrotor helicopter under external uncertain disturbances". Aerospace Science and Technology 2017, 68, 299–307. [CrossRef]
  6. Zhou, L.; Zhang, J.; Dou, J.; Wen, B. "A fuzzy adaptive backstepping control based on mass observer for trajectory tracking of a quadrotor UAV". International journal of adaptive control and signal processing 2018, 32, 1675–1693. [CrossRef]
  7. Labbadi, M.; Cherkaoui, M. "Robust adaptive backstepping fast terminal sliding mode controller for uncertain quadrotor UAV". Aerospace Science and Technology 2019, 93, 105306. [CrossRef]
  8. Zhang, J.; Ren, Z.; Deng, C.; Wen, B. "Adaptive fuzzy global sliding mode control for trajectory tracking of quadrotor UAVs". Nonlinear Dynamics 2019, 97, 609–627. [CrossRef]
  9. Razmi, H.; Afshinfar, S. "Neural network-based adaptive sliding mode control design for position and attitude control of a quadrotor UAV". Aerospace Science and technology 2019, 91, 12–27. [CrossRef]
  10. Xiong, J.J.; Zheng, E.H. "Position and attitude tracking control for a quadrotor UAV". ISA transactions 2014, 53, 725–731. [CrossRef]
  11. Labbadi, M.; Cherkaoui, M. "Adaptive fractional-order nonsingular fast terminal sliding mode based robust tracking control of quadrotor UAV with Gaussian random disturbances and uncertainties". IEEE Transactions on Aerospace and Electronic Systems 2021, 57, 2265–2277. [CrossRef]
  12. Nguyen, L.V.; Phung, M.D.; Ha, Q.P. "Iterative learning sliding mode control for UAV trajectory tracking. Electronics 2021, 10, 2474. [CrossRef]
  13. Ohnishi, K. "A new servo method in mechatronics". Trans. of Japanese Society of Electrical Engineering, D 1987, 177, 83–86.
  14. Chen, W.H. "Disturbance observer based control for nonlinear systems". IEEE/ASME transactions on mechatronics 2004, 9, 706–710. [CrossRef]
  15. Zhang, H.; Wei, X.; Karimi, H.R.; Han, J. "Anti-disturbance control based on disturbance observer for nonlinear systems with bounded disturbances". Journal of the Franklin Institute 2018, 355, 4916–4930. [CrossRef]
  16. Wang, H.; Chen, M. "Trajectory tracking control for an indoor quadrotor UAV based on the disturbance observer". Transactions of the Institute of Measurement and Control 2016, 38, 675–692. [CrossRef]
  17. Sun, N.; Yang, T.; Fang, Y.; Wu, Y.; Chen, H. "Transportation control of double-pendulum cranes with a nonlinear quasi-PID scheme: Design and experiments". IEEE Transactions on Systems, Man, and Cybernetics: Systems 2018, 49, 1408–1418. [CrossRef]
  18. Wang, R.; Liu, J. "Trajectory tracking control of a 6-DOF quadrotor UAV with input saturation via backstepping". Journal of the Franklin Institute 2018, 355, 3288–3309. [CrossRef]
  19. Liu, K.; Wang, X.; Wang, R.; Sun, G.; Wang, X. "Antisaturation finite-time attitude tracking control based observer for a quadrotor". IEEE Transactions on Circuits and Systems II: Express Briefs 2020, 68, 2047–2051. [CrossRef]
  20. Castañeda, H.; Rodriguez, J.; Gordillo, J.L. "Continuous and smooth differentiator based on adaptive sliding mode control for a quad-rotor MAV". Asian Journal of Control 2021, 23, 661–672. [CrossRef]
  21. Simoud, L.; Kadri, B.; Bousserhane, I.K. "Adaptive fuzzy-sliding mode controller for trajectory tracking control of quad-rotor". Journal of Automation Mobile Robotics and Intelligent Systems 2020, 14, 15–24. [CrossRef]
  22. Guo, Y.; Wu, M.; Tang, K.; Wang, X. "Integral back-stepping algorithm for designing the quadrotor aircraft controller". Chin. J. Intell. Sci. Technol 2019, 1, 133–139.
  23. Li, Y.; Tong, S.; Li, T. "Adaptive fuzzy output-feedback control for output constrained nonlinear systems in the presence of input saturation". Fuzzy Sets and Systems 2014, 248, 138–155. [CrossRef]
  24. Li, S.; Yang, J.; Chen, W.H.; Chen, X. "Disturbance observer-based control: methods and applications"; CRC press, 2014.
  25. Yu, J.; Shi, P.; Dong, W.; Yu, H. "Observer and command-filter-based adaptive fuzzy output feedback control of uncertain nonlinear systems". IEEE Transactions on Industrial Electronics 2015, 62, 5962–5970. [CrossRef]
  26. Pu, M.; Wu, Q.; Jiang, C.; Cheng, L. Application of adaptive second-order dynamic terminal sliding mode control to near space vehicle. Journal of Aerospace Power 2010, 25, 1169–1176.
  27. Zhang, R.; Ji, H. Robust Adaptive Trajectory Tracking Control for Uncertain Quadrotor Unmanned Aerial Vechicles in the Presence of Actuator Saturation. In Proceedings of the 2020 5th International Conference on Control and Robotics Engineering (ICCRE). IEEE, 2020, pp. 104–108. [CrossRef]
  28. Yang, Q.; Chen, M. "Adaptive neural prescribed performance tracking control for near space vehicles with input nonlinearity". Neurocomputing 2016, 174, 780–789. [CrossRef]
  29. Boskovic, J.D.; Chen, L.; Mehra, R.K. "Adaptive control design for nonaffine models arising in flight control". Journal of guidance, control, and dynamics 2004, 27, 209–217. [CrossRef]
Figure 1. 3D trajectory tracking effect
Figure 1. 3D trajectory tracking effect
Preprints 118136 g001
Figure 2. position tracking
Figure 2. position tracking
Preprints 118136 g002
Figure 3. attitude angle tracking
Figure 3. attitude angle tracking
Preprints 118136 g003
Figure 4. control input
Figure 4. control input
Preprints 118136 g004
Figure 5. output of disturbance observer
Figure 5. output of disturbance observer
Preprints 118136 g005
Figure 6. 3D trajectory tracking effect
Figure 6. 3D trajectory tracking effect
Preprints 118136 g006
Figure 7. position tracking
Figure 7. position tracking
Preprints 118136 g007
Figure 8. attitude angle tracking
Figure 8. attitude angle tracking
Preprints 118136 g008
Figure 9. control input
Figure 9. control input
Preprints 118136 g009
Figure 10. output of disturbance observer
Figure 10. output of disturbance observer
Preprints 118136 g010
Table 1. UAV parameters.
Table 1. UAV parameters.
parameter Symbol Magnitude
Mass m 2
Airframe inertia of roll Jx 0.02
Airframe inertia of pitch Jy 0.02
Airframe inertia of yaw Jz 0.04
Distance l 0.2
Gravity g 9.8
Table 2. SMC and DO parameters.
Table 2. SMC and DO parameters.
parameter Magnitude
λ δ diag([2 2 2])
α δ diag([20 20 20])
c δ diag([2 2 2])
h 1 diag([10 10 10])
h 2 diag([15 15 15])
γ i ( i = 1 , ϕ , θ , ψ ) [0.2 0.2 0.2 0.2]
o i ( i = 1 , ϕ , θ , ψ ) [0.5 0.5 0.5 0.5]
λ ξ diag([18 18 18])
α ξ diag([30 30 30])
c ξ diag([5 5 5])
h 3 diag([10 10 10])
h 4 diag([15 15 15])
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

Disclaimer

Terms of Use

Privacy Policy

Privacy Settings

© 2025 MDPI (Basel, Switzerland) unless otherwise stated