Research Article  Open Access
Design of ThreeDimensional Path Following Guidance Logic
Abstract
This paper presents a threedimensional 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 straightline 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 [1] 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 [4]. This paper is concerned only with guidance loop.
Conventional approach for path following is based on the proportionalintegralderivative (PID) control. This approach relies on the crosstrack error, and if the error is small, then linear feedback on the crosstrack 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 threedimensional space paths. Recent common approach [7–13] is rewriting the path following problem as the classical lineofsight 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 [9–13].
Motivated by these observations, a new threedimensional path following guidance logic is proposed in this paper. The proposed guidance logic is equally applicable to two primitive path types in threedimensional space: straightline path and circular path, and might be extendable to any smooth path. Similar to the methods in [7–13], 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 threedimensional 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 threedimensional 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 lineofsight (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 timeparameterized trajectory [14].
2.2. Guidance Law
In a missile community, pure proportional navigation guidance (PPNG) law has been widely used for targeting an enemy target [15]. 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 [15], 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 straightline 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 threedimensional space is very difficult and complex mainly due to the much higher complexity of the threedimensional pursuit dynamics than that of twodimensional dynamics. Some sufficient conditions can be found in [16, 17] under which a vehicle guided by the threedimensional guidance law can always intercept a target maneuvering arbitrarily with timevarying 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, straightline path and circular path. The proposed positioning method for the virtual target is conceptually simple and extendible to any smooth path.
3.1. StraightLine Path
The straightline path is specified by two waypoint vectors and and a unit direction vector along the straightline 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 [10]. Figure 3 shows a linearization situation and the relationship between the vehicle velocity vector and the relative velocity vector , where denotes the crosstrack 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 righthand 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 crosstrack error dynamics is a secondorder 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 lookahead 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.
(a)
(b)
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 straightline 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 [9–11].
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 straightline 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 crosstrack 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 righthand 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 crosstrack error dynamics is a secondorder 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 straightline 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 straightline path following with the proposed guidance logic, three scenarios are considered, and the results are shown in Figures 8–11. In the first scenario, the vehicle begins at various initial positions and poses and is supposed to fly north along the desired straightline 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 crosstrack error are shown in Figure 9.
(a)
(b)
(a)
(b)
(a)
(b)

As for the next two scenarios, Figure 10 illustrates the ability of the proposed guidance logic to follow straightline 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 overwaypoint 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 12–15. 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 crosstrack error are shown in Figure 13.
(a)
(b)
(a)
(b)
(a)
(b)

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 threedimensional 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.
(a)
(b)
(c)
5. Conclusions
This paper presents a new simple and efficient threedimensional 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 straightline 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 straightline 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 straightline, circular, and helical paths defined in threedimensional 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.
References
 G. E. Franklin, J. D. Powell, and A. EmamiNaeini, Feedback Control of Dynamic Systems, Prentice–Hall, 2002.
 M. Rathinam and R. M. Murray, Configuration Flatness of Lagrangian Systems Underactuated by Prentice–Hall, Upper Saddle River, NJ, 2002.
 E. Johnson, A. Calise, and E. Corban, “A six degreeoffreedom 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
 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
 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
 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
 V. Cichella, I. Kaminer, V. Dobrokhodov, E. Xargay, N. Hovakimyan, and A. Pascoal, “Geometric 3D pathfollowing control for a fixedwing UAV on SO(3),” in AIAA Guidance, Navigation, and Control Conference, Portland, Oregon, August 2011. View at: Publisher Site  Google Scholar
 T. Yamasaki, H. Takano, and Y. Baba, Robust PathFollowing for UAV Using Pure Pursuit Guidance, Aerial Vehicles, InTech, 2009. View at: Publisher Site
 S. Park, Avionics and Control System Development for MidAir Rendezvous of Two Unmanned Aerial Vehicles, [Ph.D. thesis], MIT, 2004.
 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
 G. Ducard, K. C. Kulling, and H. P. Geering, “A simple and adaptive online path planning system for a UAV,” in 2007 Mediterranean Conference on Control & Automation, pp. 1–6, Athens, Greece, June 2007. View at: Google Scholar
 E. D. B. Medagoda and P. W. Gibbens, “Syntheticwaypoint 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
 J.m. Zhang, Q. Li, N. Cheng, and B. Liang, “Nonlinear pathfollowing method for fixedwing unmanned aerial vehicles,” Journal of Zhejiang University Science C, vol. 14, no. 2, pp. 125–132, 2013. View at: Publisher Site  Google Scholar
 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
 P. Zarchan, Tactical and Strategic Missile Guidance, vol. 176, AIAA, 1997.
 S.H. Song and I.J. Ha, “A Lyapunovlike approach to performance analysis of 3dimensional pure PNG laws,” IEEE Transactions on Aerospace and Electronic Systems, vol. 30, no. 1, pp. 238–248, 1994. View at: Publisher Site  Google Scholar
 J.H. Oh and I.J. Ha, “Capturability of the 3dimensional pure PNG law,” IEEE Transactions on Aerospace and Electronic Systems, vol. 35, no. 2, pp. 491–503, 1999. View at: Publisher Site  Google Scholar
Copyright
Copyright © 2018 Sungsu Park. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.