# A Moving Frame Trajectory Tracking Method of a Flying-Wing UAV Using the Differential Geometry

Authors: Yi Zhu; Xin Chen; Chuntao Li
Journal: International Journal of Aerospace Engineering
 (2016)

---

## Abstract

The problem of UAV trajectory tracking is a difficult issue for scholars and engineers, especially when the target curve is a complex curve in the three-dimensional space. In this paper, the coordinate frames during the tracking process are transformed to improve the tracking result. Firstly, the basic concepts of the moving frame are given. Secondly the transfer principles of various moving frames are formulated and the Bishop frame is selected as a final choice for its flexibility. Thirdly, the detailed dynamic equations of the moving frame tracking method are formulated. In simulation, a moving frame of an elliptic cylinder helix is formulated precisely. Then, the devised tracking method on the basis of the dynamic equations is tested in a complete flight control system with 6 DOF nonlinear equations of the UAV. The simulation result shows a satisfactory trajectory tracking performance so that the effectiveness and efficiency of the devised tracking method is proved.


---

## Body

## 1. Introduction

The main difficulties of a UAV trajectory tracking issue differing from the ordinary tracking problems lie in the strict real-time requirement and the complexity of 3-dimensional curves. Some literature only attempts to deal with the reduced situations such as the “path following” problem without a constrained time parameter [1–3] or the simplified target curves in 2D plane [4–6]. What is more, different types of curves usually call for different guidance strategies. In contrast, the moving frame tracking method is employed to give a more universal solution for various kinds of complex curves in the 3D space.There are two procedures of the moving frame tracking method.The first procedure of the moving frame tracking method is to form a moving frame of the given target curve. A moving frame is a moving coordinate axis system with its three axes being the curve’s tangent vector, principal normal vector, and secondary normal vector. There are many ways to obtain a moving frame of a given curve [7, 8]. The Bishop frame which is also called the parallel frame is the most famous one [9, 10]. In recent years, papers tend to concentrate on the improvements of the Bishop frame [11, 12]. In this paper by comparisons of the Frenet frame and the type 1 Bishop frames, we can see some insights of forming a moving frame and find out the reason why the Bishop frame is suitable for solving a UAV trajectory problem.The second procedure of the moving frame tracking method is to formulate the dynamic error equations of the whole tracking process. In this procedure a quite unusual tracking process is presented. We no longer need to care about the individual shape of the target curve [13, 14]. That is to say, whether the target curve is a straight line, a circle, or an arc is unimportant. Instead, the moving frame of the curve with its tangent vector, principal normal vector, and secondary normal vector is the objectives to follow. Some knowledge of the theoretical mechanics about the motions of rigid bodies is necessary. In essence, the objective dynamic error equations are the result of a series of coordinate transformations and vector operations [15, 16]. In this procedure, the final aim is to obtain the kinematics errors in the moving frame of the target curve rather than the inertial coordinate frame.The previous papers treating the trajectory tracking problem with the moving frame method are not sufficient. The reason is that the moving frame tracking method is very interdisciplinary for the theorists of guidance, navigation, and control. However, the analysis of geometrical properties of curves actually plays an important role in practical applications. Thus, the moving frame tracking is an effective and practical method for the UAV 3D trajectory tracking problem. In the previous literature some trials have been made to apply this tracking method to the tiny UAVs or quadrotors [15, 17]. Some other sources of literature are concerned about the mathematical features of this tracking method [18, 19]. All these sources of literature tackle the particle models of the microaircrafts with very low flight speed. For example, in literature [15], the velocity of the aircraft is 0.4 m/s. In this paper a much larger and heavier UAV is used and its velocity is about 200 m/s so that the situation is different. Also, it is well known that when a particle model is used, the angular motions inside the rigid body are omitted. So another distinction with the previous literature is that in this paper a 6 DOF UAV model is employed instead of a particle model.


## 2. Formulation of the Moving Frame Tracking Method

### 2.1. General Illustration

The core idea of the moving frame tracking method lies in the conception that the position errors are resolved in the moving coordinate frame of the target curve instead of the inertial frame in ordinary tracking methods. In this method the time constraint is well satisfied since the target curve is formulated with a time parametert. The primary aim is aligning the heading direction to the tangent vector of the target curve with almost no position deviation. The principle of the moving frame tracking method is illustrated in Figure 1.Figure 1
Illustration of the moving frame tracking method.It can be seen from Figure1 that the aircraft used in this paper is a UAV with flying-wing configuration. The target curve, that is, the target trajectory to track, is an elliptic cylinder helix. There are five coordinate frames that need to be introduced which are the inertial frame I, the body frame B, the wind frame W, and the curve frame F. The inertial frame describes the physical positions on the earth. The body frame is a frame attached to the body of the aircraft. The wind frame is a speed frame with its x-axis aligned with the true airspeed of the aircraft, while the other two axes are orthogonally decomposed in the inertial frame. The curve frame is a moving frame (as the Frenet frame or Bishop frame) of the target trajectory.


### 2.2. Forming a Moving Frame

By mathematical ways, it is implementable to form a moving frame of a 3D Curve. In the early stages of classical differential geometry, the Frenet frame was adopted to formulate a curve in the three-dimensional Euclidean spaceE3. Let T, N, and B represent the tangent vector, principal normal vector, and secondary normal vector, respectively. For all the curves in E3, by transforming the time parameter t into an arc length parameter s, the Frenet frame of a curve is defined by(1)
d
r
d
s
=
T
,
d
T
d
s
d
N
d
s
d
B
d
s
=
κ
N
-
κ
T
+
τ
B
-
τ
N
=
0
κ
0
-
κ
0
τ
0
-
τ
0
T
N
B
,where κ and τ are curvature and torsion of the Frenet frame, defined by(2)κ=dTds,τ=-B′·N.Today the Frenet frame has been improved to become the Bishop frame. The type 1 Bishop frame is defined by(3)
d
T
d
s
d
N
1
d
s
d
N
2
d
s
=
k
1
s
N
1
+
k
2
s
N
2
-
k
1
s
T
-
k
2
s
T
=
0
k
1
s
k
2
s
-
k
1
s
0
0
-
k
2
s
0
0
T
N
1
N
2
.The relationship between the Frenet frame and type 1 Bishop frame is described as follows:(4)T=T,N=cos⁡θFN1+sin⁡θFN2,B=-sin⁡θFN1+cos⁡θFN2,where(5)θFs=arctan⁡k2k1.τs=dθsds,κs=k12+k22.The type 1 Bishop curvatures are defined by(6)k1=κcos⁡θF,k2=κsin⁡θF.From the definition of the Bishop frame and the relationship between it and the Frenet frame we can see that, roughly speaking, the Bishop frame is a frame which has the same original point with the Frenet frame and aligns one of its axes with one of the axes of the Frenet frame. Then the rest of the two axes of the Bishop frame rotate at a certain angleθF in the normal plane of the first axis. Obviously, a new generated Bishop frame is always isomorphic to the Frenet frame in E3.


### 2.3. Dynamic Errors Equations of Moving Frame Tracking

Let the inertial frame be defined byI=O:i,j,k with axis i pointing to the north, axis j pointing to the east, and axis k pointing vertically to the center of the earth. So the frame I is a NED (North-Easy-Down) frame. Suppose the target curve with an arc length parameter is(7)Pds=PdxsPdysPdzsT.Then the trajectory tracking problem is presented as follows: for a target curve Pd with its moving frame and an aircraft model, a controller needs to be designed to force the aircraft to fly along the target curve by means of minimizing the position error vector which is resolved in the moving frame.Assuming the Bishop frame of the target curve is defined byF=T,N1,N2, according to the definition of the frame W, the airspeed V equals ground speed when there is no wind disturbance. Thus the speed vector from frame W to I resolved in frame W is represented as vW2IW=V00.LetpI=xyzT be the vector from the origin of the frame I pointing to the aircraft’s center of mass resolved in I and pF=xFyFzFT be the vector from the origin of the frame F pointing to the aircraft’s center of mass resolved in F. The angular velocity vector of the body frame B rotating around I and resolved in frameF is presented as (8)ωdF=RI2Fωd=ωdxFωdyFωdzFT,where RI2F∈SO3 is the rotation matrix from I to F. SO3 is the 3-dimensional special orthogonal group. Also, the matrix RF2I represents the rotation matrix from the frame F to the inertial frame. Then, in the light of the kinematics of rigid bodies, (9) holds.(9)RF2I=T,N1,N2.The condition is just the same with the other frames, which is no longer repeated here. So formula (9) is an instance of showing a general rule of the coordinate transformation with unitary frames in E3.To be more precise about the meaning and resolving method of the angular velocity vector just mentioned above, some discussions of the Darboux vector are given in the following. The Darboux vector is named after Gaston Darboux who discovered it. It is also called angular momentum vector, because it is directly proportional to angular momentum. For a rigid body moving absolutely along a general curve which is expressed by a moving frame, its motions can be divided into two kinds of motions as the translational motion and the rotational motion. The rotational motion is formulated by the Darboux vectorω which is a composition of three axes’ areal velocity components.(10)ω=ωi~+ωj~+ωk~,where i~, j~, k~ represent axes vectors of a moving frame. Each axis vector rotates around a point. When this moving frame is a unitary frame, each axis areal velocity is defined by(11)ωi~=limΔt→0⁡i~t×i~t+Δt2Δt=i~t×i~′t2,ωj~=limΔt→0⁡j~t×j~t+Δt2Δt=j~t×j~′t2,ωk~=limΔt→0⁡k~t×k~t+Δt2Δt=k~t×k~′t2.Taking the Frenet frame, for instance, with i~, j~, and k~ replaced by T, N, and B, one has (12)ωT=Tt×T′t2=κB2,ωN=Nt×N′t2=τT+κB2,ωB=Bt×B′t2=τT2,ω=ωT+ωN+ωB=τT+κB.It is easy to see that the vector ω satisfies the equations(13)
d
T
d
t
d
N
d
t
d
B
d
t
=
ω
×
T
ω
×
N
ω
×
B
.Then concerning the Bishop frame, its Darboux vector is(14)ωT=T×T2=12T×k1N1+k2N2=12k1N2-12k2N1,ωN1=N1×N1′2=N1×-12k1T=12k1N2,ωN2=N2×N2′2=N2×-12k2T=-12k2N1,ω=ωT+ωN1+ωN2=k1N2-k2N1.When the moving frame is parameterized by a time parameter t, the Darboux vector of the Bishop frame and resolved in the Bishop frame is(15)ωDarboux∣Bishop=0-k2ss˙k1ss˙T,where s is the arc length parameter. For a parameterized curve rt with time t, by the chain rule for finding the derivatives of composite functions, we get (16)drtdt=drsdsdsdt=drsdss˙.Also, by the definition of the arc differentiation,(17)ds=r′tdt=r1′t2+r2′t2+r3′t2dt.If the frame of the target curve rotates with an extra angular velocity ωdF, then the angular velocity of F around inertial frame I resolved in frame F is defined by(18)ωF2IF=ωdF+ωDarboux∣Bishop=ωdxF-k2ss˙+ωdyFk1ss˙+ωdzFT.The translational speed vector of W towards I resolved in I is vWI=x˙y˙z˙=RW2IvWW, where RW2I is the rotation matrix from W to I. From Figure 2, the position vector of the UAV resolved in I can be presented as(19)pI=pd+RF2IpF.According to the rules of finding derivatives of speed vectors in different frames in the kinematics of rigid bodies, we can find the derivative of (19)(20)p˙I=p˙d+RF2Ip˙F+RF2IωF2IF∧pF,where ∧ is the so-called hat mapping, which means, for any two vector, a and b, a∧b=a×b is satisfied. Particularly, for a 3-dimension case, the form of a skew-symmetric matrix of vector a=a1,a2,a3T in accordance with a hat mapping is presented as(21)a∧=0-a3a2a30-a1-a2a10.Then we state that a∧ belongs to so3.   so3 is the Lie algebra of 3-dimensional special orthogonal group SO3. By premultiplying both sides of (20) with RI2F, we get (22)RI2Fp˙=RI2Fp˙d+p˙F+ωF2IF∧pF.Of (22) RI2Fp˙d represents the speed of a point in the target curve towards the frame I and is resolved in the frame F. It is a composition of two parts. The first is the speed resolved in frame F, that is, vFF=s˙00T. The second is the speed from the frame F towards I, which is also resolved in F denoted as vF2IF. To get an analytic expression of RI2Fp˙d, some knowledge about theoretical mechanics is necessary to be introduced. When a rigid body makes a general motion which is a combination of translation and rotation, the speed of any point P in the rigid body can be formulated as(23)v=vc+ω×r,where vc is the speed of the basic point and r is the position vector from the basic point to the point P. It is arbitrary to choose the position of the basic point, for ω never changes with the basic point.Figure 2
The planform and the actuators distribution of the flying-wing UAV.Assume there is an initial positionP0 moving with a speed of P˙0=vd and rotating with an angular velocity of Pd. Then the point P0 moves with the target curve meanwhile the relative position between P0 and the point of the target curve remains unchanged. By (23), one has(24)vF2IF=RI2Fvd+ωd∧pd-p0.Thus(25)RI2Fp˙d=vFF+vF2IF=vFF+RI2Fvd+ωd∧pd-p0.On the other hand, the left side of (22) is expressed as(26)RI2Fp˙I=RW2FvW2IW.With regard to (25) and (26), (22) can be rewritten as(27)p˙F=RW2FvW2IW-vFF-RI2Fvd+ωd∧pd-p0-ωF2IF∧pF.Let RB2N be the rotation matrix from the body frame B to a navigation frame N. Ωb=ωx,ωy,ωzT represents the angular velocity of B around the frame N~ resolved in B. According to the general rule of finding the derivatives of the rotation matrices, the derivative of RB2N with respect to time is(28)R˙B2N=RB2NΩb∧.Since in most time the navigation frame N~ is considered as an inertial frame, the conclusion is still suitable for the UAV systems. Also, the angular velocity from F to W resolved in W is (29)ωW2FW=ωW2IW-ωF2IW.So one has(30)R˙W2F=RW2FωW2FW∧.Then (27) and (30) construct the dynamic error equations of the moving frame tracking method.


## 2.1. General Illustration

The core idea of the moving frame tracking method lies in the conception that the position errors are resolved in the moving coordinate frame of the target curve instead of the inertial frame in ordinary tracking methods. In this method the time constraint is well satisfied since the target curve is formulated with a time parametert. The primary aim is aligning the heading direction to the tangent vector of the target curve with almost no position deviation. The principle of the moving frame tracking method is illustrated in Figure 1.Figure 1
Illustration of the moving frame tracking method.It can be seen from Figure1 that the aircraft used in this paper is a UAV with flying-wing configuration. The target curve, that is, the target trajectory to track, is an elliptic cylinder helix. There are five coordinate frames that need to be introduced which are the inertial frame I, the body frame B, the wind frame W, and the curve frame F. The inertial frame describes the physical positions on the earth. The body frame is a frame attached to the body of the aircraft. The wind frame is a speed frame with its x-axis aligned with the true airspeed of the aircraft, while the other two axes are orthogonally decomposed in the inertial frame. The curve frame is a moving frame (as the Frenet frame or Bishop frame) of the target trajectory.


## 2.2. Forming a Moving Frame

By mathematical ways, it is implementable to form a moving frame of a 3D Curve. In the early stages of classical differential geometry, the Frenet frame was adopted to formulate a curve in the three-dimensional Euclidean spaceE3. Let T, N, and B represent the tangent vector, principal normal vector, and secondary normal vector, respectively. For all the curves in E3, by transforming the time parameter t into an arc length parameter s, the Frenet frame of a curve is defined by(1)
d
r
d
s
=
T
,
d
T
d
s
d
N
d
s
d
B
d
s
=
κ
N
-
κ
T
+
τ
B
-
τ
N
=
0
κ
0
-
κ
0
τ
0
-
τ
0
T
N
B
,where κ and τ are curvature and torsion of the Frenet frame, defined by(2)κ=dTds,τ=-B′·N.Today the Frenet frame has been improved to become the Bishop frame. The type 1 Bishop frame is defined by(3)
d
T
d
s
d
N
1
d
s
d
N
2
d
s
=
k
1
s
N
1
+
k
2
s
N
2
-
k
1
s
T
-
k
2
s
T
=
0
k
1
s
k
2
s
-
k
1
s
0
0
-
k
2
s
0
0
T
N
1
N
2
.The relationship between the Frenet frame and type 1 Bishop frame is described as follows:(4)T=T,N=cos⁡θFN1+sin⁡θFN2,B=-sin⁡θFN1+cos⁡θFN2,where(5)θFs=arctan⁡k2k1.τs=dθsds,κs=k12+k22.The type 1 Bishop curvatures are defined by(6)k1=κcos⁡θF,k2=κsin⁡θF.From the definition of the Bishop frame and the relationship between it and the Frenet frame we can see that, roughly speaking, the Bishop frame is a frame which has the same original point with the Frenet frame and aligns one of its axes with one of the axes of the Frenet frame. Then the rest of the two axes of the Bishop frame rotate at a certain angleθF in the normal plane of the first axis. Obviously, a new generated Bishop frame is always isomorphic to the Frenet frame in E3.


## 2.3. Dynamic Errors Equations of Moving Frame Tracking

Let the inertial frame be defined byI=O:i,j,k with axis i pointing to the north, axis j pointing to the east, and axis k pointing vertically to the center of the earth. So the frame I is a NED (North-Easy-Down) frame. Suppose the target curve with an arc length parameter is(7)Pds=PdxsPdysPdzsT.Then the trajectory tracking problem is presented as follows: for a target curve Pd with its moving frame and an aircraft model, a controller needs to be designed to force the aircraft to fly along the target curve by means of minimizing the position error vector which is resolved in the moving frame.Assuming the Bishop frame of the target curve is defined byF=T,N1,N2, according to the definition of the frame W, the airspeed V equals ground speed when there is no wind disturbance. Thus the speed vector from frame W to I resolved in frame W is represented as vW2IW=V00.LetpI=xyzT be the vector from the origin of the frame I pointing to the aircraft’s center of mass resolved in I and pF=xFyFzFT be the vector from the origin of the frame F pointing to the aircraft’s center of mass resolved in F. The angular velocity vector of the body frame B rotating around I and resolved in frameF is presented as (8)ωdF=RI2Fωd=ωdxFωdyFωdzFT,where RI2F∈SO3 is the rotation matrix from I to F. SO3 is the 3-dimensional special orthogonal group. Also, the matrix RF2I represents the rotation matrix from the frame F to the inertial frame. Then, in the light of the kinematics of rigid bodies, (9) holds.(9)RF2I=T,N1,N2.The condition is just the same with the other frames, which is no longer repeated here. So formula (9) is an instance of showing a general rule of the coordinate transformation with unitary frames in E3.To be more precise about the meaning and resolving method of the angular velocity vector just mentioned above, some discussions of the Darboux vector are given in the following. The Darboux vector is named after Gaston Darboux who discovered it. It is also called angular momentum vector, because it is directly proportional to angular momentum. For a rigid body moving absolutely along a general curve which is expressed by a moving frame, its motions can be divided into two kinds of motions as the translational motion and the rotational motion. The rotational motion is formulated by the Darboux vectorω which is a composition of three axes’ areal velocity components.(10)ω=ωi~+ωj~+ωk~,where i~, j~, k~ represent axes vectors of a moving frame. Each axis vector rotates around a point. When this moving frame is a unitary frame, each axis areal velocity is defined by(11)ωi~=limΔt→0⁡i~t×i~t+Δt2Δt=i~t×i~′t2,ωj~=limΔt→0⁡j~t×j~t+Δt2Δt=j~t×j~′t2,ωk~=limΔt→0⁡k~t×k~t+Δt2Δt=k~t×k~′t2.Taking the Frenet frame, for instance, with i~, j~, and k~ replaced by T, N, and B, one has (12)ωT=Tt×T′t2=κB2,ωN=Nt×N′t2=τT+κB2,ωB=Bt×B′t2=τT2,ω=ωT+ωN+ωB=τT+κB.It is easy to see that the vector ω satisfies the equations(13)
d
T
d
t
d
N
d
t
d
B
d
t
=
ω
×
T
ω
×
N
ω
×
B
.Then concerning the Bishop frame, its Darboux vector is(14)ωT=T×T2=12T×k1N1+k2N2=12k1N2-12k2N1,ωN1=N1×N1′2=N1×-12k1T=12k1N2,ωN2=N2×N2′2=N2×-12k2T=-12k2N1,ω=ωT+ωN1+ωN2=k1N2-k2N1.When the moving frame is parameterized by a time parameter t, the Darboux vector of the Bishop frame and resolved in the Bishop frame is(15)ωDarboux∣Bishop=0-k2ss˙k1ss˙T,where s is the arc length parameter. For a parameterized curve rt with time t, by the chain rule for finding the derivatives of composite functions, we get (16)drtdt=drsdsdsdt=drsdss˙.Also, by the definition of the arc differentiation,(17)ds=r′tdt=r1′t2+r2′t2+r3′t2dt.If the frame of the target curve rotates with an extra angular velocity ωdF, then the angular velocity of F around inertial frame I resolved in frame F is defined by(18)ωF2IF=ωdF+ωDarboux∣Bishop=ωdxF-k2ss˙+ωdyFk1ss˙+ωdzFT.The translational speed vector of W towards I resolved in I is vWI=x˙y˙z˙=RW2IvWW, where RW2I is the rotation matrix from W to I. From Figure 2, the position vector of the UAV resolved in I can be presented as(19)pI=pd+RF2IpF.According to the rules of finding derivatives of speed vectors in different frames in the kinematics of rigid bodies, we can find the derivative of (19)(20)p˙I=p˙d+RF2Ip˙F+RF2IωF2IF∧pF,where ∧ is the so-called hat mapping, which means, for any two vector, a and b, a∧b=a×b is satisfied. Particularly, for a 3-dimension case, the form of a skew-symmetric matrix of vector a=a1,a2,a3T in accordance with a hat mapping is presented as(21)a∧=0-a3a2a30-a1-a2a10.Then we state that a∧ belongs to so3.   so3 is the Lie algebra of 3-dimensional special orthogonal group SO3. By premultiplying both sides of (20) with RI2F, we get (22)RI2Fp˙=RI2Fp˙d+p˙F+ωF2IF∧pF.Of (22) RI2Fp˙d represents the speed of a point in the target curve towards the frame I and is resolved in the frame F. It is a composition of two parts. The first is the speed resolved in frame F, that is, vFF=s˙00T. The second is the speed from the frame F towards I, which is also resolved in F denoted as vF2IF. To get an analytic expression of RI2Fp˙d, some knowledge about theoretical mechanics is necessary to be introduced. When a rigid body makes a general motion which is a combination of translation and rotation, the speed of any point P in the rigid body can be formulated as(23)v=vc+ω×r,where vc is the speed of the basic point and r is the position vector from the basic point to the point P. It is arbitrary to choose the position of the basic point, for ω never changes with the basic point.Figure 2
The planform and the actuators distribution of the flying-wing UAV.Assume there is an initial positionP0 moving with a speed of P˙0=vd and rotating with an angular velocity of Pd. Then the point P0 moves with the target curve meanwhile the relative position between P0 and the point of the target curve remains unchanged. By (23), one has(24)vF2IF=RI2Fvd+ωd∧pd-p0.Thus(25)RI2Fp˙d=vFF+vF2IF=vFF+RI2Fvd+ωd∧pd-p0.On the other hand, the left side of (22) is expressed as(26)RI2Fp˙I=RW2FvW2IW.With regard to (25) and (26), (22) can be rewritten as(27)p˙F=RW2FvW2IW-vFF-RI2Fvd+ωd∧pd-p0-ωF2IF∧pF.Let RB2N be the rotation matrix from the body frame B to a navigation frame N. Ωb=ωx,ωy,ωzT represents the angular velocity of B around the frame N~ resolved in B. According to the general rule of finding the derivatives of the rotation matrices, the derivative of RB2N with respect to time is(28)R˙B2N=RB2NΩb∧.Since in most time the navigation frame N~ is considered as an inertial frame, the conclusion is still suitable for the UAV systems. Also, the angular velocity from F to W resolved in W is (29)ωW2FW=ωW2IW-ωF2IW.So one has(30)R˙W2F=RW2FωW2FW∧.Then (27) and (30) construct the dynamic error equations of the moving frame tracking method.


## 3. Simulation

### 3.1. Structure of the System

The mass of the UAV, which is used in the simulation, is 2300 kg and its wingspan equals 8.76 m with a typical flying-wing configuration. This kind of UAV has no vertical or horizontal tails, so its aerodynamic characteristic is unordinary in various aspects. That leads to a worse static heading stability. The actuators of a flying-wing UAV are not the conventional elevators, ailerons, or rudders. Thus the allocation has to be made to transform the signals of actuators of a flying-wing UAV into the signals of the virtually ordinary actuators, such asδe, δa, and δr, so that the universality of the designing methodology devised in this paper is guaranteed. Figure 2 shows a planform and the actuators distribution of a flying-wing UAV.Figure3 shows the structure of the devised UAV flight control systems in the simulation. The blocks of the target curve, tracking errors of the moving frame, reverse calculation, the UAV model, and the controllers of the innerloops are all included, which can be seen from Figure 3.Figure 3
Simulation structure of the UAV flight control system.A UAV nonlinear state-space system can be obtained with state variables defined byXT=u,v,w,ϕ,θ,ψ,p,q,r,xg,yg,hg and control input vector UT=δe,δα,δr,δT. According to the traditional definition of a flight control system, u, v, and w are speed components of body frame, θ, ψ, and ϕ represent pitch angle, yaw angle, and bank angle, respectively, p, q, and r are angular velocity from body frame to inertial frame resolved in body frame, xg, yg, and hg represent the positions of the aircraft in the ground frame which is almost the same as the inertial frame, V is true airspeed, and γ and φ are flight-path angles between the first/second axis of wind frame and inertial frame, respectively.Particularly, the controllers of the attitude and trajectory loops are all the ordinary controllers for simplicity. Also when a better tracking result is obtained, the success can be clearly attributed to the devised method rather than the other advanced and complex controllers of the innerloops.


### 3.2. Moving Frame of an Elliptic Cylinder Helix

The target curve is chosen as an elliptic cylinder helix extending along the horizontal direction. The expression of the target curve with regard to a time parameter is defined as(31)rt=a1t+c1,a2cos⁡b1t+c2,a3sin⁡b2t+c3T,where a1, a2, a3, b1, b2, c1, c2, and c3 are all coefficients. By finding the first-order derivative of it with regard to time we have(32)r′t=a1,-a2b1sin⁡b1t,a3b2cos⁡b2tT.Its magnitude is(33)r′t=a12+-a2b1sin⁡b1t2+a3b2cos⁡b2t2.By the definition of the Frenet frame and (32), one has(34)Tt=r′tr′t=a1,-a2b1sin⁡b1t,a3b2cos⁡b2tTa12+-a2b1sin⁡b1t2+a3b2cos⁡b2t2,dTds=dTtdtdtds=dTtdt1r′t=1r′tddtr′tr′t=1r′tr″tr′t-r′tr′t′r′t2.For the simplicity of the expression, denote m=a12+a2b12, n=a3b22-a2b12, and den=r′t. Let b1=b2; we have(35)den=r′t=a12+-a2b1sin⁡b1t2+a3b2cos⁡b2t2=a12+a2b12+a3b22-a2b12cos2b1t=m+ncos2b1t,den′=-n·b1·sin⁡b1t·cos⁡b1tden,dTtdt=-a1den′,-a2b12cos⁡b1t·den+a2b1sin⁡b1t·den′,-a3b22sin⁡b2t·den-a3b2cos⁡b2t·den′Tden2.By (34) and (35)(36)dTds=dTtdt1r′t=-a1den′,-a2b12cos⁡b1t·den+a2b1sin⁡b1t·den′,-a3b22sin⁡b2t·den-a3b2cos⁡b2t·den′Tden2r′t.Then Nt and Bt are obtained(37)Nt=dTdsdTds-1,Bt=Tt×Nt.According to (4)~(5), that is, the transformation rule of the Frenet frame and the Bishop-1 frame, one has(38)T=T,N1=cos⁡θFN-sin⁡θFB,N2=sin⁡θFN+cos⁡θFB,θFt=∫τsds+θ0=∫τtrt′dt+θ0,tan⁡θF=k2k1,κ=k12+k22=k12+k12tan2θF=1+tan2θFk1.Thus (39)k1=±κ1+tan2θF,k2=tan⁡θF·k1.By (2), the expressions of the Frenet curvature and torsion, we get(40)κ=dTds=dTdtdtds=T′tr′t-1,τ=-dBds·N=-dtdsdBdt·N=-r′t-1dBdt·N.By (31), (32), (34), (35), (38), and (39), the Bishop frame of the target curve rt used in the simulation is formulated. For other complex curves of 3D trajectory, this methodology is still feasible as long as their analytic expressions are available (either formulated by their definitions or curve fitting methods) with regard to the time parameter t. Actually if a curve is fitted by a linear or quadratic function, the computation of its moving frame may be easier as its higher derivatives equal zero with orders being more than 3.In simulation, according to (31), the values of the coefficients are chosen by(41)a1=200,a2=300,a3=-250,b1=0.1,b2=0.1,c1=0,c2=-300,c3=-3000.The curves of the target curve rt and its moving frames are shown in Figures 4(a)–4(d).Figure 4
(a) Trajectory of target curve, (b) the target curve and its Frenet frame, (c) the target curve and its Bishop frame, and (d) the target curve and its moving frames.
(a) (b) (c) (d)In Figure4 the target curve is the blue curve which is the target to track. T, N, and B, respectively, represent the tangent vector, principal normal vector, and secondary normal vector and they are the three orthonormal axes of the Frenet frame. Meanwhile T, N1, and N2 represent the three orthonormal axes of the Bishop frame.For the lengths of the intervals of three axes of the moving frames are different, there are some zoom in and out of these axes in Figure4 for the purpose of clear identification. In Figures 4(b)–4(d) it is easy to identify the tangent vector T of the curve as the red arrow. The other two axes such as N and B or N1 and N2 construct the orthonormal coordinate frames with T. In Figures 4(c)-4(d) the initial parameter θF of the Bishop frame is chosen as 50°. According to the definitions of the two moving frames, there is a superposition of them when that parameter equals zero.


### 3.3. Tracking Result

The beginning of the tracking action starts from the moment the UAV arrives in a small neighborhood of an arbitrary point of the target curve. The initial value of the speed vector of the body frame is chosen atVb0=200,0,-2 and the attitude angles vector is ϕ,θ,ψ0=0,2,0, where the units are, respectively, “m/s” and “°”. The high speed is needed to provide enough lift. Also a larger drag force, which is proportional to the square of the airspeed, is needed to keep the maneuverability in the forward channel. The opening range of the throttle is 0,1, which means the throttle cannot provide a force in the opposite direction. So the total force of the forward channel will not change its direction if the drag is not larger enough and finally it will result in an increasing forward speed. The result of trajectory tracking is shown in Figures 5(a)–5(d).Figure 5
(a) 3D trajectory tracking result, (b) tracking curves in the vertical direction, (c) tracking curves in the lateral direction, and (d) tracking curves in the forward direction.
(a) (b) (c) (d)Figure5(a) shows the 3D trajectory tracking result. From Figure 5(a) we can see that, during the simulation time of 900 s, UAV keeps on following the target curve with hardly any time delay. The mission of trajectory tracking is satisfactorily completed. Figures 5(b)–5(d), respectively, show the tracking curves with respect to time in the vertical, lateral, and forward directions of the inertial frame. As the airspeed of the UAV is about 200 m/s, the deviation could be quite large if the tracking method is not good enough. The vertical steady-state tracking error is less than 2 m within 0.8 s time delay, the lateral error is less than 7 m within 1.1 s time delay, and the forward error is less than 5 m, which are shown in these figures.


## 3.1. Structure of the System

The mass of the UAV, which is used in the simulation, is 2300 kg and its wingspan equals 8.76 m with a typical flying-wing configuration. This kind of UAV has no vertical or horizontal tails, so its aerodynamic characteristic is unordinary in various aspects. That leads to a worse static heading stability. The actuators of a flying-wing UAV are not the conventional elevators, ailerons, or rudders. Thus the allocation has to be made to transform the signals of actuators of a flying-wing UAV into the signals of the virtually ordinary actuators, such asδe, δa, and δr, so that the universality of the designing methodology devised in this paper is guaranteed. Figure 2 shows a planform and the actuators distribution of a flying-wing UAV.Figure3 shows the structure of the devised UAV flight control systems in the simulation. The blocks of the target curve, tracking errors of the moving frame, reverse calculation, the UAV model, and the controllers of the innerloops are all included, which can be seen from Figure 3.Figure 3
Simulation structure of the UAV flight control system.A UAV nonlinear state-space system can be obtained with state variables defined byXT=u,v,w,ϕ,θ,ψ,p,q,r,xg,yg,hg and control input vector UT=δe,δα,δr,δT. According to the traditional definition of a flight control system, u, v, and w are speed components of body frame, θ, ψ, and ϕ represent pitch angle, yaw angle, and bank angle, respectively, p, q, and r are angular velocity from body frame to inertial frame resolved in body frame, xg, yg, and hg represent the positions of the aircraft in the ground frame which is almost the same as the inertial frame, V is true airspeed, and γ and φ are flight-path angles between the first/second axis of wind frame and inertial frame, respectively.Particularly, the controllers of the attitude and trajectory loops are all the ordinary controllers for simplicity. Also when a better tracking result is obtained, the success can be clearly attributed to the devised method rather than the other advanced and complex controllers of the innerloops.


## 3.2. Moving Frame of an Elliptic Cylinder Helix

The target curve is chosen as an elliptic cylinder helix extending along the horizontal direction. The expression of the target curve with regard to a time parameter is defined as(31)rt=a1t+c1,a2cos⁡b1t+c2,a3sin⁡b2t+c3T,where a1, a2, a3, b1, b2, c1, c2, and c3 are all coefficients. By finding the first-order derivative of it with regard to time we have(32)r′t=a1,-a2b1sin⁡b1t,a3b2cos⁡b2tT.Its magnitude is(33)r′t=a12+-a2b1sin⁡b1t2+a3b2cos⁡b2t2.By the definition of the Frenet frame and (32), one has(34)Tt=r′tr′t=a1,-a2b1sin⁡b1t,a3b2cos⁡b2tTa12+-a2b1sin⁡b1t2+a3b2cos⁡b2t2,dTds=dTtdtdtds=dTtdt1r′t=1r′tddtr′tr′t=1r′tr″tr′t-r′tr′t′r′t2.For the simplicity of the expression, denote m=a12+a2b12, n=a3b22-a2b12, and den=r′t. Let b1=b2; we have(35)den=r′t=a12+-a2b1sin⁡b1t2+a3b2cos⁡b2t2=a12+a2b12+a3b22-a2b12cos2b1t=m+ncos2b1t,den′=-n·b1·sin⁡b1t·cos⁡b1tden,dTtdt=-a1den′,-a2b12cos⁡b1t·den+a2b1sin⁡b1t·den′,-a3b22sin⁡b2t·den-a3b2cos⁡b2t·den′Tden2.By (34) and (35)(36)dTds=dTtdt1r′t=-a1den′,-a2b12cos⁡b1t·den+a2b1sin⁡b1t·den′,-a3b22sin⁡b2t·den-a3b2cos⁡b2t·den′Tden2r′t.Then Nt and Bt are obtained(37)Nt=dTdsdTds-1,Bt=Tt×Nt.According to (4)~(5), that is, the transformation rule of the Frenet frame and the Bishop-1 frame, one has(38)T=T,N1=cos⁡θFN-sin⁡θFB,N2=sin⁡θFN+cos⁡θFB,θFt=∫τsds+θ0=∫τtrt′dt+θ0,tan⁡θF=k2k1,κ=k12+k22=k12+k12tan2θF=1+tan2θFk1.Thus (39)k1=±κ1+tan2θF,k2=tan⁡θF·k1.By (2), the expressions of the Frenet curvature and torsion, we get(40)κ=dTds=dTdtdtds=T′tr′t-1,τ=-dBds·N=-dtdsdBdt·N=-r′t-1dBdt·N.By (31), (32), (34), (35), (38), and (39), the Bishop frame of the target curve rt used in the simulation is formulated. For other complex curves of 3D trajectory, this methodology is still feasible as long as their analytic expressions are available (either formulated by their definitions or curve fitting methods) with regard to the time parameter t. Actually if a curve is fitted by a linear or quadratic function, the computation of its moving frame may be easier as its higher derivatives equal zero with orders being more than 3.In simulation, according to (31), the values of the coefficients are chosen by(41)a1=200,a2=300,a3=-250,b1=0.1,b2=0.1,c1=0,c2=-300,c3=-3000.The curves of the target curve rt and its moving frames are shown in Figures 4(a)–4(d).Figure 4
(a) Trajectory of target curve, (b) the target curve and its Frenet frame, (c) the target curve and its Bishop frame, and (d) the target curve and its moving frames.
(a) (b) (c) (d)In Figure4 the target curve is the blue curve which is the target to track. T, N, and B, respectively, represent the tangent vector, principal normal vector, and secondary normal vector and they are the three orthonormal axes of the Frenet frame. Meanwhile T, N1, and N2 represent the three orthonormal axes of the Bishop frame.For the lengths of the intervals of three axes of the moving frames are different, there are some zoom in and out of these axes in Figure4 for the purpose of clear identification. In Figures 4(b)–4(d) it is easy to identify the tangent vector T of the curve as the red arrow. The other two axes such as N and B or N1 and N2 construct the orthonormal coordinate frames with T. In Figures 4(c)-4(d) the initial parameter θF of the Bishop frame is chosen as 50°. According to the definitions of the two moving frames, there is a superposition of them when that parameter equals zero.


## 3.3. Tracking Result

The beginning of the tracking action starts from the moment the UAV arrives in a small neighborhood of an arbitrary point of the target curve. The initial value of the speed vector of the body frame is chosen atVb0=200,0,-2 and the attitude angles vector is ϕ,θ,ψ0=0,2,0, where the units are, respectively, “m/s” and “°”. The high speed is needed to provide enough lift. Also a larger drag force, which is proportional to the square of the airspeed, is needed to keep the maneuverability in the forward channel. The opening range of the throttle is 0,1, which means the throttle cannot provide a force in the opposite direction. So the total force of the forward channel will not change its direction if the drag is not larger enough and finally it will result in an increasing forward speed. The result of trajectory tracking is shown in Figures 5(a)–5(d).Figure 5
(a) 3D trajectory tracking result, (b) tracking curves in the vertical direction, (c) tracking curves in the lateral direction, and (d) tracking curves in the forward direction.
(a) (b) (c) (d)Figure5(a) shows the 3D trajectory tracking result. From Figure 5(a) we can see that, during the simulation time of 900 s, UAV keeps on following the target curve with hardly any time delay. The mission of trajectory tracking is satisfactorily completed. Figures 5(b)–5(d), respectively, show the tracking curves with respect to time in the vertical, lateral, and forward directions of the inertial frame. As the airspeed of the UAV is about 200 m/s, the deviation could be quite large if the tracking method is not good enough. The vertical steady-state tracking error is less than 2 m within 0.8 s time delay, the lateral error is less than 7 m within 1.1 s time delay, and the forward error is less than 5 m, which are shown in these figures.


## 4. Conclusions

The moving frame tracking method devised in this paper based on the classical differential geometry is interdisciplinary. It is a trial to solve the trajectory tracking problems in a new direction avoiding the complex designing of the innerloop controllers. Although the innerloop controllers are simple, the whole flight control system in the simulation is much more complicated since a 6 DOF model of a large flying-wing UAV is employed. From the simulation it can be seen that a rapid, accurate, and safe trajectory tracking result is obtained.



---

*Source: 3406256-2016-11-09.xml*