Abstract

This study investigates a guidance method that will allow the small unmanned helicopter to follow the predefined horizontal smooth path. A stable nonlinear guidance law, which needs the information of the inertial position and groundspeed of the helicopter and the implicit function of the desired path, is designed to generate the reference course rate command based on the concept of the vector field. The asymptotic approximation to the desired path with bounded following errors has also been demonstrated by using the Lyapunov stability arguments. Some conditions for guaranteeing the stability have been extended. Simulations on following four types of planar paths, i.e., the square, circular, elliptic, and cubic curve paths, have verified the effectiveness of the proposed method. The predefined square path following performance of the proposed vector field-based method is compared with another two guidance laws, which are based on the PD-like and fuzzy logic control. The comparison shows that the proposed method can guide the helicopter to follow the predefined path most smoothly. The maximum overshoot by using the proposed method is less than 0.016 meters, while those by using the other two methods are all larger than 0.80 meters. Moreover, the vector field-based method will cost the least time for the vehicle to converge to the predefined path.

1. Introduction

Small unmanned aerial vehicles including the fixed-wing [1], quadrotors [2], and helicopter [3] have been studied and applied in military and civilian fields in past decades. The unmanned helicopters have attracted many researchers because they can fly vertically and manoeuvre in narrow spaces, especially hovering over interesting areas [3], such as the scene of the residential structure fire, the high-voltage transmission tower, and the damage position of the bridge. In the aspects of research, the vision-aided navigation and control of unmanned helicopters [4, 5], conflict-free navigation [6], monocular vision based indoor flight [7], and cooperative control of multiple unmanned helicopters [8] have appeared in recent years. It needs the vehicle to have the ability to follow (or track) the predefined path (or trajectory) precisely to realize the autonomous or automatic control of its own.

According to the model-based controller structure, the approaches to realize the path following or trajectory tracking control of a small unmanned helicopter can be divided into two main categories. One approach uses an integrated method to solve the helicopter’s guidance and control problem simultaneously. The alternative method adopts the hierarchical control architecture to separate the above problem into an inner loop for stabilizing its dynamics and an outer loop for guidance.

The integrated method to realize the path following or trajectory tracking mostly appears on the nonlinear control techniques. Zhou et al. applied the concept of backstepping control for the helicopter in continuous time [9] to track the predefined position and yaw reference trajectories. Razzaghian and Kardehi Moghaddam applied the nonlinear fuzzy sliding mode control method to the trajectory control of the helicopter with the help of a dynamic inverter [10]. Tsai et al. combined the fuzzy basis function networks and the backstepping technique to reach the design of an intelligent adaptive tracking controller, where its performance was also compared with a numerical neural network controller [11, 12]. Benitez-Morales et al. [13] applied the feedback linearization control methodology for the trajectory tracking of a small helicopter’s nonlinear longitudinal dynamics in simulation. Kim and Shim used the nonlinear model predictive control (MPC) method to track the predefined trajectory where the nonlinear model contains the kinematics and the system specific dynamics [14]. The application of the MPC method for realizing the path tracking in unknown and cluttered environments was also discussed in [15]. While applying the nonlinear control methods, it needs good knowledge of the vehicle’s nonlinear model. Furthermore, the backstepping and fuzzy technique will mostly introduce new parameters and transformed variables. The computation of the neural network and model predictive control is large. All of the above make them difficult to be used in the low-cost avionics systems.

While applying the separate inner and outer loop approach, the inner loop control usually uses the simple and well-established design methods. For guidance design, the traditional proportion integration differentiation (PID) controllers are used due to its simple structure and effectiveness [16, 17]. And it is mostly used in the lateral/longitudinal manoeuvres by reducing the lateral deviation from a desired fight path. Two Mamdani-type fuzzy controllers were used to handle the lateral/longitudinal control, respectively, in [18]. The robust control techniques have also been applied in the guidance loop design. A Kalman-filter based linear quadratic integral (LQI) controller was used for the position controller design by considering the characteristics of the inner attitude closed-loop dynamics [19]. Bergerman et al. adopted the FLC method together with the simple PD controller for the position and heading control of a helicopter [20]. The authors of reference [21] developed a composite nonlinear feedback control technique to achieve a high-performance position control. Part of the technique is based on the linear H2/H∞ optimization method. The robust control techniques are useful for the outer loop design. However, it needs much more calculation due to its higher order compared with the simple PID technique. Marantos et al. proposed a robust control scheme that is decomposed into a position and an attitude control module, operating in a cascaded form with low complexity [22]. Ma and Huo applied the hierarchical inner-outer loop structure to realize the singularity-free path following control of an unmanned helicopter. The outer-loop position controller is constructed with the hyperbolic tangent function [23].

Considering the controller structure and the purpose of the horizontal path following of a small unmanned helicopter with low-cost avionics, we adopted the hierarchical control architecture for the flight control system design. The unstable dynamics of the helicopter have been stabilized by the setpoint tracking LQG control technique [24]. The LQG technique can also track the reference heading rate and velocities in the body-fixed coordinate frame.

The core part of the outer loop is based on the concept of the vector field which has been successfully applied in miniature aerial vehicles to generate the commanded course rate [25]. The method calculates a vector field around the path to be followed. The vectors in the field are directed toward the path to be followed and represent the desired direction of flight. And it has realized the waypoint path following and collision avoidance for the vehicles in the simulation and real flight tests [26, 27]. In [25], the straight-line and circular orbit paths following approaches have been provided. However, in some cases, the route of an aircraft is a more complex smooth curve. In order to follow the general horizontal smooth paths that can be expressed by implicit functions, including the ellipse and cubic curve, a general smooth path following guidance law based on the concept of the vector field has been produced for a small unmanned helicopter in this study.

The main contributions of this study are summarized as follows: First, a guidance law based on the vector field for following a class of horizontal paths is presented in the Cartesian coordinate system. The stability of the path following with bounded following errors is demonstrated by the Lyapunov stability arguments. Second, some conditions for guaranteeing the stability have been extended by comparing with those appeared in [24]. The simulations about tracking the square, quadratic, and cubic curves were presented to evaluate the effectiveness of proposed method. The following performance of the square path was compared with those by using another tow guidance laws. Third, the control results were compared with another two guidance laws based on the PD-like and fuzzy logic control, which illustrates the effectiveness and better performance of the proposed control strategies.

The remainder of the paper is organized as follows: The formal problem description for a small unmanned helicopter to follow a predefined smooth path was given in Section 2. In Section 3, the course rate command is generated based on the concept of the vector field. The detailed stability analysis is also given. In Section 4, the simulation details on four types of planar paths are presented. The conclusion and future work are given in Section 5.

2. Problem Description

The helicopter adopts the hierarchical control architecture for the planar smooth path following. Figure 1 shows the structure of the control system. The inner-loop controller is used not only to stabilize the helicopter dynamics but also track the reference signals from outputs of the outer-loop controller. The outer-loop controller design is based on the inertial positions and velocity of the helicopter and the desired path from the path generator. And it is used to generate the desired heading rate and velocities.

In Figure 1, denotes the position of the center of gravity of the helicopter in the local north-east-down, Cartesian coordinates [20]. , , , and denote the reference velocities and the heading rate in the body-fixed coordinates, respectively.

The design of the inner-loop controller is based on the helicopter’s dynamics. And a setpoint LQG technique [24] with the combination of an LQR and a linear quadratic estimator is used not only to stabilize the internal stability of the unmanned helicopter but also to track the reference signals , , , and .

The outer-loop controller design is separated into two parts which are used to produce the reference velocities and the heading rate command, respectively. The vertical reference velocity design is based on the PI method. In this paper, we only consider the reference heading rate command generator. The following two assumptions are adopted:

Assumption 1. The set altitude of the helicopter was well controlled. It means that the flight path of the vehicle is on the horizontal plane with a certain height in the local coordinate system.

Assumption 2. The heading of the flying vehicle is assumed to be equal to its course (see Figure 2). If the helicopter is working in the low-speed flight mode, it has [20]. Then, the reference heading rate can be generated as the course rate command shown in (2), i.e., .
In this study, the desired horizontal smooth path is presented by a twice continuously differentiable implicit function as follows:where and . To generate the heading (course) rate command, the kinematics of the helicopter in the inertial north-east frame is used, and it is given as follows:where the groundspeed . and are positive constants.
Considering that the desired path (1) is the generic curve, it is difficult to express the explicit Euclidean distance between the position of the helicopter and the generic curve-based path mostly. The value when the UAV is in is used as the distance value. In this study, the nominal distance function is defined as . The value of can represent the position of the helicopter relative to the desired path. If , it means that the helicopter is on the path. Moreover, it can distinguish whether the helicopter is within the curve when the curve is closed or the helicopter is on the right half-plane of the curve when the curve is not closed.
The following is to design the heading (course) rate command which will make the helicopter fly along the desired path in the right direction.

3. Vector Field-Based Nonlinear Guidance Law

The magnitude gradient of in point is denoted as , where and are the partial derivatives of or ) with respect to and , respectively. For some given , the value of may be zero in some points . If the helicopter’s initial position is at these points, the guidance to be designed below will fail, and the helicopter will lose control. In order to avoid the helicopter being trapped at the center point of the closed curve (such as the center of a circle or ellipse), the flight domain for the helicopter is defined as , where defines the size of the no-fly zone.

The desired course is defined as follows:where is a odd function which is strictly monotonic increasing over with for all . Another property of is that its derivative, i.e., , is monotonic decreasing over . Then, it has the fact that is monotonic increasing over , , and for . is defined as , and it has the fact that

The desired course shown in (3) has two parts: and . If the helicopter is on the desired path , then , and is the tangent direction of the desired path. If the helicopter is far away from the desired path, then . Together with the property of , the desired course is to guide the helicopter approach the desired path with the course angle from to . For example, if the helicopter is far away from a desired straight-line path, then . In this case, the desired course is , which is to make the helicopter fly vertically to the desired straight-line path.

Figure 2 shows the corresponding vector field derived from (1)–(3), where the curve is straight line, circle, ellipse, and cubic curve, respectively. The ground velocity in the horizontal plane is chosen as . The function in (3) is chosen as with . The implicit functions of the straight line, circular, elliptic, and cubic curve paths in Figure 2 are , , , and , respectively. The goal is that the helicopter can follow the vector towards the desired path at its current position.

The state variables are defined as , where . The dynamics of the variables can be derived as follows:

The main purpose of this study is to find the course rate command , which will make the errors and converge to zeros as the time goes to infinity, i.e., make the helicopter fly along the desired path with bounded errors in finite time.

Theorem 1. If the flying helicopter’s initial position is not on the desired path but within the flight domain , the course rate command shown as (6), which is a nonlinear combination of the course error and the time derivative of the desired course shown as (3), will make the helicopter approach the desired path with the desired course and fly along the desired path with bounded errors in finite time.

where and . The parameters satisfy the following conditions: , , and with , and the positive value is arbitrary chosen. The conditions are different with those in [24]. The saturation function is defined as follows:

Proof. Substitute shown as (6) into (5), thenIt can be found that the equilibrium point of the nonlinear system (8) is .
Let , and the boundary region around the sliding surface with respect to is defined as . Then, the derivative of is as follows:So, if , then , and it gets that will reach in finite time. It remains to show that, inside , system (8) will converge to the equilibrium point . The Lyapunov candidate function is defined as follows:Differentiating with respect to time, it hasInside the boundary region , it has . So,Let , andwhere , , and is arbitrary. It has the fact that both and are symmetric functions in , and . It is noted that the function defined here is different from that appeared in [24], which will extend the condition for the stability.
When , then , andIf , then .
When , then and . If , it derives that . So while and , then for in .
Figure 3 shows the plot comparison of the function and with , , and . The blue solid line is the plot of function with respect to . The red dashed line is the plot of function as shown in [24]. The black dotted line is the plot of one of feasible functions with in this paper. In fact, , and the function in [24] is the special case of (13).
Furthermore, if and , when , thenIt derives that, when , the control law (6) will make reach in finite time.
When , thenwhere the matrix  =  is positive definite. It has the fact that the function is continuous positive definite. Then, it derives that the equilibrium point of the nonlinear system (8) is uniformly asymptotically stable [28].
Thus, if , , and , with the arbitrary chosen value . It can state that the control law (6) will make the helicopter fly along the desired path with bounded errors in finite time. And the path following errors (the distance and course error) will converge to zeros as the time goes to infinity.

4. Simulations

This section presents the simulations of the proposed vector field-based guidance law for the path following of an ALIGN T-Rex 600 RC model helicopter (see Figure 4). The helicopter was instrumented with avionics weights 4.9 kg. For simulation, the detailed inner-loop controller design together with the linear model of the helicopter can be seen in [24]. And we choose , , and , respectively. The local earth-fixed coordinate system is defined to follow the north-east-down convention. The forward and sideway reference velocities along the body axis of the helicopter were set as and , respectively. The simulation sample time was set as 20 ms.

While conducting the simulations, we applied the proposed method to follow four types of planar paths, i.e., the square, circular, elliptic, and cubic curve paths in the Matlab/Simulink GUI environment, respectively. The helicopter flied in a counter clockwise direction.

4.1. Square Path Following

In this section, another two guidance laws have also been applied to follow the square path. The results will be compared to show the performance of the proposed vector field-based method. The first one for comparison is a PD-like nonlinear control law (PD_PFC) [29] shown as follows:where and are the constant parameters, and the signed value denotes the vertical distance from the current position of the vehicle to the desired straight line.

The other guidance law has the same expression as PD_PFC, but the parameter is adjusted by the fuzzy logic (FC_PFC). The structure of the FC_PFC is shown in Figure 5, and the control parameter is given as follows:where is a constant, and is the tuning part for . In the design of fuzzy control logic, the domains of discourse for the two inputs ( and ) and the output are set as [−6, 6], [−3, 3], and [−0.09, 0.09], respectively. The details of the membership functions and the rules for the design of the fuzzy logic unit can be seen in [29]. In this study, we choose and , respectively. Then, , according to the fuzzy control mechanism shown in [29]. In this case, the control law shown FC_PFC can make the helicopter fly along the predefined straight-line path.

The initial position of the small unmanned helicopter was set as (5, 40, −20) in the local north-east-down frame, and its initial heading was set as 90° east. The predefined square path has four waypoints, (A (0, 0, −20), B (0, 80, −20), C (80, 0, −20), and D (80, 80, −20)), as shown in Figure 6(a). Figure 6(b) shows the path following comparison with the three methods, PD_PFC, FC_PFC, and the vector field in the horizontal plane.

Figure 7 shows the comparison of the deviation when the helicopter follows the square path with the methods PD_PFC, FC_PFC, and the vector field. While doing the waypoint switch, the helicopter will switch route if the distance between the position of the vehicle and the next waypoint is less than 8 m. This mechanism causes the abrupt changes of with about 8 meters. Figure 7 also shows that the proposed vector field method will make the helicopter reach much smoother transition of course with smaller overshoot and oscillation amplitude of than those by using the other two methods, PD_PFC and FC_PFC.

Figure 8 shows the comparison of the course rate command with the methods PD_PFC, FC_PFC, and the vector field. When the route is switched, compared with the other two methods, PD_PFC and FC_PFC, the course rate command generated by using the method vector field can converge to zero most quickly, which means that the method can make the helicopter fly along the target route most quickly. Figures 9 and 10 show the and in (3) while following the predefined square path. The corresponding value ranges are (0, 1.27) and (0, 4.71), respectively.

Table 1 presents the comparison of the maximum overshoots, rise time, and convergence time displayed in the elliptic areas, (a), (b), (c), (d), (e), and (f) of Figure 7. The rise time refers to the length of time that the helicopter flies toward the straight line before the first time becomes less than 0.4 meters. The convergence time is defined as the time from the helicopter following the desired path until is less than 0.4 meters. It can be seen that the maximum overshoot by using the method vector field is less than 0.016 meters, while that by using the method FC_PFC is within the range of 0.81∼0.87 meters. The maximum overshoot produced by using the method PD_PFC is about 1.9 meters, which is the largest. The method PD_PFC has the shortest rise time, which is about 2.64 s. While using the methods, the vector field and FC_PFC, the corresponding rise times are about 3.66 s and 3.5 s, respectively. However, the convergence times by using the method vector field are all less than 3.72 s. The corresponding convergence times by using the methods FC_PFC and PD_PFC are all lager than 7.30 s.

Table 2 shows the average and the standard deviation values of the distance of the three methods, respectively. The comparison of the standard deviation values and the maximum overshoots show that the vector field method makes the helicopter to follow the predefined path most smoothly. The mean value of by using the method vector field is the largest. This is because almost all of the helicopter's flight is inside the square by using the method vector field. While using the methods PD_PFC and FC_PFC, the helicopter will fly across the path during its turning.

Table 3 shows the comparison of the flight time of each route with the three methods. It can be shown that the method PD_PFC will cost the most time to complete each route. Table 4 shows the comparison of the moment when the vehicle starts to turn with the three methods. It shows that the method vector field will make the helicopter switch the waypoints firstly.

It means that it takes the least time for the helicopter with the method of the vector field to reach the waypoints.

Table 3 shows the comparison of the flight time of each route with the three methods. It can be shown that the method PD_PFC will cost the most time to complete each route. Table 4 shows the comparison of the moment when the vehicle starts to turn with the three methods. It shows that the method vector field will make the helicopter switch the waypoints firstly. It means that it takes the least time for the helicopter with the method of the vector field to reach the waypoints.

The above indicates that the method vector field can achieve the best path following of the predefined square path than those by using the methods PD_PFC and FC_PFC. Although the method PD_PFC has the performance of the shortest rise time, it has the largest overshoot, convergence time, and oscillation amplitude. With the parameter adjusted by the fuzzy logic, the method FC_PFC can follow the square path better than that by using the method PD_PFC. But the design of the fuzzy rules of the method FC_PFC is limited. The fuzzy rules cannot be fully considered. It makes the FC_PFC still have a larger overshoot than those by using the method vector field. And it takes more flight time for the vehicle to reach the goal with the method FC_PFC than that by using the method vector field. In comparison, the control law designed by using the method vector field is based on the smooth transition to the predefined path firstly. And it makes the method vector field have the best advantage.

4.2. Quadratic and Cubic Curve Path Following

The circle and ellipse are chosen as the predefined paths in this section. The initial position of the small unmanned helicopter was set as (40, 25, −20) in the local north-east-down coordinate. The functions of the predefined circle and ellipse are and , respectively. Figures 11(a) and 12(a) show that the helicopter will follow the predefined quadratic paths after the approximation of transition. Figures 11(b) and 12(b) show that the nominal distance will approach zero with the bounded following error in finite time. Figure 11(c) shows that the course rate command generated by the method vector field will approach 0.1 rad/s while the helicopter is flying along the circle path with a radius of 30 meters at a speed of 3 m/s. Since the curvature of each point on the ellipse is not the same, Figure 12(c) shows that the course rate command generated for the ellipse path following varies periodically while the helicopter is flying along the ellipse round and round.

For cubic curve path following, the function of the predefined cubic curve is . The initial position of the small unmanned helicopter was set as (−30, −15, −20) in the local north-east-down coordinate. Figure 13(a) shows that the helicopter will follow the predefined cubic path after it has reach the path. The nominal distance shown in Figure 13(b) indicates that there is no overshoot when the helicopter flies towards the cubic path.

5. Conclusions

The guidance of the helicopter to realize the horizontal desired path following has been designed based on the concept of the vector field. The guidance law only needs the inertial information of the helicopter including the position and velocity in the north-east frame and the implicit function of the desired path. The asymptotic stability analysis of the horizontal smooth path following with bounded errors has also been given. Compared with the work in [25], the flight paths have been extended to a class of the smooth curve which can be expressed by implicit functions. Compared with the work in [24], the conditions for the stability of the proposed vector field guidance method have been extended.

Simulations on following four types of planar paths, i.e., the square, circular, elliptic, and cubic curve paths, have verified the effectiveness of the proposed method. Furthermore, another two PD-like nonlinear control laws, PD_PFC and FC_PFC, were also applied to the square path following. The comparison shows that the method vector field has the best path following performance. The helicopter will arrive each waypoint and converge to the next route with the shortest arrival time by using the method vector field. Additionally, the simulation flight path produced by using the method vector field is the smoothest with the smallest overshoot. The guidance law designed in this paper can also be applied in the guidance of UGV and other types of UAV working in the horizontal plane.

It can be found that the function in (3) will influence the process that the helicopter reaches the sliding surface. In the future, a suitable function with satisfactory parameters designed will be studied to make the helicopter follow a serial of smooth paths better. Additionally, since the ground velocity in the horizontal plane can vary within , another control law to adjust the velocity considering the convergence rate of different kinds of path will also be invested.

When there is external interference, especially the wind is larger enough, the assumption that the heading of the flying vehicle is equal to its course cannot be guaranteed. In this case, the kinematic model shown as (2) is not suitable for generating the heading rate command. The kinematic model which is the function of the heading, airspeed, and wind speed [25] will be used to generate the heading rate command.

Data Availability

The labeled data used to support the findings of this study are available from the corresponding author upon request.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

Acknowledgments

This work was supported by the National Natural Science Foundation of China (grant no. 61503172), 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).