Research Article | Open Access

Volume 2018 |Article ID 9235124 | 11 pages | https://doi.org/10.1155/2018/9235124

# Design of Three-Dimensional Path Following Guidance Logic

Revised22 May 2018
Accepted30 May 2018
Published21 Jun 2018

#### Abstract

This paper presents a three-dimensional path following guidance logic. The proposed guidance logic is composed of the guidance law and the motion strategy of virtual target along the desired path. The guidance law makes a vehicle purse the virtual target, and the motion strategy explicitly specifies the motion of virtual target by introducing the concept of the projection point and the tangentially receding distance. The proposed logic is simple and efficient and yet provides precise path following. Numerical simulations are performed to demonstrate the effectiveness of the proposed guidance logic.

#### 1. Introduction

Path following problem is to design a guidance law that will make a vehicle to follow a desired path. The desired path usually consists of consecutive segments which are comprised of circular arc and straight-line path. Path following problem has been a research topic over the last two decades, and many methods have been developed in response to the need for efficient and reliable path following guidance systems. Most of the methods have been developed for the paths in planar motion.

The path following guidance law specifies command acceleration that is applied to the vehicle, and the control law of the vehicle follows the command generated by the guidance law. There are many control methods  for implementing these commands in the vehicle. Although guidance loop and control loop can be designed separately, there are alternative methods for combining both guidance and control loops [2, 3]. However, these methods are usually more complex to use in real applications . This paper is concerned only with guidance loop.

Conventional approach for path following is based on the proportional-integral-derivative (PID) control. This approach relies on the cross-track error, and if the error is small, then linear feedback on the cross-track error provides good performance. Other approach is to construct vector fields surrounding the path so that the vehicle converges to the desired path along the vector field [5, 6]. Global convergence is proved, but this method is not applicable to three-dimensional space paths. Recent common approach  is rewriting the path following problem as the classical line-of-sight guidance problem by specifying a moving virtual target along the desired path. This approach generates a simple guidance law, yet can compensate a large deviation from the desired path. However, the position of virtual target is not easy to determine, and the initial distance between the vehicle and the desired path should be less than the specified distance. Some methods in this approach are still for the paths in planar motion .

Motivated by these observations, a new three-dimensional path following guidance logic is proposed in this paper. The proposed guidance logic is equally applicable to two primitive path types in three-dimensional space: straight-line path and circular path, and might be extendable to any smooth path. Similar to the methods in , the proposed guidance logic also uses a moving virtual target on the desired path; however, the proposed logic explicitly specifies the motion of virtual target by introducing the concept of the projection point and the tangentially receding distance. The proposed logic is simple and efficient, yet provides precise path following.

This paper is organized as follows. In the next section, a three-dimensional engagement geometry of a vehicle and virtual target is presented to formulate the problem, and the guidance law is proposed to pursue this virtual target. In Section 3, the motion of virtual target is specified explicitly according to the position and velocity vectors of the vehicle and the geometry of the desired path. Some linearized stability analyses are also performed. In Section4, numerical simulation results are provided to demonstrate the performance of the proposed guidance logic. Conclusions are given in Section 5.

#### 2. Design of Guidance Law

The proposed path following guidance logic is composed of the guidance law and the motion strategy of virtual target. In this section, the guidance law is firstly described. The guidance law generates command acceleration that is applied to the vehicle.

##### 2.1. Engagement Kinematics

Figure 1 illustrates the overall kinematics of three-dimensional engagement between the vehicle and the virtual target on the desired path. The inertial frame is represented by . and are the position and velocity vectors of the vehicle, respectively; represents the command acceleration vector which is assumed to be perpendicular to the velocity vector of vehicle; and is the relative position vector or line-of-sight (LOS) vector from the vehicle to the target. The position vector and velocity vector of the virtual target will be determined in further sections.

In this framework, the path following guidance law leads the vehicle to pursue a moving virtual target, while the interception of a target is not a goal as in the missile guidance law.

The guidance law in this paper issues an acceleration command which is perpendicular to the velocity vector. Therefore, the speed of the vehicle is not to be constrained by the guidance law but allowed to be controlled independently. This is because path following is required for a vehicle to follow a desired path without any temporal specifications. Note that, on the other hand, trajectory tracking is required to track a time-parameterized trajectory .

##### 2.2. Guidance Law

In a missile community, pure proportional navigation guidance (PPNG) law has been widely used for targeting an enemy target . PPNG tends to keep a constant LOS angle and eventually delivers a missile into a target if the missile speed is sufficiently larger than that of the target. However, PPNG is not considered in path following problem since a constant LOS angle does not guarantee path following, and moreover the relative distance between the target and vehicle is typically kept constant in path following problem.

Pursuit guidance (PG) law has also been used in the missile community. Although it is known to be suboptimal guidance law for intercept purpose , PG can direct the vehicle along the LOS irrespective of the vehicle and target velocities. Therefore, many PG and PG variants are used in recent path following studies with a moving virtual target concept.

In this paper, however, the combined PPNG and PG law is proposed as a path following guidance law as in (1). where and are proportional and pursuit gains, respectively; represents the distance between the vehicle and target; and is the relative velocity vector. The first term of (1) is PPNG law and the second is PG law. Therein, the gain terms and determine the performance of path following and will be further investigated in the next section by using a linear analysis.

The reason of the addition of PPNG to PG is two folds. One is for enhancing damping for a straight-line path and the other is for providing the centripetal acceleration for a circular path. In this way, both paths are successfully followed.

The proof of convergence of PPNG and PG law in three-dimensional space is very difficult and complex mainly due to the much higher complexity of the three-dimensional pursuit dynamics than that of two-dimensional dynamics. Some sufficient conditions can be found in [16, 17] under which a vehicle guided by the three-dimensional guidance law can always intercept a target maneuvering arbitrarily with time-varying normal acceleration.

The next section determines the explicit motion of virtual target.

#### 3. Design of Virtual Target Motion

In this section, the motion of virtual target is explicitly determined for two cases, straight-line path and circular path. The proposed positioning method for the virtual target is conceptually simple and extendible to any smooth path.

##### 3.1. Straight-Line Path

The straight-line path is specified by two waypoint vectors and and a unit direction vector along the straight-line segment connecting waypoints and as shown in Figure 2. The waypoint vector is a position vector to a waypoint from the origin of inertial frame. The point is the projection of the vehicle on the path, and is the receding distance of the virtual target computed along the path starting from . In this way, the virtual target is always ensured to be located on the path. In Figure 2, is the relative position vector of a vehicle from the waypoint .

The speed of the virtual target is determined by the projection of the current velocity vector of a vehicle on the path. Therefore, the position and velocity vectors of the virtual target are computed as

The receding distance between the virtual target and the projection point is the design choice of the proposed guidance logic. The influence of this value can be investigated by the linear analysis using similar method to . Figure 3 shows a linearization situation and the relationship between the vehicle velocity vector and the relative velocity vector , where denotes the cross-track error.

Then, the guidance law of (1) becomes

Assuming that the magnitudes of and are small, then (3) can be written as

Equation (5) resembles the proportional and derivative (PD) control and indicates that the two gains and and the ratio of vehicle speed and the distance for the virtual target behave as the PD control gains. The first term of the right-hand side of the above equation is due to pure proportional navigation guidance (PPNG) law and the second and third terms pursuit guidance (PG) law. Thus, the PPNG law enhances the damping performance. Assuming further , (5) reduces to

Equation (6) shows that the cross-track error dynamics is a second-order system, and the track error eventually goes to zero. The damping ratio and natural frequency are determined by PD control gains, which are and , respectively. For example, if and are chosen, then the damping ratio is and the natural frequency is .

The receding distance also plays a role as a look-ahead distance to detect the end of the path segment. As the vehicle moves, the virtual target also moves along the desired path which consists of consecutive segments. When the receding distance reaches the end of the current segment, a new virtual target position must be selected on the next segment to proceed to the next waypoint .

In this segment switching situation as shown in Figure 4, a new projection point on the next segment is firstly determined, and a new virtual target position is computed at a point on the next path segment that is distant from the new projection point . This segment switching logic is very simple and practical compared to the previous methods in the literatures since no additional methods are required to ensure that the virtual target always exists on the new path segment.

##### 3.2. Circular Path

The circular path is specified by a unit vector for indicating the direction of rotation, a position vector pointing to the centre of the circle, and the circle radius , as shown in Figure 5. The two waypoint vectors and indicate the start and end points of the circular path.

For the circular path following case, a virtual target is proposed to be positioned on the tangent line at the point with a tangential distance ahead of that point, where the point is the projection point of the vehicle position onto the circular path. Note that the virtual target is not positioned on the circular path. In this way, the positioning method of the virtual target maintains consistency with the straight-line path case. Furthermore, this positioning method is very simple and practical compared to the previous methods in which the target is positioned at a point on the circular path, which is usually selected as an intersection point of the circular path and the reference distance from the vehicle .

In Figure 5, a unit direction vector represents a direction of tangent line at the projection point , and is a position vector from the centre of circle to the vehicle.

Then, the position and velocity vectors of the virtual target are expressed as

In (8), a unit direction vector represents a direction from the centre of the circle to the projection point and is given by where represents a projection of the vector onto the circle contained plane. The time derivative terms for the two unit direction vectors in (8) can be calculated by differentiating (10) as which can be further simplified as follows:

Since , differentiating it gives

Substituting (12) and (13) to (8), the velocity vector of the virtual target can be computed as

Note that unlike the straight-line path case, the velocity vector of the virtual target is not along the direction.

As a special case, if the motion of the vehicle initially begins on the circular path with the direction along the tangential unit vector , that is, then the target velocity vector and the relative position and velocity vectors are reduced to and the guidance law in (1) becomes

Therefore, with a proportional gain of , the guidance law produces the command acceleration that is the same with the centripetal acceleration which is appropriate to follow the circle with radius . Note that pursuit guidance (PG) law generates zero command acceleration, which means that PG law makes no contribution in this special case.

The tangentially receding distance between the virtual target and the projection point is also the design choice of the proposed guidance logic. The influence of this value can be investigated by the linear analysis. Figure 6 shows a linearization situation with assumption that the vehicle motion is perturbed from the initial circular path following motion. In Figure 6, denotes the cross-track error, and the relationship between the vehicle velocity vector and the relative velocity vector is also shown.

Assuming that all the vectors are almost in the same plane which contains a circular path and the magnitudes of and are small, then and are satisfied, and the relative velocity vector is approximately expressed as

Therefore, the guidance law of (1) becomes

Assuming also that the magnitudes of and are small, then (19) can be written as

Equation (21) resembles proportional and derivative (PD) control with the forcing term of . The first term of the right-hand side of the above equation is due to pure proportional navigation guidance (PPNG) law, and the second and third terms are due to pursuit guidance (PG) law. Thus, the PPNG law provides the centripetal acceleration, and the PG law plays a role as a PD control. Since the vehicle is approximately in circular motion, holds and (21) is reduced to

Equation (22) implies that with a proportional gain of , the cross-track error dynamics is a second-order system and the track error eventually goes to zero. The damping ratio and natural frequency are determined by two guidance gains and the ratio of the vehicle speed and the tangentially receding distance , which are and , respectively. For example, if and are chosen, then the damping ratio is and the natural frequency is .

The proposed strategy for specifying the motion of virtual target involves computations of position and velocity of the projection point and the receding point on the tangent line at the projection point, which depend on both the velocity of vehicle and the geometry of the desired path. Although more complex computations are expected than the straight-line or circular path, this is conceptually possible to any smooth path.

For example, in case of helical path defined on a vertical cylinder of radius as shown in Figure 7, the position and velocity vectors of virtual target in (8) are modified as where is now a position vector pointing to the instantaneous centre of curvature at the point . The time derivative of is given by a vertical component of the velocity vector of a vehicle as follows:

The time derivative of a unit direction vector in (12) is modified as where is a unit normal vector which is different from the unit tangential vector of the path at the point . The time derivative of in (13) is also modified as where is a pitch of helix.

In this way, the motion of virtual target can be computed according to the geometry of the desired path. Therefore, the proposed guidance logic might be extendable to any smooth path.

#### 4. Simulations

In this section, the numerical simulations are performed to demonstrate the effectiveness of the proposed path following guidance logic. The path of a vehicle is defined in three dimensions and is assumed to be given to the vehicle a priori. It is also assumed that the vehicle is a point mass and is flying at a constant speed of 25 m/sec. The tangentially receding distance is chosen as 200 m, and and are used in simulations.

To illustrate straight-line path following with the proposed guidance logic, three scenarios are considered, and the results are shown in Figures 811. In the first scenario, the vehicle begins at various initial positions and poses and is supposed to fly north along the desired straight-line path at an altitude of 300 m. The initial conditions used in the first scenario are summarized in Table 1. Figure 8 shows that the proposed logic can accommodate large deviations from the desired path, and the vehicle trajectory converges to the path without any following errors. The trajectories of cross-track error are shown in Figure 9.

 Line colour Initial positions (: north, : east, : altitude in meters) Initial headings and flight path angles (deg) Orange Magenta Blue Green Black

As for the next two scenarios, Figure 10 illustrates the ability of the proposed guidance logic to follow straight-line path segments with both obtuse and acute angles. The receding distance detects the end of path segment, and the vehicle performs segment switching maneuver.

If the receding distance is longer, the vehicle will start its segment switching earlier. On the contrary, instead of using the receding distance, if the projection point is used to detect the end of path segment, then over-waypoint transition is possible as shown in Figure 11. Although the transitions show some deviations around the waypoint, the vehicle returns to the next path segment without any following errors.

To illustrate circular path following with the proposed guidance logic, three scenarios are considered and the results are shown in Figures 1215. In the first scenario, the vehicle begins at various initial positions and poses and is supposed to fly along circular path with the circle radius of 500 m at an altitude of 300 m. The initial conditions used in the first scenario are summarized in Table 2. Figure 12 shows that the vehicle trajectory converges to the desired circular path with any following errors. The trajectories of cross-track error are shown in Figure 13.

 Line colour Initial positions (: north, : east, : altitude in meters) Initial headings and flight path angles (deg) Magenta Blue Green Black

To further test the circular path following capabilities of the proposed guidance logic, two more scenarios are simulated. One is for oblique circular paths defined in three-dimensional space and the other is for path transitions between concentric circular paths. In Figure 14, it can be seen that the vehicle trajectories converge to an oblique circular path without any following errors, and Figure 15 shows the vehicle successfully transits and follows two concentric circular paths with varying radii and inclination angles.

Figure 16 illustrates how the proposed guidance logic can track a helical path with any following error. The helical path is defined on a vertical cylinder of radius 500 m, having pitch of m.

#### 5. Conclusions

This paper presents a new simple and efficient three-dimensional path following guidance logic. The proposed guidance logic is composed of the guidance law and the motion strategy of the virtual target along the desired path.

As for the guidance law, the combined pure proportional navigation guidance (PPNG) and pursuit guidance (PG) are proposed. The combined law enhances damping for a straight-line path and provides the centripetal acceleration for a circular path. This guidance law makes a vehicle pursue the virtual target efficiently. As for the motion strategy of the virtual target, the motion is explicitly specified by introducing the concept of the projection point and the tangentially receding distance. Although more complex computations are expected than the straight-line or circular path, the proposed guidance logic is conceptually extendable to any smooth path.

The effectiveness of the proposed logic has been demonstrated by the numerical simulations with various scenarios. For straight-line, circular, and helical paths defined in three-dimensional space, the proposed logic provides precise path following.

#### Data Availability

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

#### Conflicts of Interest

The authors declare that there is no conflict of interest regarding the publication of this paper.

#### Acknowledgments

This work was supported by Sejong University.

1. G. E. Franklin, J. D. Powell, and A. Emami-Naeini, Feedback Control of Dynamic Systems, Prentice–Hall, 2002.
2. M. Rathinam and R. M. Murray, Configuration Flatness of Lagrangian Systems Underactuated by Prentice–Hall, Upper Saddle River, NJ, 2002.
3. E. Johnson, A. Calise, and E. Corban, “A six degree-of-freedom adaptive flight control architecture for trajectory following,” in AIAA Guidance, Navigation, and Control Conference and Exhibit, Monterey, California, August 2002. View at: Publisher Site | Google Scholar
4. D. J. Gates, “Nonlinear path following method,” Journal of Guidance, Control, and Dynamics, vol. 33, no. 2, pp. 321–332, 2010. View at: Publisher Site | Google Scholar
5. D. R. Nelson, D. B. Barber, T. W. McLain, and R. W. Beard, “Vector field path following for miniature air vehicles,” IEEE Transactions on Robotics, vol. 23, no. 3, pp. 519–529, 2007. View at: Publisher Site | Google Scholar
6. D. A. Lawrence, E. W. Frew, and W. J. Pisano, “Lyapunov vector fields for autonomous unmanned aircraft flight control,” Journal of Guidance, Control, and Dynamics, vol. 31, no. 5, pp. 1220–1229, 2008. View at: Publisher Site | Google Scholar
7. V. Cichella, I. Kaminer, V. Dobrokhodov, E. Xargay, N. Hovakimyan, and A. Pascoal, “Geometric 3D path-following control for a fixed-wing UAV on SO(3),” in AIAA Guidance, Navigation, and Control Conference, Portland, Oregon, August 2011. View at: Publisher Site | Google Scholar
8. T. Yamasaki, H. Takano, and Y. Baba, Robust Path-Following for UAV Using Pure Pursuit Guidance, Aerial Vehicles, InTech, 2009. View at: Publisher Site
9. S. Park, Avionics and Control System Development for Mid-Air Rendezvous of Two Unmanned Aerial Vehicles, [Ph.D. thesis], MIT, 2004.
10. S. Park, J. Deyst, and J. P. How, “A new nonlinear guidance logic for trajectory tracking,” in AIAA Guidance, Navigation, and Control Conference and Exhibit, Providence, Rhode Island, August 2004. View at: Publisher Site | Google Scholar
11. G. Ducard, K. C. Kulling, and H. P. Geering, “A simple and adaptive on-line path planning system for a UAV,” in 2007 Mediterranean Conference on Control & Automation, pp. 1–6, Athens, Greece, June 2007. View at: Google Scholar
12. E. D. B. Medagoda and P. W. Gibbens, “Synthetic-waypoint guidance algorithm for following a desired flight trajectory,” Journal of Guidance, Control, and Dynamics, vol. 33, no. 2, pp. 601–606, 2010. View at: Publisher Site | Google Scholar
13. J.-m. Zhang, Q. Li, N. Cheng, and B. Liang, “Nonlinear path-following method for fixed-wing unmanned aerial vehicles,” Journal of Zhejiang University Science C, vol. 14, no. 2, pp. 125–132, 2013. View at: Publisher Site | Google Scholar
14. P. Encarnacao and A. Pascoal, “Combined trajectory tracking and path following: an application to the coordinated control of autonomous marine craft,” in Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228), vol. 1, pp. 964–969, Orlando, FL, USA, December 2001. View at: Publisher Site | Google Scholar
15. P. Zarchan, Tactical and Strategic Missile Guidance, vol. 176, AIAA, 1997.
16. S.-H. Song and I.-J. Ha, “A Lyapunov-like approach to performance analysis of 3-dimensional pure PNG laws,” IEEE Transactions on Aerospace and Electronic Systems, vol. 30, no. 1, pp. 238–248, 1994. View at: Publisher Site | Google Scholar
17. J.-H. Oh and I.-J. Ha, “Capturability of the 3-dimensional pure PNG law,” IEEE Transactions on Aerospace and Electronic Systems, vol. 35, no. 2, pp. 491–503, 1999. View at: Publisher Site | Google Scholar

We are committed to sharing findings related to COVID-19 as quickly and safely as possible. Any author submitting a COVID-19 paper should notify us at help@hindawi.com to ensure their research is fast-tracked and made available on a preprint server as soon as possible. We will be providing unlimited waivers of publication charges for accepted articles related to COVID-19. Sign up here as a reviewer to help fast-track new submissions. 