Abstract

A novel asymptotic tracking controller for an underactuated quadrotor unmanned aerial vehicle (UAV) is proposed to solve a moving target tracking problem. Firstly, the control system is decoupled into the position control system and the attitude control system. Secondly, a method combined artificial potential field with passivity control (APF&PC) is introduced for the positioning system to achieve high-precision tracking of moving target at a fixed distance. Thirdly, a super-twisting sliding mode (STSM) method with an improved reaching law for the attitude system is applied to ensure that the attitude converges to the desired value. Furthermore, the stabilities of two subsystems are proved, and sufficient stability conditions are derived based on the passive method and Lyapunov method, respectively. Finally, simulation results of the moving target tracking verify the superiority and robustness of the proposed control method in the presence of parameter uncertainties and external disturbances.

1. Introduction

In recent years, quadrotor unmanned aerial vehicles have attracted increasing attention from both industrial and academic communities. With some characteristics of vertical take-off and landing, single or team flight, and low-cost manufacturing, they have wide applications such as military monitoring, traffic information collection, power system detection, and disaster first aid [14]. The quadrotor UAV is an underactuated and strongly coupled nonlinear system, which is subject to structural uncertainties and unknown external disturbance. Therefore, it is a great challenge to design an accurate and robust controller for the quadrotor to achieve autonomous flight and target tracking.

Moving target tracking is an essential skill for the quadrotor UAV to perform military and civil tasks, like tracking enemy targets in air combat, tracking vehicles in urban antiterrorism, and timely finding and locking the victims in maritime rescue [5, 6]. Due to the limitation of the observation range and the danger of unfriendly targets, the quadrotor UAV needs to maintain a certain distance in the whole mission, which brings new challenges to target tracking. Currently, many kinds of control methods have been successfully applied in the target tracking of UAVs. Wang et al. [7] proposed an integrated framework for UAV-based target tracking and recognition systems to achieve satisfactory tracking performance. Rabah et al. [8] developed a target tracking algorithm based on a Fuzzy-PI controller to track a moving target under varying speed. Araar et al. [9] proposed a PID method with an EKF filter to track autonomously and land on a moving platform. Chen et al. [10] presented sliding mode control methods based on artificial potential field and RBF neural network for a quadrotor to track the moving target. Based on studies aforesaid, the design of a controller with high precision and strong robustness is the precondition of accurate tracking. Thus, it is the key for the moving target tracking of a quadrotor to realize the position and attitude tracking control of the quadrotor system and improve the robustness of the system.

In order to achieve attitude stabilization and position tracking control of the quadrotor, various advanced control techniques have been developed. Many remarkable achievements have been obtained such as robust PID control [11], active disturbance rejection method [12], feedback linearization control [13], backstepping control [14], model predictive control [15], adaptive control [16], immersion and invariance control [17], reinforcement learning [18], and composite stability control [19, 20]. Although the above methods can accomplish the autonomous flight of UAVs, some of them still have limited capability to handle uncertainties and external disturbances. Sliding mode control (SMC) is considered an effective method in solving the control problems of uncertain nonlinear systems because of its unique robustness and adaptability to uncertainty and external disturbances [2123]. Therefore, a wide class of control methods based on SMC has been proposed to solve trajectory tracking of the quadrotor. Chen et al. [24] designed a robust nonlinear controller that combines sliding mode control and backstepping control to achieve trajectory tracking of a quadrotor UAV. Xu et al. [25] presented a quadrotor controller based on the terminal sliding mode control to track the attitude trajectory under input saturation. Castañeda et al. [26] proposed an adaptive second-order sliding mode control method to improve the robustness of the system under different operating conditions and external disturbances. Inspired by the aforementioned papers, we can improve sliding mode control to handle the attitude control problem of quadrotors under uncertainties and external disturbances.

There are some main feasible control methods to realize the position tracking of UAVs. The artificial potential field (APF) is a robust feedback control method based on the virtual force field, which has been widely applied in obstacle avoidance and target tracking [27]. Chen et al. [28] proposed an artificial potential field UAV path planning method to make UAV avoid obstacles efficiently and economically when there are many threats. Hu et al. [29] designed a time-varying sliding surface and a nonlinear adaptive feedback control law based on the APF method for obstacle avoidance control. The passive control (PC) method is to redistribute the energy function of the inverted system by injecting damping into the system so that it conforms to Lyapunov stability law and ensures that the system is asymptotically stable [30]. Ha et al. [31] proposed a unified passivity-based adaptive backstepping control framework for the velocity field following and timed trajectory tracking of a quadrotor on the Internet. Jose and Hugo [32] presented a passivity-based controller for a quadrotor with a cable-suspended load to guarantee asymptotic stability. Based on the aforementioned discussion, we propose a novel double-loop control system based on the position controller and attitude controller, which can achieve high-precision target tracking for the quadrotor. The position controller combines the artificial potential field with passive theory to achieve high-precision position tracking, and the attitude controller uses the super-twisting sliding mode method with an improved reaching law to improve the convergence speed of the attitude.

The main contributions of this study are as follows: firstly, a novel position controller based on artificial potential field and passive control is proposed to improve the precision of fixed distance tracking. The quadrotor can track the moving target at a certain distance by tracking the balance point of the artificial potential field. The passive control can improve the robustness of the system by providing disturbance rejection to uncertainties and disturbances. Besides, a super-twisting sliding mode controller with an improved reaching law is presented for attitude control to ensure fast convergence and strong robustness. The reaching law based on proportional term and exponential term can reduce the chattering and improve the convergence rate, which will guarantee a better tracking performance.

The rest of this paper is organized as follows. In Section 2, the structure of the target tracking system and the dynamic modeling of the quadrotor are presented. In Section 3, a novel quadrotor control method for moving target tracking is studied and its stability is analyzed. In Section 4, numerical simulations are provided to show the feasibility and effectiveness of the proposed approach. Finally, a brief conclusion is drawn in Section 5.

2. Mathematical Model of the Quadrotor

Target tracking is a complex engineering system that involves technical modules in hardware, localization, mapping, planning, and control. The target tracking of UAV is to locate the target according to the distance information of relative observation angle and attitude information of UAV. Then, the future motion state of the target is predicted according to the observation data of sensors. In addition, the target state is filtered and estimated, and motion information of UAV is collected. On the premise that the attitude angle and angular velocity of the quadrotor can be measured, the three-dimensional position and translation velocity of the UAV relative to the moving target are available. Finally, the UAV will be guided to keep track of the moving target through the continuous update of target estimation and prediction state. For the target tracking of the quadrotor, the most critical issues are the control of trajectory tracking. We assume that the relative position of the quadrotor can be obtained from the visual information of the camera, and the state of the tracking target can be estimated by the Kalman filtering method. In this paper, we will focus on the trajectory tracking of the quadrotor control system. By designing the position controller and attitude controller of quadrotor UAV, the moving target can be tracked within a safe distance. The simplified structure of the tracking system is shown in Figure 1.

The dynamical model of the quadrotor is set up by the earth-frame I(Oxyz) and the body-frame B(Oxyz) as illustrated in Figure 2. It is assumed that the moving target is a mobile car, and ρ is the relative distance between the quadrotor and target. In quadrotor systems, fi (i = 1, 2, 3, 4) stands for the thrust force produced by the ith propeller. The vertical motion is created by the collective thrust input of all four propellers. The roll, pitch, and yaw motion can be achieved by changing the speeds of different propellers. The position and attitude of the quadrotor expressed in the inertial frame are defined as P = [x, y, z]T and Θ = [ϕ, θ, ψ]T, where ϕ, θ, and ψ are successively roll, pitch, and yaw angles. These angles are bounded as , , and .

The dynamic behavior of quadrotor in the inertial coordinate can be described by the dynamic equation based on the Euler–Lagrange method [33] as follows:where m is the total mass, is the gravitational acceleration, and is a unit vector in the vertical direction. The vectors d1 and d2 denote, respectively, the norm-bounded uncertainties and disturbances in translational and rotational motions, which are slow time-varying signals.

R represents an orthonormal rotation matrix, defined bywhere and , respectively, represent cosine function and sinusoidal function.

The positive definite matrix J is the moment of inertia, given bywhere represents inertia tensors of the quadrotor.

The vector C represents a Coriolis and centrifugal force term, which can be calculated by [33]

The control input U1 denotes total lift force and stand for torques applied on the three axes, which can be calculated by rotor thrusts as follows [34]:where b1 and ωi represent lift coefficient and angular speed of the relevant propeller, respectively.

Further, the input torque of attitude control for a quadrotor UAV can be obtained aswhere c1 is an aerodynamic constant, and l is the distance from the motors to the center of gravity.

The control problem considered in this work is to design a control system to guarantee the trajectory tracking of a moving target for the quadrotor system with bounded uncertainties and disturbances.

3. Controller Design

It is assumed that we can gain the trajectory of the moving target by the vision sensor and calculated the velocity and acceleration of the target. The overall control objective for the quadrotor with a desired yaw angle ψd is to track the desired trajectory of the target Pd = [xd, yd, zd]T. The speed and acceleration of the target can be defined as Vd and ad, respectively. The distance from the quadrotor to the target can be described by . For a given expected tracking distance , the error of the relative distance is given by . The purpose of target tracking control is to design a closed-loop controller to make the tracking error approach 0.

In this section, the control system is composed of the position controller and attitude controller. Firstly, a position controller based on the artificial potential field and passive control is designed to obtain the desired position tracking for Pd and generate the desired roll and pitch references ϕd and θd. Besides, an attitude controller based on the super-twisting sliding mode method with an improved reaching law is applied to make the aircraft track the desired attitude vector Θd = [ϕd, θd, ψd]T. The control structure is depicted in Figure 3.

3.1. Position Controller Design

According to (1), the translational error is obtained bywhere is the virtual control input.

We use the artificial potential field method to solve the position tracking. Firstly, the repulsion potential Jr is constructed as a generalized Morse function [28]:where b and c are constant, which determine the magnitude and velocity of the repulsion force, respectively. The gain coefficient of the potential field a is a constant. D =  determines the action area of the artificial potential field. represents the minimum safe distance, and is expressed as the maximum distance.

In order to ensure that the artificial potential field has the correct equilibrium state , the gravitational potential is defined aswhere k indicates a positive constant that can adjust the strength of gravitational potential.

If the quadrotor can keep a certain distance to track the target, the velocity field of the artificial potential field at the equilibrium point is 0. The values of parameters k, b, and c will be satisfied asWhen , the gravitational force has a great effect on the convergence in long distances. When , the repulsive force plays a leading role in short distances. When , the potential field no longer works. When , the two forces are just equal and the potential field reaches equilibrium.

By combining repulsive potential and gravitational potential, the velocity field function between UAV and target for can be determined as

Definition 1. Considering nonlinear systems,For all and , f is a locally Lipschitz function and , and is continuous and . If a differentiable positive definite function satisfiesthen, the abovementioned nonlinear system is passive [35].
The velocity error can be set asThe velocity field is used to calculate the relative velocity between UAV and target. The relative velocity is defined asBased on (15), the velocity error can be derived asThe derivative of can be derived asTo ensure accurate tracking of moving targets, a virtual control input of the position controller is designed aswhere , is the estimate of d1, and u is the virtual input of the passive system.
Substituting (18) into (17) yieldswhere the error .
For the tracking system, the structure of the cascaded passive system is shown in Figure 4. The total input of the system is , and the output is . According to passive theory, the passivity of the system can improve the accuracy of the position tracking and avoid the local minimum of the artificial potential field near the equilibrium point. Thus, the stability of the system will be improved.

Theorem 1. Consider the quadrotor translational dynamics described in (8). The whole position tracking system acts as a cascade of the drive system (17) and driven system (20). If the relative velocity and the virtual control input are designed according to (16) and (19), the control strategy can guarantee that the position control system is passive and globally stable at the origin.

Proof. If a candidate storage function is set aswhere , .
According to (11) and (12), we can getwhere , .
If , then , . If , then , . It can be derived as .
The derivative of V1 can be given byThen, the system is passive to and .
The derivative of V2 can be written asThus, the system is passive to and .
The derivative of V3 can be solved asThe feedback control is designed aswhere ; then,Taking into account uncertainties and external disturbances, the storage function V is chosen asThe adaptive law is constructed asBecause is a slow time-varying signal, the derivative of V can be solved asTherefore, it is shown that the controller can force the states of the system with bounded disturbances and uncertainties to converge asymptotically to origin.
We define the virtual control input UP = [Ux, Uy, Uz]T, satisfyingThe above matrix expression can be obtained byAccording to (32), the actual control input U1 can be solved asSubstituting U1 into Ux and Uy, we can get two desired attitude angles from (32); that is,

3.2. Attitude Controller Design

In this section, the attitude controller is designed by using the super-twisting sliding mode control with an improved reaching law. The objective of the controller is to ensure the convergence of the attitude angles to the desired trajectories.

Considering both model uncertainties and external disturbances in the attitude subsystem, (2) can be written aswhere , , .

The vector d denote the norm-bounded model uncertainty and external disturbances in rotational motions aswhere .

The dynamic model of attitude system can be transformed into

The state-space form of this model can be given bywhere the vector and .

The tracking error of attitude e1 is defined as

The angular velocity tracking error is given by

The sliding mode manifold is designed aswhere , .

The reaching law of the sliding mode manifold is chosen aswhere the gain coefficient are positive constant, .

The improved reaching law adds the proportion term and the velocity term. The law provides a power convergence rate in the reaching phase and reduces the approaching time to the sliding surface. In addition, the combined terms can guarantee that the system state reaches the sliding mode surface with a good dynamic performance.

Substituting (42) and (43) into (39) leads to

Theorem 2. Consider the quadrotor rotational dynamics described in (2). If the sliding mode manifold and control input are designed according to (42) and (43), the control strategy can ensure that the attitude tracking error e1 converges to zero.

Proof. If a candidate Lyapunov function is selected asthe derivative of W is computed aswhere .
The matrix Q can be calculated as  = . If appropriate values of k2, k4, and λ are selected to make >0 and , the sliding surface will converge to 0. It can be concluded that the proposed attitude controller can guarantee that the attitude angle asymptotically converges to the desired values.

4. Simulation and Analysis

Trajectory tracking simulations of the quadrotor have been carried out to verify the validity and efficiency of the proposed control method. Besides, a synthesis controller based on second-order SMC (2-SMC) [36] has been chosen for the comparison.

The parameter values of the quadrotor model are as follows: m = 0.5 kg, b1 = 5 Ns2, c1 = 2 Nms2, l = 0.5 m,  = 9.8 m/s2, Ixx = Iyy = 0.004 kgm2, Izz = 0.008 kgm2, and the yaw angle ψd = π/3. The external disturbances are considered as d1 = [0.1sin(0.1πt), 0.1cos(0.1πt), 0.1cos(0.1πt)]T and d2 = [0.3sin(0.1πt) + 0.1, 0.4cos (0.1πt) + 0.1, 0.5sin(0.1πt) + 0.2]T.

In order to further evaluate the robustness of the proposed control method, another simulation has been executed for the system under external disturbances and parametric uncertainties. The parameter uncertainties are considered as ±30% in the mass m and inertia matrix Ixx, Iyy, and Izz respectively.

The controller parameters of 2-SMC are given as follows: cz = 1, cψ = 1, ε1 = 1, ε2 = 1, ε3 = 0.5, ε4 = 0.5, η1 = 1, η2 = 1, η3 = 4, η4 = 4, c1 = 10ms/(u1cosϕcosψ), c2 = 5ms/(u1cosϕcosψ), c3 = 1, c4 = 5, c5 = −10ms/(u1cosψ), c6 = −5ms/(u1cosψ), c7 = 1, and c8 = 5.

The parameters of the control method based on PC and STSM (PC&STSM) are adjusted as , , , k = 10, a = 1, b = 16.83, c = 2, α = 0.8, λ1 = 4, β = 2, k1 = 0.5, k2 = 1, k3 = 3, k4 = 2, and λ = 10. According to the tracking target, selecting methods of controller parameters will be given as follows.(1)First, it is assumed that the expected distance between the aircraft and the moving target  = 2. The gain coefficient a will be chosen as a = 1 to balance the potential field force. When 5, we choose k = 10 to get a large gravitational force. When , we choose c = 2 to get a slightly large repulsive force. According to (11), we can get b = 16.83 at the equilibrium point of the artificial potential field(2)The parameters α and β are in connection with the convergence rate of the relative velocity and position error. The parameter λ1 is related to the external disturbances in translational motion. Through several simulation attempts, we choose α = 0.8, β = 2, and λ1 = 4 in order to improve the convergence rate and accuracy(3)When s = 0, . If any attitude angle error needs to converge to 0.01 in 0.5 s, λ should be chosen as λ = 10. The parameters k1, k2, and k4 are in connection with the accuracy and convergence speed of attitude angle error. According to (43) and (47), k1 > 0, k2 > 0, and k4λ > 0.25. Through several simulation attempts, we choose k1 = 0.5, k2 = 1, and k4 = 2 to obtain fast convergence and small overshoot. Finally, the parameter k3 is related to the robustness of the system, and k3 will be adjusted according to

In order to show the effectiveness of the proposed strategy, we select two tracking scenarios for simulation.

4.1. Ground Moving Target

The initial position and attitude angle values of the quadrotor are [0, 0, 1.5] m and [0.2, 0.2, 0.5] rad. The trajectory of a moving ground target can be described as

Simulation results of trajectory tracking are depicted in Figure 5. Figure 5(a) presents tracking results from the two control methods in 3D space. It can be observed that the PC&STSM method can make the quadrotor track the target accurately at a fixed distance, whereas the 2-SMC approach makes it slightly off the desired track at the beginning. As shown in Figure 5(b), the position tracking from APF&PC achieves null steady-state error for all positions in 1.8 s, while the 2-SMC controller takes 3.8 s to get the steady state. Figure 5(c) shows that the STSM controller has a fast convergence rate than that from 2-SMC. Compared with 2-SMC, the improved reaching law greatly improves the convergence performance. The comparisons of convergence time and overshoot between the two methods are listed in Tables 1 and 2.

As shown in Figure 6, the simulation results of trajectory tracking demonstrate the control quality of the proposed controller in terms of disturbances and uncertainties.

It can be seen from Figure 6(a) that the PC&STSM controller can still track accurately the trajectory of the moving ground target when the mass and inertia matrixes of the quadrotor change by ± 30%. According to Figure 6(b), the position tracking generated by the controller converges to the set position in 2s even if the disturbances and uncertainties are considered. Besides, the figure also shows that parameter uncertainties have few effects on position control. From Figure 6(c), it can be observed that attitude angles converge in a short time and keep the desired values all the time although uncertainties and disturbances cause overshoot. The simulation results have illustrated that the PC&STSM controller has good robustness and tracking performance in the case of external disturbances and parameter uncertainties.

4.2. Aerial Moving Target

The initial position and attitude angle values of the quadrotor are [0, 0, −1] m and [0, 0.2, 0.5] rad. The trajectory of a moving aerial target can be described as

According to Figure 7(a), it can be concluded that the aerial target tracking control system can meet the tracking performance, and the PC&STSM has a better tracking effect than 2-SMC. From Figure 7(b), it can be observed that APF&PC is insensitive to disturbances and has a faster convergence speed in position tracking. In contrast, 2-SMC has a longer adjustment time. Figure 7(c) shows that STSM achieves zero steady-state error with a small overshoot between 0 rad and 0.09 rad, while 2-SMC has a bigger amplitude oscillation in attitude tracking. The response speed of STSM is faster than that of 2-SMC, which is helpful to flexibly move in the air. The comparisons of convergence time and overshoot between the two methods are listed in Tables 3 and 4.

As presented in Figures 6 and 8, the convergence of position and attitude state is slightly affected by the variation of system parameters, but the proposed controller can achieve zero steady-state error and compensate for external disturbances and parameter uncertainties. The simulation results verify the robustness of the proposed control scheme.

Numerical simulation indicated that the controller based on PC&STSM can trace the moving target effectively and has a good dynamic performance. Compared with the 2-SMC method, the proposed controller has a better performance in tracking precision and robustness.

5. Conclusion

In this paper, we propose a composite control strategy based on passive control and super-twisting sliding mode control to solve the problem of moving target tracking of quadrotors considering model uncertainties and external disturbances. The control structure is composed of position and an attitude controller. For position control, the artificial potential field method is proposed by combining gravitational potential with repulsion potential to achieve the stable tracking of moving targets at a fixed distance. Meanwhile, the cascade passive control is designed to ensure the stability of the positioning system. Moreover, the super-twisting sliding mode controller with an improved reaching law is introduced to make the attitude angles quickly track the desired trajectory and overcome uncertainties and disturbances. Finally, the simulation results show that the proposed control system can achieve a better tracking performance and robustness compared with 2-SMC in moving target tracking.

Data Availability

No data were used to support this study.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

Acknowledgments

This work was supported in part by the National Natural Science Foundation of China under Grant 61903163, Natural Science Foundation of the Jiangsu Higher Education Institutions of China under Grant 19KJB510023, and Marine Equipment and Technology Institute of JUST under Grant HZ20200007.