# A Three-Dimensional Guidance Logic for Continuous Curvature Path Following

Authors: Sungsu Park
Journal: International Journal of Aerospace Engineering
 (2019)

---

## Abstract

A new simple and practical guidance logic is proposed for a vehicle to follow a general continuous curvature path defined in a three-dimensional space. The proposed guidance logic is formulated in such a way that the guidance law is to generate the command acceleration such that a vehicle pursues the designed moving virtual target, and this eventually makes a vehicle to follow a desired path. The position and velocity of the virtual target are specified explicitly by introducing the concept of the projection point and the tangentially receding distance. Numerical simulations are conducted to evaluate the precise path-following capability of the proposed guidance logic.


---

## Body

## 1. Introduction

The objective of path following is to ensure a vehicle to follow a desired path without any temporal requirements [1]. Path following is an important capability of a moving vehicle, and its relevant applications can be found in wheeled robots [1], unmanned aerial vehicles [2–5], airships [6], and spacecraft [7].A smooth path is preferable to most moving vehicles since nonsmooth motions cannot be performed without stopping and hovering capabilities of a vehicle [8]. Although some mobile robots and flying vehicles can stop or hover at a certain point, this increases the driving or flight time and may result in degraded navigation performance. A smooth path is typically the concatenation of two primitive paths: straight-line path and circular path. Smooth transitions with continuous curvature at the junction of two primitive paths are also essential for a path to be smoothly executed by a vehicle, avoiding sudden changes in the acceleration and ensuring a smooth driving or flying [9, 10]. A continuous curvature path is generated by the path planning algorithm with consideration of both the physical constraints of a vehicle and environmental constraints [11]. The continuous curvature path planning has gained a great deal of attention, and many researchers have proposed planning algorithms, which can be found in the literatures [8–13].Once the path is generated by a path-planning algorithm, a path-following guidance algorithm is designed for a vehicle to follow the desired path. Many path-following guidance algorithms are available in the literatures, which include the conventional proportional-integral-derivative (PID) control-based method, vector field construction method [14–16], and virtual target-based method [1, 3–5, 17–22]. A comparative study between some of path-following guidance algorithms can be found in [23]. Among them, a virtual target-based method is under consideration in this paper, and this method is positioning a moving virtual target along the desired path and using the guidance or control law to follow the virtual target. Park et al. [17, 18] and Ducard et al. [19] proposed a method in which the virtual target moves along the path at a fixed distance ahead of the vehicle, which is called the look-ahead point. However, it needs another logic to ensure the distance is long enough to intersect the desired path, and it is difficult to calculate the intersection point. Moreover, the velocity of the virtual target is not explicitly determined. Cho et al. [20] extended the concept of the look-ahead point further to the look-ahead angle and proposed a new three-dimensional nonlinear path-following guidance law for differential geometric path. However, the look-ahead angle should satisfy several conditions, and it requires the radius of the virtual tube that envelops the entire path. Gates [21] determined the motion of the virtual target indirectly by introducing fictitious forces between the vehicle and the virtual target. However, this method generates complicated guidance command as pointed out in [22]. Typically, a virtual target method generates a nonlinear guidance law and can compensate a large deviation from the desired path. However, some methods in this approach are still for the paths in planar motion and are only applicable to primitive paths and their combinations, and the position and velocity of virtual target on a general three-dimensional path are not easy to determine. Park [24] proposed a new path-following guidance logic composed of the guidance law and the motion strategy of the virtual target. The guidance law is the combined pure proportional navigation guidance (PPNG) and pursuit guidance (PG) law, 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 interesting aspect of this logic is that the virtual target is not always on the desired path. The proposed logic is simple and efficient, yet provides precise path following. However, the guidance logic was designed for only regular paths such as a straight-line, circular, and helical paths.In this paper, a new extended guidance logic is presented for a continuous curvature path following based on our previous work [24]. The proposed guidance logic is general in the sense that it can be applied to any continuous curvature path in a three-dimensional space and includes the guidance logic proposed in [24] as a special case. Yet, it allows conceptually easy and practical way to determine the position and velocity of virtual target even when the desired path is a complicated curve and provides precise path following.This paper is organized as follows. In the next section, a three-dimensional geometry of a continuous curvature path is presented as preliminaries to derive the proposed kinematics of a virtual target. In Section3, the guidance law is proposed with the combined pure proportional navigation guidance (PPNG) and pursuit guidance (PG) law. In Section 4, the motion of virtual target is specified explicitly as a function of the geometry of the desired path and position and velocity vectors of the vehicle. It starts with a general continuous curvature path and moves on to special paths such as a straight-line path and a circular path. In Section 5, numerical simulations are performed to demonstrate the performance of the proposed guidance logic. Conclusions are given in Section 6.


## 2. Geometry of a Continuous Curvature Path

A typical parametric representation of pathrp in a three-dimensional space is given by [25].
(1)rpl=xli1+yli2+zli3,where l is a parameter which may denote arc length, angle, or something else, and x,y,z are Cartesian components along the unit direction vectors i1,i2,i3 of inertial frame i as illustrated in Figure 1. The use of parametric representation of a continuous curvature path is essential in deriving the proposed kinematics of a virtual target.Figure 1
Parametric representation of a general path.Ifrpl is differentiable, the unit tangent vector et of a path at some point D, which is represented by rD=rpl0, is given by
(2)etl=drpl/dldrpl/dl,where the derivative is evaluated at l=l0, and ∣·∣ denotes the magnitude of a vector. The curvature κ of a path at point D is expressed in terms of the first and the second derivatives of rpl and is given by
(3)κl=drpl/dl×d2rpl/dl2drpl/dl3.For a continuous curvature path, a path-planning algorithm should generate at least a second-order differentiable path. The arc lengths along a path is calculated by the following integral.
(4)s=∫0ldrpdldl.Although the actual evaluation of equation (4) is difficult in general, the use of arc length s as a parameter instead of l in equation (1) simplifies various formulas. For example, the unit tangent vector in equation (2) is simply obtained as the following form.
(5)ets=drpsds.The curvature in equation (3) is also simplified as
(6)κs=detsds.Since the curvature is nonnegative by definition, it is necessary to indicate the direction to the instantaneous center of curvature atD. The unit principal normal vector en gives this direction and is defined by
(7)ens=dets/dsdets/ds=1κsdetsds.The unit principal normal vector can be equivalently represented with parameterl as follows.
(8)enl=d2rpl/dl2−d2s/dl2etlκlds/dl2,where
(9)dsdl=drpldl,d2sdl2=drpl/dl·d2rpl/dl2ds/dl.


## 3. Design of Guidance Law

The proposed path-following guidance logic is composed of the guidance law and the motion strategy of virtual target. The goal of the guidance logic here is to generate the command acceleration such that a vehicle pursues the moving virtual target and eventually enables a vehicle to follow a desired path. This is an important difference compared to that of the missile guidance law in which the goal is to intercept a target.Figure2 illustrates the three-dimensional pursuit geometry of the vehicle and virtual target. In Figure 2, rm and vm denote the position and velocity vectors of the vehicle, respectively, am represents the command acceleration vector which is assumed to be perpendicular to the velocity vector of vehicle, and r is the relative position vector from a vehicle to the target. The position vector rt and velocity vector vt of the virtual target will be determined in the next section. Typically, pursuit guidance (PG) law and its variants have been used in recent path-following studies with a moving virtual target concept, because PG can direct the vehicle along the line-of-sight (LOS) irrespective of the vehicle and target velocities [3, 5]. However, in our previous work [24], the combined pure proportional navigation guidance (PPNG) and PG law was proposed as a path-following guidance law as in
(10)am=Nr×vR2×vm−hNr×vmR2×vm,where N>0 and h>0 are proportional and pursuit gains, respectively, R represents the distance between the vehicle and target, and v=vt−vm is the relative velocity vector. The first term of equation (10) is the PPNG law, and the second is the PG law. PPNG and PG laws are widely used in missile community due to their easy implementation and effectiveness [26]. PPNG keeps a constant LOS angle, and PG directs a missile along the LOS [27]. The reason for using the combined PPNG and PG is that the PPNG law can provide the instantaneous centripetal acceleration to a vehicle while the PG law can direct the vehicle along LOS in our framework of path-following guidance logic. This will be further investigated in the next section as well as roles of gain terms N and h by using a linear analysis.Figure 2
Pursuit geometry of the vehicle and virtual target.


## 4. Design of Virtual Target Motion

The proposed strategy for specifying the motion of virtual target in our previous work [24] is simple and practical. In this strategy, a virtual target is proposed to be positioned on the tangent line at the point D with a tangentially receding distance R0 ahead of that point as illustrated in Figure 3, where the point D is the nearest projection point of a vehicle position onto the desired path. Note that the virtual target is not positioned on the path, which is the main difference between the proposed and the conventional methods.Figure 3
Continuous curvature path following.The velocity of a virtual target is computed using the velocity of the projection point, which depends on both the velocity of vehicle and the geometry of desired path. In this paper, the desired path is assumed to be designed by a path-planning algorithm such that it satisfies the maximum curvature constraint of the vehicle considering the vehicle maneuvering limitations.In this section, the strategy of [24] is extended to a general continuous curvature path, and the motion of virtual target is explicitly determined as a function of the geometry of the desired path and position and velocity vectors of a vehicle. It starts with a general continuous curvature path and moves on to special paths such as a straight-line path and a circular path.


### 4.1. General Continuous Curvature Path

The nearest projection pointD of a vehicle current position onto the desired path can be computed by minimizing the following function.
(11)J=12rpl−rm·rpl−rm.Taking the derivative ofJ with respect to the parameter l and setting it to zero gives
(12)0=dJdl=rpl−rm·dsdletor
(13)0=dJdl=rpl−rm·dsdlet.Therefore, the relative position vector from a vehicle to the nearest projection pointrpl−rm is perpendicular to the unit tangent vector et at the nearest projection point. To find the parameter l that minimizes the function, a gradient descent method may be used. This method starts with some initial guess of l and repeatedly performs the following update.
(14)l←l−βrpl−rm·dsdlet,where β>0 is the step size. The gradient descent may take many iterations to compute a minimum value depending on the step size and initial guess of l. However, once the minimum value of l is computed with an appropriate step size, the use of this value as a new initial guess at the next iteration speeds up the computation of the nearest projection point. As an alternative to gradient descent method, Newton’s method may be used for better convergence speed at the cost of more computation per each iteration.If the parameterl∗ that minimizes the function of equation (11) is found, the position vector to the nearest projection point D is given by rD=rpl∗. Then, the position vector of a virtual target is computed as follows.
(15)rtl=rDl+R0etl,where l is used instead of l∗ for notation simplicity. The velocity of a virtual target is the time derivative of the position vector.
(16)vtl=ṙtl=drDldll̇+R0detldsdsdll̇,where overhead dots represent the time derivative. Substituting equations (2) and (7) into (16) leads to
(17)vtl=dsdll̇et+R0κdsdll̇en.To obtain the rate of parameterl̇, equation (13) is differentiated with respect to time.
(18)drDdll̇−vm·et+rD−rm·detdll̇=0.Substituting equations (2) and (7) into (18) yields.
(19)l̇=vm·etds/dl1+κrD−rm·en.To summarize, the velocity of a virtual target is given by(20)vtl=vm·et1+κrD−rm·enet+R0κen.As a special case, the equilibrium state is considered. If the motion of a vehicle initially begins on the path with the direction along the unit tangent vectoret, i.e.,
(21)rm=rD,vm=Vmet,then equations of target velocity vector and the relative position and velocity vectors reduce to
(22)r=R0et,v=R0Vmκen,and the guidance law (10) becomes
(23)am=NVm2κen.Therefore, with the proportional gain ofN=1, the guidance law produces the command acceleration that is the same to the instantaneous centripetal acceleration of a path with curvature κ. Note that pursuit guidance (PG) law generates zero command acceleration, which means that PG law makes no contribution in the equilibrium state.The navigation gainsN,h and the tangentially receding distance R0 between the virtual target and the projection point are the design choice of the proposed guidance logic. The influence of these values can be investigated by a linear analysis similar to the method in [17, 18]. Figure 4 shows a linearization situation with assumption that the vehicle motion is perturbed from the equilibrium state. In Figure 4, d denotes the cross-track error.Figure 4
Linear model of continuous curvature path following.Assuming that the all vectors are almost in the same plane and the magnitudes ofκd and α1 are small, then the relative velocity vector is approximately expressed as
(24)v≈VmR0κ+sinα1en.Therefore, the guidance law (10) becomes
(25)am≈NVm2R0κRcosα2+NVm2Rsinα1cosα2+hNVm2Rsinαen.Assuming that the magnitudes ofd/R0 and α=α1+α2 are small,
(26)R≈R0,cosα2≈1,sinα1+α2≈ḋVm+dR0,then the magnitude of command acceleration can be written as
(27)am≈NVm2κ+NVmR0ḋ+hNVmR0ḋ+hNVm2R02d.Equation (27) resembles a proportional and derivative (PD) control with the forcing term of NVm2κ. The first two terms of the right hand side of the above equation are due to pure proportional navigation guidance (PPNG) law and the third and fourth terms pursuit guidance (PG) law. Thus, the PPNG law provides centripetal acceleration with the enhancement of the damping performance, and the PG law plays a role as a PD control. Since the vehicle is initially on the path with curvature κ in the equilibrium state and perturbed from it, am≈Vm2κ−d¨ holds and equation (27) becomes
(28)Vm2κ=NVm2κ+d¨+N1+hVmR0ḋ+hNVm2R02d.Equation (28) implies that with a proportional gain of N=1, 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 guidance gain and the ratio of the vehicle speed and the tangentially receding distance R0, which are 1+h/2h and hVm/R0. Note that the cross-track error dynamics is at least a critically damped system.The proposed guidance logic for a general continuous curvature path following is summarized in Table1.Table 1
Summary of the proposed guidance logic.
amt←guidancelogich,R0,rpl,rmt,vmt
1
Determine the nearest projection point→l∗,rD=rpl∗
2
et=drpl/dldrpl/dl at l=l∗
3
κ=drpl/dl×d2rpl/dl2drpl/dl3 at l=l∗
4
dsdl=drpldl at l=l∗
5
d2sdl2=drpl/dl·d2rpl/dl2ds/dl at l=l∗
6
Ifκ=0,en=0 else en=d2rpl/dl2−d2s/dl2etκds/dl2 at l=l∗
7
rt=rD+R0et
8
vt=vm·et1+κrD−rm·enet+R0κen
9
r=rt−rm
10
v=vt−vm
11
R2=r·r
12
am=r×vR2×vm−hr×vmR2×vmIn the next two subsections, the motion strategy of virtual target for a general continuous curvature path is applied to two primitive paths: straight-line path and circular path. Since geometries of these paths are simple, the resulting motions of virtual target are also simple and turn out to be the same to the ones in [24].


### 4.2. Special Case 1: Straight-Line Path

The straight-line path with the start positionrw in the direction of unit constant vector ep as shown in Figure 5 can be represented parametrically as
(29)rpl=rw+lep,where l is the distance along the line from rw. Figure 6 illustrates the pursuit geometry of the vehicle and virtual target for the straight-line path, where rwm=rm−rw is the relative position vector of vehicle from the point W.Figure 5
Parametric representation of a straight-line path.Figure 6
Straight-line path following.Then, the unit tangent vectoret and unit principal normal vector en at all points on a path can be computed as follows.
(30)etl=ep,enl=0,and the curvature κ of a straight-line path is given by κl=0. The nearest projection point D is calculated directly from equation (13) as
(31)rD=rw+rwm·epep.At pointD, the rate of parameter l̇ in equation (19) reduces to
(32)l̇=vm·ep.Therefore, the position and velocity vectors of the virtual target are simply computed as(33)rt=rw+rwm·epep+R0ep,vt=vm·epep,which are the same as those in [24].


### 4.3. Special Case 2: Circular Path

The circular path is specified by a unit vectorerot for indicating the direction of rotation, a position vector rc pointing to the center of circle, and the circle radius Rc, as shown in Figure 7. The position vector rw indicates the start point of a circular path. Then, the circular path can be represented parametrically in the form as
(34)rpl=rc+rw−rccosl+erot×rw−rcsinl,where l is the angle measured from the point W. With the use of arc length s as parameter, equation (34) becomes
(35)rps=rc+RcewcossRc+erot×RcewsinsRc,where ew=rw−rc/Rc.Figure 7
Parametric representation of a circular path ((a) top view, (b) side view).Then, the unit tangent vectoret and its derivative at a point on a circular path in terms of arc length are given by
(36)drpsds=ets=−ewsinsRc−erot×ewcossRc,detsds=−1RcewcossRc−1Rcerot×ewsinsRc=−1Rc2rps−rc.The curvature of equation (6) reduces to
(37)κs=1Rc,and the unit principal normal vector en of equation (7) becomes
(38)ens=−1Rcrps−rc.Figure8 illustrates the pursuit geometry of the vehicle and virtual target for circular path, where rcm=rm−rc is the relative position vector of vehicle from the center of circle to a vehicle.Figure 8
Circular path following ((a) top view, (b) side view).The nearest projection pointD is calculated from equation (13) as
(39)rcm·ets=0,which occurs when
(40)rcm−rcm·eroterotrcm−rcm·eroterot=−ens.Therefore, the position vector to the nearest projection point is given by(41)rD=rc+Rcrcm−rcm·eroterotrcm−rcm·eroterot.At pointD, the rate of parameter ṡ is computed as
(42)ṡ=Rcvm·etrcm−rcm·eroterot.Substituting equations (40) and (41) into (15) yields the position vector of virtual target as
(43)rts=rc−Rcens+R0ets.Finally, the velocity vector of virtual target is computed by substituting equations (37) and (42) into (17).
(44)vt=Rcrcm−rcm·eroterotvm·etet+R0rcm−rcm·eroteroten.Thus, the position and velocity vectors are the same those in [24].


## 4.1. General Continuous Curvature Path

The nearest projection pointD of a vehicle current position onto the desired path can be computed by minimizing the following function.
(11)J=12rpl−rm·rpl−rm.Taking the derivative ofJ with respect to the parameter l and setting it to zero gives
(12)0=dJdl=rpl−rm·dsdletor
(13)0=dJdl=rpl−rm·dsdlet.Therefore, the relative position vector from a vehicle to the nearest projection pointrpl−rm is perpendicular to the unit tangent vector et at the nearest projection point. To find the parameter l that minimizes the function, a gradient descent method may be used. This method starts with some initial guess of l and repeatedly performs the following update.
(14)l←l−βrpl−rm·dsdlet,where β>0 is the step size. The gradient descent may take many iterations to compute a minimum value depending on the step size and initial guess of l. However, once the minimum value of l is computed with an appropriate step size, the use of this value as a new initial guess at the next iteration speeds up the computation of the nearest projection point. As an alternative to gradient descent method, Newton’s method may be used for better convergence speed at the cost of more computation per each iteration.If the parameterl∗ that minimizes the function of equation (11) is found, the position vector to the nearest projection point D is given by rD=rpl∗. Then, the position vector of a virtual target is computed as follows.
(15)rtl=rDl+R0etl,where l is used instead of l∗ for notation simplicity. The velocity of a virtual target is the time derivative of the position vector.
(16)vtl=ṙtl=drDldll̇+R0detldsdsdll̇,where overhead dots represent the time derivative. Substituting equations (2) and (7) into (16) leads to
(17)vtl=dsdll̇et+R0κdsdll̇en.To obtain the rate of parameterl̇, equation (13) is differentiated with respect to time.
(18)drDdll̇−vm·et+rD−rm·detdll̇=0.Substituting equations (2) and (7) into (18) yields.
(19)l̇=vm·etds/dl1+κrD−rm·en.To summarize, the velocity of a virtual target is given by(20)vtl=vm·et1+κrD−rm·enet+R0κen.As a special case, the equilibrium state is considered. If the motion of a vehicle initially begins on the path with the direction along the unit tangent vectoret, i.e.,
(21)rm=rD,vm=Vmet,then equations of target velocity vector and the relative position and velocity vectors reduce to
(22)r=R0et,v=R0Vmκen,and the guidance law (10) becomes
(23)am=NVm2κen.Therefore, with the proportional gain ofN=1, the guidance law produces the command acceleration that is the same to the instantaneous centripetal acceleration of a path with curvature κ. Note that pursuit guidance (PG) law generates zero command acceleration, which means that PG law makes no contribution in the equilibrium state.The navigation gainsN,h and the tangentially receding distance R0 between the virtual target and the projection point are the design choice of the proposed guidance logic. The influence of these values can be investigated by a linear analysis similar to the method in [17, 18]. Figure 4 shows a linearization situation with assumption that the vehicle motion is perturbed from the equilibrium state. In Figure 4, d denotes the cross-track error.Figure 4
Linear model of continuous curvature path following.Assuming that the all vectors are almost in the same plane and the magnitudes ofκd and α1 are small, then the relative velocity vector is approximately expressed as
(24)v≈VmR0κ+sinα1en.Therefore, the guidance law (10) becomes
(25)am≈NVm2R0κRcosα2+NVm2Rsinα1cosα2+hNVm2Rsinαen.Assuming that the magnitudes ofd/R0 and α=α1+α2 are small,
(26)R≈R0,cosα2≈1,sinα1+α2≈ḋVm+dR0,then the magnitude of command acceleration can be written as
(27)am≈NVm2κ+NVmR0ḋ+hNVmR0ḋ+hNVm2R02d.Equation (27) resembles a proportional and derivative (PD) control with the forcing term of NVm2κ. The first two terms of the right hand side of the above equation are due to pure proportional navigation guidance (PPNG) law and the third and fourth terms pursuit guidance (PG) law. Thus, the PPNG law provides centripetal acceleration with the enhancement of the damping performance, and the PG law plays a role as a PD control. Since the vehicle is initially on the path with curvature κ in the equilibrium state and perturbed from it, am≈Vm2κ−d¨ holds and equation (27) becomes
(28)Vm2κ=NVm2κ+d¨+N1+hVmR0ḋ+hNVm2R02d.Equation (28) implies that with a proportional gain of N=1, 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 guidance gain and the ratio of the vehicle speed and the tangentially receding distance R0, which are 1+h/2h and hVm/R0. Note that the cross-track error dynamics is at least a critically damped system.The proposed guidance logic for a general continuous curvature path following is summarized in Table1.Table 1
Summary of the proposed guidance logic.
amt←guidancelogich,R0,rpl,rmt,vmt
1
Determine the nearest projection point→l∗,rD=rpl∗
2
et=drpl/dldrpl/dl at l=l∗
3
κ=drpl/dl×d2rpl/dl2drpl/dl3 at l=l∗
4
dsdl=drpldl at l=l∗
5
d2sdl2=drpl/dl·d2rpl/dl2ds/dl at l=l∗
6
Ifκ=0,en=0 else en=d2rpl/dl2−d2s/dl2etκds/dl2 at l=l∗
7
rt=rD+R0et
8
vt=vm·et1+κrD−rm·enet+R0κen
9
r=rt−rm
10
v=vt−vm
11
R2=r·r
12
am=r×vR2×vm−hr×vmR2×vmIn the next two subsections, the motion strategy of virtual target for a general continuous curvature path is applied to two primitive paths: straight-line path and circular path. Since geometries of these paths are simple, the resulting motions of virtual target are also simple and turn out to be the same to the ones in [24].


## 4.2. Special Case 1: Straight-Line Path

The straight-line path with the start positionrw in the direction of unit constant vector ep as shown in Figure 5 can be represented parametrically as
(29)rpl=rw+lep,where l is the distance along the line from rw. Figure 6 illustrates the pursuit geometry of the vehicle and virtual target for the straight-line path, where rwm=rm−rw is the relative position vector of vehicle from the point W.Figure 5
Parametric representation of a straight-line path.Figure 6
Straight-line path following.Then, the unit tangent vectoret and unit principal normal vector en at all points on a path can be computed as follows.
(30)etl=ep,enl=0,and the curvature κ of a straight-line path is given by κl=0. The nearest projection point D is calculated directly from equation (13) as
(31)rD=rw+rwm·epep.At pointD, the rate of parameter l̇ in equation (19) reduces to
(32)l̇=vm·ep.Therefore, the position and velocity vectors of the virtual target are simply computed as(33)rt=rw+rwm·epep+R0ep,vt=vm·epep,which are the same as those in [24].


## 4.3. Special Case 2: Circular Path

The circular path is specified by a unit vectorerot for indicating the direction of rotation, a position vector rc pointing to the center of circle, and the circle radius Rc, as shown in Figure 7. The position vector rw indicates the start point of a circular path. Then, the circular path can be represented parametrically in the form as
(34)rpl=rc+rw−rccosl+erot×rw−rcsinl,where l is the angle measured from the point W. With the use of arc length s as parameter, equation (34) becomes
(35)rps=rc+RcewcossRc+erot×RcewsinsRc,where ew=rw−rc/Rc.Figure 7
Parametric representation of a circular path ((a) top view, (b) side view).Then, the unit tangent vectoret and its derivative at a point on a circular path in terms of arc length are given by
(36)drpsds=ets=−ewsinsRc−erot×ewcossRc,detsds=−1RcewcossRc−1Rcerot×ewsinsRc=−1Rc2rps−rc.The curvature of equation (6) reduces to
(37)κs=1Rc,and the unit principal normal vector en of equation (7) becomes
(38)ens=−1Rcrps−rc.Figure8 illustrates the pursuit geometry of the vehicle and virtual target for circular path, where rcm=rm−rc is the relative position vector of vehicle from the center of circle to a vehicle.Figure 8
Circular path following ((a) top view, (b) side view).The nearest projection pointD is calculated from equation (13) as
(39)rcm·ets=0,which occurs when
(40)rcm−rcm·eroterotrcm−rcm·eroterot=−ens.Therefore, the position vector to the nearest projection point is given by(41)rD=rc+Rcrcm−rcm·eroterotrcm−rcm·eroterot.At pointD, the rate of parameter ṡ is computed as
(42)ṡ=Rcvm·etrcm−rcm·eroterot.Substituting equations (40) and (41) into (15) yields the position vector of virtual target as
(43)rts=rc−Rcens+R0ets.Finally, the velocity vector of virtual target is computed by substituting equations (37) and (42) into (17).
(44)vt=Rcrcm−rcm·eroterotvm·etet+R0rcm−rcm·eroteroten.Thus, the position and velocity vectors are the same those in [24].


## 5. Simulations

The numerical simulations are conducted to evaluate the proposed path-following guidance logic in this section. The three-dimensional path of a vehicle is assumed to be given to the vehicle a priori. The vehicle is modeled as a point mass flying at a constant speed of 20 m/sec. The tangentially receding distanceR0 is chosen as 300 m, step size β=10−6, and N=1 and h=1 are used in simulations.In the simulations, two scenarios are considered and the results are shown in Figures9–13. In the first scenario, the vehicle begins at various initial positions and poses and is supposed to fly along the helical path considered in [24]. The helical path is defined on a vertical cylinder of radius 500 m, having pitch of L=102π m. The initial conditions used in the first scenario are summarized in Table 2. Figure 9 shows that the proposed logic can track the desired helical path without any following errors despite the large initial deviations from the path. The trajectories of cross-track error are shown in Figure 10.Figure 9
Helical path following. (a) Three-dimensional view, (b) side view, and (c) planar view.
(a)
(b)
(c)Figure 10
Cross-track errors in helical path following.Figure 11
Defined path. (a) Three-dimensional view and (b) curvature.
(a)
(b)Figure 12
General path following. (a) Three-dimensional view, (b) side view, and (c) planar view.
(a)
(b)
(c)Figure 13
Cross-track errors in general path following.Table 2
Initial conditions used in simulations.
Line colour
Initial positions (m)
Initial headingsψ and flight path angles γ (deg)
Blue
x=200,y=−200,z=200
ψ=0,γ=0
Magenta
x=300,y=−600,z=250
ψ=30,γ=−10
Black
x=−300,y=300,z=150
ψ=200,γ=10As for the next scenario, a more complex path is considered as given in equation (45) to test general continuous curvature path-following capabilities of the proposed guidance logic.
(45)rpl=500cosl10i1+500sinl5i2+10cosl5+200i3m.Figure11 illustrates the defined path and its curvature as a function of parameter l. In this scenario, the vehicle begins at various initial positions and poses and is supposed to fly along the defined path. The initial conditions used in this scenario are the same to those of the first scenario as in Table 2.Figure12 shows how the proposed guidance logic can successfully track this path without any following error. The trajectories of cross-track error are shown in Figure 13, which verifies that all errors converge to zero as expected.


## 6. Conclusions

A new simple and practical guidance logic is presented for a vehicle to follow a general continuous curvature path defined in a three-dimensional space. The proposed guidance logic is general in the sense that it can be applied to any continuous curvature path and includes the guidance logic proposed in [24] as a special case.The proposed guidance logic is composed of the guidance law and motion strategy of the virtual target. The guidance law is a combination of the pure proportional navigation guidance (PPNG) and the pursuit guidance (PG) law, 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 guidance logic is formulated in such a way that the guidance law is to generate the command acceleration such that a vehicle pursues the designed moving virtual target, and this eventually makes a vehicle to follow a desired path.The numerical simulations are conducted to evaluate the proposed path-following guidance logic. For both regular helical path and a general continuous curvature path defined in a three-dimensional space, the proposed logic shows the precise path-following capability.



---

*Source: 3754182-2019-09-03.xml*