A Moving Target Tracking Control of Quadrotor UAV Based on Passive Control and Super-Twisting Sliding Mode Control

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. -irdly, 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.


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 [1][2][3][4]. e quadrotor UAV is an underactuated and strongly coupled nonlinear system, which is subject to structural uncertainties and unknown external disturbance. erefore, 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 UAVbased 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. us, 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 [21][22][23].
erefore, 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.
ere are some main feasible control methods to realize the position tracking of UAVs. e 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 timevarying sliding surface and a nonlinear adaptive feedback control law based on the APF method for obstacle avoidance control. e 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 passivitybased 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. e position controller combines the artificial potential field with passive theory to achieve high-precision position tracking, and the attitude controller uses the supertwisting sliding mode method with an improved reaching law to improve the convergence speed of the attitude.
e 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. e quadrotor can track the moving target at a certain distance by tracking the balance point of the artificial potential field. e 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. e 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. e 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.

Mathematical Model of the Quadrotor
Target tracking is a complex engineering system that involves technical modules in hardware, localization, mapping, planning, and control. e target tracking of UAV is to locate the target according to the distance information of relative observation angle and attitude information of UAV. en, 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. e simplified structure of the tracking system is shown in Figure 1. e 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, f i (i � 1, 2, 3, 4) stands for the thrust force produced by the ith propeller. e vertical motion is created by the collective thrust input of all four propellers. e roll, pitch, and yaw motion can be achieved by changing the speeds of different propellers. e 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. ese angles are bounded as ϕ ∈ − π/2 π/2 , θ ∈ − π/2 π/2 , and ψ ∈ − π π . e 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, g is the gravitational acceleration, and e 3 � 0 0 1 T is a unit vector in the vertical direction. e vectors d 1 and d 2 denote, respectively, the normbounded uncertainties and disturbances in translational and rotational motions, which are slow time-varying signals.
R represents an orthonormal rotation matrix, defined by where C (·) and S (·) , respectively, represent cosine function and sinusoidal function. e positive definite matrix J is the moment of inertia, given by where I � I xx I yy I zz T represents inertia tensors of the quadrotor. e vector C represents a Coriolis and centrifugal force term, which can be calculated by [33] e control input U 1 denotes total lift force and Γ � Γ ϕ Γ θ Γ ψ T stand for torques applied on the three axes, which can be calculated by rotor thrusts as follows [34]: where b 1 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 as where c 1 is an aerodynamic constant, and l is the distance from the motors to the center of gravity. e 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.

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. e overall control objective for the quadrotor with a desired yaw angle ψ d is to track the desired trajectory of the target P d � [x d , y d , z d ] T . e speed and acceleration of the target can be defined as V d and a d , respectively. e distance from the quadrotor to the target can be described by ρ � P − P d . For a given expected tracking distance ρ d , the error of the relative distance is given by e P � ρ − ρ d . e 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 P d and generate the desired roll and pitch references ϕ d Rotor 3 Rotor 4

Rotor 1
mg  Mathematical Problems in Engineering and θ d . Besides, an attitude controller based on the supertwisting sliding mode method with an improved reaching law is applied to make the aircraft track the desired attitude vector Θ d � [ϕ d , θ d , ψ d ] T . e control structure is depicted in Figure 3.

Position Controller Design.
According to (1), the translational error is obtained by where U P � U 1 Re 3 is the virtual control input. We use the artificial potential field method to solve the position tracking. Firstly, the repulsion potential J r 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. e gain coefficient of the potential field a is a constant. D � [‖ρ‖ min , ‖ρ‖ max determines the action area of the artificial potential field. ‖ρ‖ min > 0 represents the minimum safe distance, and ‖ρ‖ max is expressed as the maximum distance.
In order to ensure that the artificial potential field has the correct equilibrium state ‖ρ d ‖, the gravitational potential J a is defined as where 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. e values of parameters k, b, and c will be satisfied as When ‖ρ d ‖ ≤ ‖ρ‖ ≤ ‖ρ‖ max , the gravitational force has a great effect on the convergence in long distances. When ‖ρ‖ min ≤ ‖ρ‖ ≤ ‖ρ d ‖, the repulsive force plays a leading role in short distances. When ‖ρ‖ > ‖ρ‖ max , the potential field no longer works. When ‖ρ‖ � ‖ρ d ‖, 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 ‖ρ‖ ∈ D can be determined as Definition 1. Considering nonlinear systems, For all x ∈ R n and u ∈ R m , f is a locally Lipschitz function and f(0, 0) � 0, and h(x) is continuous and then, the abovementioned nonlinear system is passive [35]. e velocity error can be set as e velocity field is used to calculate the relative velocity between UAV and target. e relative velocity is defined as Based on (15), the velocity error can be derived as e derivative of v r can be derived as To ensure accurate tracking of moving targets, a virtual control input of the position controller is designed as where λ 1 > 0, d 1 is the estimate of d 1 , and u is the virtual input of the passive system. Substituting (18) into (17) Figure 3: Structure of the quadrotor control system.
where the error d 1 � d 1 − d 1 . For the tracking system, the structure of the cascaded passive system is shown in Figure 4. e total input of the system is d 1 + u, and the output is e P . 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. us, the stability of the system will be improved. Theorem 1. Consider the quadrotor translational dynamics described in (8). e 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.
If ‖ρ‖ ≥ ‖ρ d ‖, then T ≥ 0, Q ≤ 0. If ‖ρ‖ < ‖ρ d ‖, then T < 0, Q > 0. It can be derived as e T P v f ≤ 0. e derivative of V 1 can be given by en, the system is passive to e P and v r . e derivative of V 2 can be written as us, the system is passive to v r and d 1 + u. e derivative of V 3 can be solved as e feedback control is designed as where β > 0; then, Taking into account uncertainties and external disturbances, the storage function V is chosen as e adaptive law is constructed as Because d 1 is a slow time-varying signal, the derivative of V can be solved as erefore, 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 e above matrix expression can be obtained by According to (32), the actual control input U 1 can be solved as Substituting U 1 into U x and U y , we can get two desired attitude angles from (32); that is,

Attitude Controller Design.
In this section, the attitude controller is designed by using the super-twisting sliding mode control with an improved reaching law. e 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 as where e vector d denote the norm-bounded model uncertainty and external disturbances in rotational motions as where ‖d‖ ≤ D 1 . e dynamic model of attitude system can be transformed into e state-space form of this model can be given by where the vector f(Θ) � − J − 1 0 C _ Θ and g(Θ) � J − 1 0 . e tracking error of attitude e 1 is defined as e angular velocity tracking error is given by e sliding mode manifold is designed as where s � s ϕ s θ s ψ T , λ > 0. e reaching law of the sliding mode manifold is chosen as where the gain coefficient k 1 , k 2 , and k 4 are positive constant, k 3 > D 1 ≥ ‖d‖. e improved reaching law adds the proportion term and the velocity term. e 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 e 1 converges to zero.
Proof. If a candidate Lyapunov function is selected as the derivative of W is computed as where Q � k 4 λ 2 e matrix Q can be calculated as |Q| � k 4 λ − (1/4). If appropriate values of k 2 , k 4 , and λ are selected to make |Q|>0 and _ W ≤ 0, 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.

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.
e parameter uncertainties are considered as ±30% in the mass m and inertia matrix I xx , I yy , and I zz respectively. e controller parameters of 2-SMC are given as follows: e parameters of the control method based on PC and STSM (PC&STSM) are adjusted as ‖ρ‖ min � 1, ‖ρ d ‖ � 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 ‖ρ d ‖ � 2. e gain coefficient a will be chosen as a � 1 to balance the potential field force. When 2 ≤ ‖ρ‖ ≤ 5, we choose k � 10 to get a large gravitational force. When 1 ≤ ‖ρ‖ ≤ 2, 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) e parameters α and β are in connection with the convergence rate of the relative velocity and position error. e parameter λ 1 is related to the external disturbances in translational motion. rough several simulation attempts, we choose α � 0.8, β � 2, and λ 1 � 4 in order to improve the convergence rate and accuracy (3) When s � 0, _ e 1 � − λe 1 . If any attitude angle error needs to converge to 0.01 in 0.5 s, λ should be chosen as λ � 10. e parameters k 1 , k 2 , and k 4 are in connection with the accuracy and convergence speed of attitude angle error. According to (43) and (47), k 1 > 0, k 2 > 0, and k 4 λ > 0.25. rough several simulation attempts, we choose k 1 � 0.5, k 2 � 1, and k 4 � 2 to obtain fast convergence and small overshoot. Finally, the parameter k 3 is related to the robustness of the system, and k 3 will be adjusted according to k 3 > ‖d‖ In order to show the effectiveness of the proposed strategy, we select two tracking scenarios for simulation.

Ground Moving Target.
e initial position and attitude angle values of the quadrotor are [0, 0, 1.5] m and [0.2, 0.2, 0.5] rad. e 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. e 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 e simulation results have illustrated that the PC&STSM controller has good robustness and tracking performance in the case of external disturbances and parameter uncertainties.

Aerial Moving Target.
e initial position and attitude angle values of the quadrotor are [0, 0, − 1] m and [0, 0.2, 0.5] rad. e 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. e response speed of STSM is faster than that of 2-SMC, which is helpful Mathematical Problems in Engineering 7   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. e 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.

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. e 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
e authors declare that they have no conflicts of interest.