Abstract
This paper presents an approach to address the curved-path following problem of a fixed-wing UAV, which can reach uniform optimal path-following performance for different initial states and control processes. First, a proper guidance law is designed following a class of horizontal smooth paths with fixed control parameters. The stability of the relative nonlinear system is guaranteed by the Lyapunov stability theory. The influence of the control parameters on path-following performance has been analyzed. Second, the rules of the time-varying control parameters are designed separately. The rules of the time-varying P-like parameter are designed by analyzing the dynamic characteristics of the nonlinear system with different initial flight states. The rules of the time-varying D-like parameter are designed based on the fuzzy logic technique. The stability of the corresponding nonautonomous nonlinear system is also proved. The simulations are carried out in the Matlab/Simulink environment with an Aerosonde UAV model. The results are presented to illustrate the effectiveness and high path-following performances of the proposed control strategies.
1. Introduction
In the past two decades, small fixed-wing UAVs have been widely applied in military and civil fields, such as anti-terrorism reconnaissance, communication relay, land surveying and mapping, forest fire prevention, power inspection, and so on [1]. One important function of the autopilot is that it can give the UAV the ability to fly over the target area according to the predefined path [2]. The methods for realizing the objective can be classified into two categories: trajectory tracking and path following. Path following is to make the UAV fly along the geometric path at any feasible speed. Trajectory tracking requires the UAV to converge and follow a time-parameterized path [3]. It requires the autopilot to produce the velocity command, which is critical for the small fixed-wing UAV [4].
Various approaches have been proposed in the literature for path following. Two main categories are linear-control-based approaches and nonlinear-control-based approaches. The linear path following control methods mainly include PID and LQR techniques. The structure of a PID-based path following controller is simple and easy to implement [5], but the selection of control parameters mostly depends on the experience of the designers [6]. the controller’s ability to resist unmodeled parts and external disturbances is poor [7]. The LQR-based method is usually applied to follow a straight-line and circular paths. The LQR-based path following approach requires a suitable linear model, which includes the dynamic characteristics of the system and the differential equation of the heading error [8]. It should be pointed out that the heading error must be small enough to meet the linearization conditions [9]. Otherwise, the linear model will not match the actual characteristics, and the controller will fail.
The nonlinear path following control methods mainly include the intelligent control techniques, nonlinear model predictive control (NMPC), and the Lyapunov-stability-theory-based methods. In the aspect of intelligent control techniques, Cancemi et al. applied the Takagi–Sugeno fuzzy technique to produce the desired heading to follow the predefined waypoints [10]. Back et al. applied the convolutional neural networks to produce the head direction control and lateral offset [11]. By combining the above two control quantities linearly, the yaw rate command was generated to guide the UAV to follow the desired path. Zhang et al. [12] used the deep reinforcement learning approach to generate the desired heading command, where a specific reward function was designed for minimizing the cross-track error of the path following problem. The simulations with the above intelligent techniques have been presented to show their effectiveness. However, the stability of the relative controllers has not been proved.
Considering the input and state constraints of the UAV, the NMPC technique is usually applied to solve the path following problems by combining the dynamics of the UAV and the path following error. In the early stage of applying NMPC, the methods have satisfactory path-following performance [13,14], but they do not consider the stability of the relative closed-loop system. Hamada et al. applied the NMPC technique to produce the lateral guidance law by using the continuation/generalized minimum residual method with an extended Kalman filter [15]. In [16], Yang et al. applied the NMPC technique to generate the heading rate command to first follow the straight-line path. By varying the control horizon depending upon the path curvature profile, an adaptive NMPC algorithm was presented to follow the continuous curvature path [17]. The conditions that can assure the closed-loop stability of the corresponding system were obtained. However, this method presents higher requirements for the calculation of the optimization problems, especially when the control horizon increases.
Other nonlinear path following controllers are mainly based on the Lyapunov stability theory. Kothari et al. applied the pure pursuit and line-of-sight (PLOS) method to realize following in a straight-line [18]. By using the virtual target point, Park et al. [19] developed a nonlinear path-following guidance law, which can follow both straight-line and circular paths. The use of heading guidance generated from vector fields is a candidate for UAVs to implement path following [2]. Nelson et al. combined the techniques of vector field and sliding mode to generate the straight-line and circular paths following control law [20]. Farì et al. presented an adaptive vector field control law which can compensate for the lack of knowledge of the wind vector and for the presence of unmodelled course angle dynamics [21]. Zhao et al. developed a curved-path following controller approach with the combination of the vector field and the input-to-state stability theorem [22]. Liang et al. designed a saturated course rate controller based on a combined vector field, which combined a conservative vector field and a solenoidal vector field [23,24]. The theory of nested saturations is an alternative approach which can be used to deal with the input constraints [3]. Zhao et al. developed a curved-path following control scheme with the control constraints by using the theory of nested saturations [3]. Beard et al. designed the guidance strategies for following the straight-lines and orbits in wind by using the nested saturations technique. The strategies have considered the roll angle and flight path constraints [25]. While designing the guidance law for path following by using the kinematic and dynamic models of the UAV, the backstepping technique can be applied to design the virtual control to meet the requirements step by step, finally designing the real control law. By using the backstepping and parameter adaptation techniques, Jung et al. have developed the roll angle command, which can follow the flyable smooth path [26]. Flores et al. have designed a path following controller by introducing a virtual particle moving along the geometric path that is represented by parameterized smooth functions. The error kinematic model in the Frenet–Serret frame, together with the roll dynamics, is used to generate the guidance law [27]. Furthermore, the wind disturbances, which are estimated by using the arbitrary-order exact robust differentiator, are considered to improve robustness [28].
The nonlinear controllers designed using the Lyapunov stability theory are very attractive, both in theory and experiment. Nevertheless, in the process of designing this kind of controller, the control parameters are generally fixed to ensure the stability of the corresponding closed-loop nonlinear system. In fact, the values of the control parameters have a very important impact on the path-following performance, which is mainly reflected in the convergence speed, overshoot, following error, and so on. If the above controller parameters change within a certain range, the corresponding stability proof process will no longer be applicable. Therefore, designing a stable path following controller based on the Lyapunov stability theory, where its corresponding control parameters can be adjusted in real time to adapt to different initial conditions and dynamics, is vital to improve the path-following performance of a UAV.
In our previous works [29], a PD-like nonlinear guidance law was presented to guide the fixed-wing UAV toward the predefined straight-line path. To achieve better path-following performance, one of the control parameters was tuned by fuzzy logic. However, the other control parameter is still fixed; therefore, it cannot give the UAV a better path-following performance. In this study, the PD-like nonlinear guidance law is extended to follow a class of horizontal paths. Both of the control parameters are designed adaptively to improve the path-following performance.
The main contributions of this study are summarized as follows: First, a Lyapunov-stability-based guidance law for following a class of horizontal paths is presented by using Barbalat’s lemma, where the ground speed of the UAV is time-varying and bounded. Second, both of the control parameters of the guidance law for following the straight-line and circular paths are designed adaptively. The rules of the time-varying P-like parameter are designed to make it adapt to this different initial flight states, whereas the rules of the time-varying D-like parameter are designed based on the fuzzy logic technique. In this case, the stability of corresponding nonautonomous nonlinear system is also guaranteed. To the best of our knowledge, this the first time that all of the control parameters of the guidance law used are time-varying and adaptive. Third, the control results were compared with the methods when the parameter was fixed, which illustrates the effectiveness and better performance of the proposed control strategies.
The remainder of this paper is organized as follows. The equations of the problem description are listed in Section 2. In Section 3, a guidance strategy for a class of horizontal path following is derived. The influence of the parameters on the dynamic characteristics of the relative nonlinear system is also analyzed. The detailed rules of the time-varying P-like parameter and the fuzzy logic controller for optimizing the D-like parameter are also presented. The simulation results obtained using an Aerosonde UAV in Matlab/Simulink are given in Section 4, and some concluding remarks are summarized in Section 5.
2. Problem Formulation
A small fixed wing UAV equipped with autopilot can realize the stable feedback control of altitude, attitude, and airspeed. In this case, these states converge with the desired response to their commanded values. In typical application fields such as mapping and searching, the airspeed and altitude remain unchanged using a zero climb rate under the control of the autopilot so that the UAV works in the safe flight envelope [25]. The following kinematic model in the horizontal plane can describes the motion of the fixed-wing UAV:
where , , and denote the inertial position and speed of the UAV in a 2D inertial frame, respectively. and represent the and components of the wind velocity . and denote the airspeed and heading, respectively. is the course of the UAV. is the course rate command of the UAV. When the fixed-wing UAV is flying, the speed will always be positive. Thus, the following assumption is adopted.
Assumption 1.
The speedand its derivativeare both bounded, and, whereandare all positive constants.
Definition 1. (Horizontal Path).
Let
be an implicit expression of a reference path, whereis a twice continuously differentiable function.
Definition 2. (Level Set).
A level set of a functionis the set, where is a given constant.
Following [30], the value when the UAV is in is used as the distance value. Given that the gradient of is not zero on the path, the value of can represent the position of the UAV relative to the desired path. If , it means that the UAV is on the path.
Let and be the first-order partial derivatives of , and the gradient modules of is . As shown in Figure 1, the vector represents the desired orientation along the level path. The desired orientation can be given as
Figure 1.
Path level set and the position of the UAV with respective to the desired path.
For some given , the value of may be zero in some points . If the UAV’s initial position is at these points, the guidance to be designed below will fail, and the UAV will lose control. In the following, the safe flying area for the UAV is defined as , where is a positive constant.
Assumption 2.
,
, , , and are bounded in any bounded domain .
The virtual distance error is introduced as
By differentiating Equation (3) with respect to time, we obtain
Let the course angle error be defined as
Hence,
The error kinematics model suitable for control purposes is summarized as
The Equations (3) and (5) show that if the UAV is flying along the desired path with the right direction, then , and . Thus, the purpose of this study is that, based on the error kinematics model (7), the designed feedback control law should make the errors and converge to zero.
3. Controller Design
In this section, first, a stable kinematic control law for the course rate command with fixed control parameters is derived based on the nonautonomous systems. Second, the analysis of the control parameters is presented. Third, the nonautonomous systems which will be used to describe the adaptive path following is presented, and the relative control law is designed based on the Lyapunov stability theory. Additionally, the method of parameters adaptation is also described. The sketch of the solution to the curved-path following controller with parameters adaptation is shown in Figure 2.
Figure 2.
The sketch of the solution to the curved-path following controller with parameters adaptation.
3.1. Kinematic Controller Design with Fixed Control Parameters
Theorem 1.
Considering the kinematic error model of the UAV described in Equation (7), the following control law,
whereandare all positive constants, is the saturation function defined as
withan arbitrary given positive constant, asymptotically drivesandtowards zero.
Proof of Theorem 1.
Substitute shown as Equation (8) into Equation (7), then
Define the domain , where is a positive constant, and let , Equation (9) can be rewritten as
where
It can be found that is a locally Lipschitz map from the domain into with Assumptions 1 and 2 adopted. is the only equilibrium point for (11) in . Let be a candidate Lyapunov function given as:
Therefore, . Moreover, if . If , ; thus in . The time derivative of U(x) along the trajectory of (9) is
It can be found that is negative semidefinite. Since , , , , , and are bounded and , one can derive that is bounded. It can be found from (12) that is lower bounded. Since , , and their derivatives are all bounded, by (13) is negative semidefinite and uniformly continuous in time. By Barbalat’s lemma [31], as . Moreover, it has , and as in (11). Since is bounded, it follows that tends to a finite limit as . Since as , and in (11) is uniformly continuous, it derives that as . Hence, it follows that and . Therefore, the kinematic control law (8) can asymptotically drive and toward zero. □
3.2. Figures, Tables and Schemes
For a given initial state of the nonlinear system (9), The behaviors of and are affected by the two control parameters and . In order to study how the parameters will affect the dynamics of the nonlinear system (9), the straight-line and circular paths are chosen for case analysis. The function of a given straight-line path can be expressed as , where and . The function of a given circular path can be described as , where and represent the center and radius of the circle, respectively. With the functions of the straight-line and circular paths described above, the values of the corresponding gradient modulus are all .
Figure 3a shows the different trajectories of the nonlinear system (9) with , V, and , but under five different values of parameter . The trajectories of and are shown in Figure 3b,c, respectively. The parameter directly affects the dynamic characteristics of the two states and . With larger value of the rise times of the two states and are all shorter, but the corresponding overshoots and oscillation amplitudes become larger. The smaller or larger value of the parameter , the faster the convergence speed of the two states.
Figure 3.
The dynamics of the nonlinear system (9) with , , and , but under five different values of . (a) The phase plots of the system (9); (b) the trajectories of with respect to time; (c) the trajectories of with respect to time.
Figure 4a shows the different trajectories of the nonlinear system (9), with , V, and , but under five different values of . The trajectories of and are shown in Figure 4b,c, respectively. It can be seen that the parameter significantly influences the dynamics of and . With a larger value of , the overshoots of and will both be smaller. The smaller value of will lead to a larger oscillation amplitude and more oscillation times of and . With the increase of , the rise times of and are both longer. Equation (9) shows that the dynamics of is a nonlinear combination of the variable and its differential, which is similar to a PD controller. The term can predict the error trend and correct the error in advance. Thus, the parameter cannot blindly pursue a large value, but should take an appropriate value.
Figure 4.
The dynamics of the nonlinear system (9) with ‖Δf‖ = 1, , and k1 = 0.00025, but under five different values of . (a) The phase plots of the system (9); (b) the trajectories of with respect to time; (c) the trajectories of with respect to time.
3.3. Kinematic Controller Design with Time-Variable Control Parameters
The analysis of Section 3.2 shows that the two parameters and will both affect the guidance performance of a UAV. Reviewing the proof process of Theorem 1, as long as the parameter is always greater than a positive value, the stability of the relative nonlinear system (9) can be guaranteed. At the same time, we hope that for each flight path, under different initial distances and relative course angles, the parameter can also adapt to the different initial flight states, where the resulting overshoot is small and the convergence speed is fast, whereby the stability of the whole system can also be guaranteed.
In the following, in order to achieve better path-following performance with smaller overshoot and faster convergence speed, a modified control law is introduced as:
where , , are both positive constants with , and
, are both positive constants with , is a positive constant.
Equation (15) shows that the parameter is time-varying. For each given path, the parameter changes from the maximum value to the minimum value over time . This parameter change mechanism can meet the need to use a large value of to make the UAV fly to the target path quickly when the vehicle is far from the target path. When the UAV is close to the target path, the value of becomes smaller, which will reduce the overshoot. The time constant plays an adjusting role in this process. When following the control of each target path, the time constant should be set according to the initial states of the UAV relative to the target path, i.e., the initial distance and relative course angles.
When , it follows that and . Thus,
Theorem 2.
Considering the kinematic error model of the UAV described in Equation (7), the control law ucmd(t) shown as (14) will asymptotically drive ed andtowards zero.
Proof of Theorem 2.
Substitute shown as (14) into Equation (7), the corresponding nonautonomous nonlinear system can be shown as:
where
It can be found that is piecewise continuous in t and locally Lipschitz in on . Moreover, , . Thus, is the only equilibrium point for the nonlinear system .
By choosing the candidate Lyapunov function as
The derivative of along the trajectories of (19) is given by
Furthermore, with the results shown as Equations (16) and (17), it can be derived that
It can be found that is a continuous positive semidefinite function on , and are both continuous positive definite on . It can be found from (22) and (23) that is lower bounded. Since , , and their derivatives are all bounded, by (21) is negative semidefinite and uniformly continuous in time. By Barbalat’s lemma (p. 323, [31]), as . Moreover, it has , and as in (19). Since is bounded, it follows that tends to a finite limit as . Since as , and in (19) is uniformly continuous, it derives that as . Hence, it follows that and . Therefore, the kinematic control law (14) can asymptotically drive and toward zero. □
3.4. The Adaptive Design of and
In this subsection, the control parameters and are designed adaptively to improve the path-following performance. Since a given smooth path on the plane can be approximated by a certain number of straight lines and arc segments, the following research focuses on the straight-line and circular paths.
Assumption 3.
For each straight-line or circular path to be followed, the distance between the UAV and the target path is within 300 m, and the corresponding course angle deviation is within 90 degrees. Thus, the variation ranges of the initial values of the statesandareand, respectively.
As shown in Equation (13), the dynamics of the parameter is determined by the parameter . The adaptive design of is transformed into the optimal design of parameter . In this study, the time constant is selected by analyzing the dynamic response of Equation (9) under different initial conditions. and are chosen as 0.00025 and 0.0001, respectively. The objective is to establish the relationship between the time constant and the initial values of the states and based on Equation (9), when , . In the following, the initial values of the states and are denoted as and for convenience.
Since the analytical solution of the nonlinear Equation (9) cannot be obtained, the numerical method is applied to study its dynamic characteristics. By discretizing the value range of according to equal intervals of length 30, 21 values of are obtained. Similarly, 19 values of the state are obtained by discretizing its value range according to equal intervals of length . Thus, 399 pairs of (are obtained through combination. Under each initial state condition (, the state trajectories of the nonlinear system (9) with and , can be calculated by the fourth order Runge–Kutta algorithm.
There are four typical trajectories of under different initial state conditions (, which can be seen in Figure 5. As shown in Figure 5a,b, if , the time length is defined as the length of time it takes for the state to get the maximum value from its initial value. If , the time length is defined as the length of time it takes for the state to get the minimum value from its initial value. Figure 5c,d shows that, if , the time length is defined as the length of time it takes for the state to get the minimum value from its initial value. If , the time length is defined as the length of time it takes for the state to get the maximum value from its initial value.
Figure 5.
Four typical trajectories of . (a) ; (b) and ; (c) and ; (d) .
In this study, the empirical relationship between the time constant and the two parameters and are selected by analyzing the dynamic trajectory as
At this time, the discrete relationship between the time constant and 399 pairs of ( can be obtained, as can be seen in Figure 6. When following each desired path, the initial state of the UAV will be calculated, and then the corresponding time constant required to follow this path can be obtained by using the bilinear interpolation method.
Figure 6.
The relationship between the time constant and the initial states of and .
According to the analysis shown in Section 3.2, the value of k2 should be adjusted adaptively in a certain range near the appropriate value. Additionally, the dynamics of is a nonlinear combination of the variable and its differential, which is similar to a PD controller. The method of applying fuzzy logic to a linear PD controller is adopted to the adaptive design of parameter . In this study, the adaptive parameter can be calculated around the given nominal value by a fuzzy logic controller as
where is the output of the fuzzy logic controller.
While designing the fuzzy logic controllers, the value of is defined by the fuzzy rules described in Table 1, based on and . The terms NB, NM, NS, Z, PS, PM, and PB stand for negative big, negative medium, negative small, zero, positive small, positive medium, and positive big, respectively. Figure 7a shows the triangular, Z-shaped, and S-shaped membership functions used for the fuzzification of the inputs and , and the output . The universe of discourse of , , and are given as [−240, 240], [−30, 30], and [−0.00025, 0.00075], respectively. Figure 7b shows the input-output surface for the fuzzy logic controller among , , and . The minimum value of is −0.0002042. In this study, the parameter is chosen as 0.0008. Then, is always positive with .
Table 1.
Fuzzy rules to estimate , based on and .
Figure 7.
The properties of the fuzzy controller. (a) The membership functions used for the fuzzification of the inputs and , and the output , respectively; (b) Input-output surface of the fuzzy logic controller among , , and .
4. Simulation
The proposed curved-path following control method with adaptive parameters is presented as Figure 8.
Figure 8.
The structure of the proposed controller.
The bank-to-turn maneuver with no sideslip is applied to the small fixed-wing UAV. It follows that [25]
where is the magnitude of gravity at sea level. It is assumed that the inner loop PD controller can quickly track the commanded bank angle. At the same time, the dynamics of the bank angle are much faster than those of heading and altitude. In this case, the roll angle can be approximately considered as the commanded bank angle . Therefore, Equation (28) becomes
Considering the relationship shown in Equation (1), the bank angle command can be derived as
The simulation was studied in the Matlab/Simulink environment. The Aerosonde UAV model with a wingspan of 2.9 m was used as the test vehicle [29]. Figure 9 shows the simulation in the Matlab/Simulink environment. The parameters used in the simulation are shown in Table 2. The initial was set as 25 m/s. The sample time was set as 25 ms. A constant wind at 8 m/s from 270° W was also added to the model of the UAV, which will verify the effectiveness of the proposed method under the wind disturbance. The initial position and course of the UAV were set as and 0° N, respectively.
Figure 9.
The simulation in the Matlab/Simulink environment.
Table 2.
The parameters for simulation.
4.1. Polygon Path Following
The desired horizontal polygon path was defined with six waypoints: A (0, 0), B (2400, 1386), C (2400, 3386), D (0, 5786), E (−2400, 5786), and F (−2400, 0). The simulation duration is 900 s. Figure 10a shows the comparison of the path following with the control parameter , , and . For the convenience of description, the path following controller under the action of , , and is abbreviated as , , and , respectively. To verify the effectiveness of the proposed methods, we compared the path-following performances of the methods , , and vector field (VF) [20]. While executing the polygon path following, the turn-through-waypoint mode was adopted to switch course.
Figure 10.
Comparison of the polygon path following with the four methods , , and VF. (a) the position; (b) the distance ; (c) the parameter ; (d) the parameter ; (e) the course rate command ; (f) the bank angle command .
The response to the straight-line path can be evaluated by the length of the predefined path followed (LOPPF), the convergence distance, and the error overshoot. For a given segment path, the time from the error converging to less than the aircraft’s wingspan until the UAV starts to switch to another path is called the effective time of UAV flying along the given path. The length of the predefined path followed (LOPPF) is defined as the projection length of the UAV’s flight path on the desired segment during this effective path-following time. The convergence time is defined as the time from the UAV following the desired path until is less than the aircraft’s wingspan. For straight-line path following, the error overshoot is the maximum of , which can be seen in the areas of I, II, III, IV, V, and VI, as shown in Figure 10b.
Figure 10b shows the comparison of the while following the predefined polygon path with the four methods , , , and VF. As shown in the areas I, II, III, IV, V, and VI, the error overshoots found by using the method are the largest. The corresponding error overshoots found by using the method are the second smallest. When using the method , the error overshoots are moderate and closer to those generated by the method . The corresponding error overshoots shown in the areas I, II, III, IV, V, and VI are all listed in Table 3.
Table 3.
The performance comparison of the polygon path following using the four methods.
As Figure 10b and Table 3 show, while turning through the waypoint F (2000, 0), the deviations of the UAV from the reference path found by using the four methods are all larger than 125 m, and the largest occur during the first lap flight. These deviations show that, with the two orthogonal components of the added wind acting on the fuselage axis and the lateral axis of the UAV, the wind from 270° W influences the turning of the UAV dramatically. Moreover, the convergence time by using the method is 25.73 s, which is the longest during the first lap flight. However, the convergence time is moderate by comparing it with those obtained by using the methods and .
Table 3 lists the performance comparison of the polygon path following using the four methods , , , and VF. The segment AB900s means that the UAV only follows part of segment AB during the second flight. The LOPPFs when the UAV follows the segments BC, CD, and EF with the method are the longest. The LOPPFs when the UAV follows the segments AB, DE, FA, and AB900s are moderate compared with those obtained by the other three methods , , and VF. During the 900s’s flight, the total LOPPFs by using the methods , , , and VF are 16,223.55 m, 16,508.06 m, 16,809.59 m and 16,515.96 m, respectively. This indicates that the UAV can fly on the most desired polygon path by using the method .
4.2. Circular Path Following
Figure 11a shows the position comparison while following the circular path using the three methods. The desired circular path is defined as two concentric circles with circle A: , and circle B . The UAV first flew toward circle A. About 180 s later, the UAV started to switch from the position (0, 600) and flew toward circle B with a radius of .
Figure 11.
Comparison of the circular path following using the four methods , , and VF. (a) The position; (b) the distance ; (c) the parameter ; (d) the parameter ; (e) the course rate command ; (f) the bank angle command .
The distance presented in Figure 11b shows that, with the parameter adaptive, the method inherits the advantages of the rapidity of the method and the small overshoot of the method . The error overshoots of for the first circular path following using the three methods , , and are 22.65 m, 11.07 m and 12.52 m, respectively. When switching to fly toward circle B, the error overshoots of using the methods , , and are 14.59 m, 2.25, and 3.03 m, respectively.
The length of the predefined circular path followed (LOPCPF) is defined as the length of the actual flight path after the time that the UAV has converged to the desired circular path. Table 4 lists the LOPCPF, the convergence time, and the error overshoot for the UAV to follow the two circles A and B. It is determined that it takes only 10.60 s for the UAV to converge to circle B using the method . While using the methods and , the convergence times are 20.95 s and 14.83 s, respectively. During the 300 seconds’ flight, the LOPCPF by using the three methods , , , and VF are 5356.88 m, 5662.37 m, 5742.11 m, and 5879.15 m, respectively. The above indicates that the method will still cause the UAV to fly the second most accurately on the desired circular path, with moderate convergence time and error overshoot.
Table 4.
The performance comparison of the circular path following using the four methods.
5. Conclusions
This paper has considered the problem of horizontal curved-path following using fixed-wing UAV. The guidance strategies are derived using a kinematic model of the aircraft and using the Lyapunov stability theory. The control parameters in the guidance law are time-varying and adaptive to the initial states and dynamics of the corresponding nonlinear system. The rules of the time-varying P-like parameter are designed by using an exponential equation shown as (15), where its corresponding parameter is determined by using the fourth order Runge–Kutta algorithm and the bilinear interpolation method. The rules of the time-varying D-like parameter are designed based on the fuzzy logic technique. The stability of the corresponding nonautonomous nonlinear system is also guaranteed. Finally, we have demonstrated the effectiveness of the proposed strategies in a Matlab/Simulink simulation environment with an Aerosonde model. For the given square and circular paths, the method using the adaptive parameters can make the UAV fly more accurately on the target path based on the performance indexes LOPPF and LOPCPF. In the sense of path following, the proposed method provides a methodology that will be applied to realize the better path following of unmanned systems, including aerial, underwater, and ground-based robots.
In the actual flight process, the roll angle command is bounded, which should be considered in the parameter design of the controller. At the same time, if the bank angle command tracking control response of the UAV is very fast, the method described in this paper will be effective. If its response takes a certain time, the closed-loop roll dynamics must be considered in the design of controller. The closed-loop roll dynamics can be expressed as a first-order system. The follow-up research work will further design the path following controller by using the backstepping technique.
In the future, the closed-loop roll dynamics of the bank angle presented by a first-order system with the unmodeled parts will be used to generate the bank angle command in order to make the vehicle follow the predefined path more precisely. The method to estimate the disturbance described in [28] will also be considered to design a robust controller.
Author Contributions
Y.C. has contributed to this paper by carrying out the methodology and formulation, the supporting algorithms, and original draft preparation. N.L. has also contributed to this research by performing the simulations. W.Z. has contributed to this paper by analyzing how the parameters will influence the path-following performance. Y.W. was also involved in the aspect of the revision of the manuscript and in the literature review. His expertise in UAV has contributed towards optimizing the control parameters to improve control performance. Y.C., N.L., W.Z. and Y.W. discussed the results. All authors have read and agreed to the published version of the manuscript.
Funding
This work was supported by the National Natural Science Foundation of China (Grant Nos. 61503172 and 61773194), the Natural Science Foundation of Fujian Province (Grant No. 2020J05197), and the Shenzhen Special Funds for the Construction of High-Level Universities (Grant No. 02326402).
Institutional Review Board Statement
Not applicable.
Informed Consent Statement
Not applicable.
Data Availability Statement
The data presented in this study are available upon request from the corresponding author.
Conflicts of Interest
The authors declare no conflict of interest.
References
- Suo, W.; Wang, M.; Zhang, D.; Qu, Z.; Yu, L. Formation control technology of fixed-wing UAV swarm based on distributed ad hoc network. Appl. Sci. 2022, 12, 535. [Google Scholar] [CrossRef]
- Wilhelm, J.P.; Clem, G. Vector field UAV guidance for path following and obstacle avoidance with minimal deviation. J. Guid. Control Dyn. 2019, 42, 1848–1856. [Google Scholar] [CrossRef]
- Zhao, S.; Wang, X.; Zhang, D.; Shen, L. Curved path following control for fixed-wing unmanned aerial vehicles with control constraint. J. Intell. Robotic Syst. 2018, 89, 107–119. [Google Scholar] [CrossRef]
- Yu, X.; Yang, J.; Li, S. Finite-time path following control for small-scale fixed-wing UAVs under wind disturbances. J. Franklin Inst. 2020, 357, 7879–7903. [Google Scholar] [CrossRef]
- Sun, M.; Zhu, R.; Yang, X. UAV path generation, path following and gimbal control. In Proceedings of the IEEE International Conference on Networking, Sensing and Control, Sanya, China, 6–8 April 2008; pp. 870–873. [Google Scholar]
- Jarrett, C.; Perry, K.; Stol, K.A. Controller comparisons for autonomous railway following with a fixed-wing UAV. In Proceedings of the IEEE International on Automation, Robotics and Applications, Queenstown, New Zealand, 17–19 February 2015; pp. 104–109. [Google Scholar]
- Rhee, I.; Park, S.; Ryoo, C.K. A tight path following algorithm of an UAS based on PID control. In Proceedings of the SICE Annual Conference, Taipei, Taiwan, 18–21 August 2010; pp. 1270–1273. [Google Scholar]
- Ratnoo, A.; Sujit, P.B.; Kothari, M. Optimal path following for high wind flights. In Proceedings of the 18th IFAC World Congress, Milano, Italy, 28 August–2 September 2011; pp. 12985–12990. [Google Scholar]
- Lee, S.; Cho, A.; Kee, C. Integrated waypoint path generation and following of an unmanned aerial vehicle. Aircr. Eng. Aerosp. Technol. 2013, 82, 296–304. [Google Scholar] [CrossRef]
- Cancemi, L.; Innocenti, M.; Pollini, L. Hardware implementation of a fuzzy guidance system with prescribed waypoint approach trajectory. In Proceedings of the American Control Conference, Portland, OR, USA, 4–6 June 2014; pp. 5254–5259. [Google Scholar]
- Back, S.; Cho, G.; Oh, J.; Tran, X.T.; Oh, H. Autonomous UAV trail navigation with obstacle avoidance using deep neural networks. J. Intell. Robotic Syst. 2020, 100, 1195–1211. [Google Scholar] [CrossRef]
- Zhang, Y.; Zhang, Y.; Yu, Z. Path following control for UAV using deep reinforcement learning approach. Guid. Nav. Control 2021, 1, 2150005. [Google Scholar] [CrossRef]
- Sprinkle, J.; Eklund, J.M.; Kim, H.J.; Sastry, S. Encoding aerial pursuit/evasion games with fixed wing aircraft into a nonlinear model predictive tracking controller. In Proceedings of the IEEE International Conference on Decision and Control, Nassau, Bahamas, 14–17 December 2004; pp. 2609–2614. [Google Scholar]
- Slegers, N.; Kyle, J.; Costello, M. Nonlinear model predictive control technique for unmanned air vehicles. J. Guid. Control Dyn. 2006, 29, 1179–1188. [Google Scholar] [CrossRef]
- Hamada, Y.; Tsukamoto, T.; Ishimoto, S. Receding horizon guidance of a small unmanned aerial vehicle for planar reference path following. Aerosp. Sci. Technol. 2018, 77, 129–137. [Google Scholar] [CrossRef]
- Yang, K.; Hedrick, J.K. Linear tracking for a fixed-wing UAV using nonlinear model predictive control. IEEE Trans. Control Syst. Technol. 2007, 17, 1202–1210. [Google Scholar]
- Yang, K.; Kang, Y.; Sukkarieh, S. Adaptive nonlinear model predictive path-following control for a fixed-wing unmanned aerial vehicle. Int. J. Control Autom. Syst. 2013, 11, 65–74. [Google Scholar] [CrossRef]
- Kothari, M.; Postlethwaite, I.; Gu, D. A suboptimal path planning algorithm using rapidly-exploring random trees. Int. J. Aerosp. Innov. 2010, 2, 93–104. [Google Scholar]
- Park, S.; Deyst, J.; How, H.P. Performance and Lyapunov stability of a nonlinear path-following guidance method. J. Guid. Control Dyn. 2007, 30, 1718–1728. [Google Scholar] [CrossRef]
- Nelson, D.R.; Blake, B.D.; Mclain, T.W.; Beard, R.W. Vector field path following for miniature air vehicles. IEEE Trans. Robot. 2007, 23, 519–529. [Google Scholar] [CrossRef] [Green Version]
- Farì, S.; Wang, X.; Roy, S.; Baldi, S. Addressing unmodelled path-following dynamics via adaptive vector field: A UAV test case. IEEE Trans. Aerosp. Electron. Syst. 2019, 56, 1613–1622. [Google Scholar] [CrossRef]
- Zhao, S.; Wang, X.; Lin, Z.; Zhang, D.; Shen, L. Integrating vector field approach and input-to-state stability curved path following for unmanned aerial vehicles. IEEE Trans. Syst. Man Cybern. Syst. 2018, 50, 2897–2904. [Google Scholar] [CrossRef]
- Liang, Y.; Jia, Y.; Wang, Z.; Matsuno, F. Combined vector field approach for planar curved path following with fixed-wing UAVs. In Proceedings of the American Control Conference, Chicago, IL, USA, 1–3 July 2015; pp. 5980–5985. [Google Scholar]
- Liang, Y.; Jia, Y.; Du, J.; Zhang, J. Vector field guidance for three-dimensional curved path following with fixed-wing UAVs. In Proceedings of the American Control Conference, Chicago, IL, USA, 1–3 July 2015; pp. 1187–1192. [Google Scholar]
- Beard, R.W.; Ferrin, J.; Humpherys, J. Fixed wing UAV path following in wind input constraints. IEEE Trans. Control Syst. Technol. 2014, 22, 2103–2117. [Google Scholar] [CrossRef]
- Jung, D.; Tsiotras, P. Bank-to-turn control for a small UAV using backstepping and parameter adaptation. In Proceedings of the 17th IFAC World Congress, Seoul, Korea, 6–11 July 2008; pp. 4406–4411. [Google Scholar]
- Flores, G.; Lugo-Cárdenas, I.; Lozano, R. A nonlinear path-following strategy for a fixed-wing MAV. In Proceedings of the IEEE International Conference on Unmanned Aircraft Systems, Atlanta, GA, USA, 28–31 May 2013; pp. 1014–1021. [Google Scholar]
- Escamilla Núez, H.; Flores, G.; Lozano, R. Robust path following using a small fixed-wing airplane for aerial research. In Proceedings of the IEEE International Conference on Unmanned Aircraft Systems, Denver, CO, USA, 9–12 June 2015; pp. 1270–1278. [Google Scholar]
- Chen, Y.; Wang, T.; Liang, J.; Wang, C.; Xue, C. A fuzzy robust path following controller for a small unmanned air vehicle. In Proceedings of the IEEE International Conference on Industrial Electronics and Applications, Singapore, 18–20 July 2012; pp. 1189–1194. [Google Scholar]
- Wang, T.; Chen, Y.; Liang, J.; Wang, C.; Zhang, Y. Combined of vector field and linear quadratic Gaussian for the path following of a small unmanned helicopter. IET Control Theory Appl. 2012, 6, 2696–2703. [Google Scholar] [CrossRef]
- Khalil, H.K. Nonlinear Systems, 3rd ed.; Prentice-Hall: Upper Saddle River, NJ, USA, 2002; 323p. [Google Scholar]
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations. |
© 2022 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).