Professional Documents
Culture Documents
Sliding Mode Based Integrated Guidance and Autopilot For Chasing UAV With The Concept of Time-Scaled Dynamic Inversion
Sliding Mode Based Integrated Guidance and Autopilot For Chasing UAV With The Concept of Time-Scaled Dynamic Inversion
I. INTRODUCTION
1598
R = (x R
yR
0 0)
zR )
(3)
(4)
s1
s 2 )T
(5)
where
s1 = z R / R , s 2 = y R / R
(6)
The problem is to guide and control the UAV into the target
aircraft direction in a way that the vector of Eq. (5) converges
to zero vector, or the variables s1 , and s 2 tend to zero.
III. INTEGRATED GUIDANCE AND AUTOPILOT
The objective in this study is to reduce the variables, s1 , and
s 2 in Eq. (6) with respect to the velocity axes and not the
inertial frame. Hereafter, the time derivative with respect to
the velocity axes, denoted by a prime; ( ) is referred as a
primed time derivative in this study. Taking the primed
time derivatives of s1 and s 2 in Eq. (6) yields
s1 = a + b1
(7)
s 2 = a cos + b2
(8)
b1 = y R tan / R VT , z / R
b2 = z R tan / R + VT , y / R
(13)
Sideslip angle, , angle of attack, and bank angle,
form the second intermediate control variables. Since the
sideslip angle, should be always attenuated regardless of any
frame, the usual time derivative can be taken for s3 as
s3 =
(14)
Using the definition in Eqs. (9) and (10) leads to the primed
time derivatives of s1 and s 2 as
s1 = a(c11 + c12 ) + d 2,1
(15)
s 2 = a(c 21 + c 22 ) + d 2, 2
where
ac11 0 ac12
Gs = ac21 0 ac22
0
1
0
2 n s1 + n2 s1
g s = 2 n s 2 + n2 s 2
2 n
f ( , )
f ( , )
)T = Bs + d s
where
cos tan
B s =
sin
cos / cos
f ( , )
+ FT cos )sin /( mVUAV )
(18)
Note that the dynamics of the angle of attack, the side slip
angle, and the bank angle can be described through their
relation to the body rates, = ( p q r ) T , as
(16)
where
= G s + g s
f ( , )
d s = (d s ,1
d s,2
1 sin tan
0
cos
0 sin / cos
d s ,3 )T
d 2,1 a f ( , ) + b1 0
d 2, 2 a f ( , ) + b2 0
(17)
= s 2 + 2 n s 2 + n2 s 2 2
s3 + 2 n s3
3
where , the damping coefficient is set at a value of 2 / 2 ;
n , the natural frequency for the sliding surface is treated as a
design parameter. It is interesting to note that the highest
order term in each component in Eq. (17) corresponds to the
fast states (body rates), and the second highest-order terms
correspond to the slow states (angle of attack, sideslip angle,
and bank angle), and the variables, s1 , and s 2 correspond to
the flight path angles(flight path angle and heading angle). If
the dynamics reach the sliding manifolds of Eq. (17), the
-dynamics converges to zero with time. During this time,
the rotation rates, and the attitude and flight path angles will
gradually converge, with the time-histories dictated by the
design parameter, n . Substitution of Eqs. (15) and (16) in
Eq. (17) yields
(19)
(20)
expressed as
= B f u + d f
(22)
where
B f I m 1q D SW diag (bCl ,a , c C m,e , bC n,r )
Ix
I m = 0
I xz
I xz
0
I z
0
Iy
0
d f = I m (d f ,1
d f ,2
sigmoid ( i ) =
d f ,3 ) T
d f 1 ( I y I z )qr + I xz pq + q D SW bClp p
d f 2 ( I z I x ) pr + I xz (r 2 p 2 ) + q D SW c (C m 0 + C m + C mq q )
d f 3 ( I x I y ) pq I xz qr + q D SW b(C n + C nr r )
= T (G s Bs B f u + G s Bs d f + g s + d 5 )
(25)
i =1
i =1
VL = i i + d 5,i i < 0
(27)
1 + e i
i max
(29)
VL = T
i max
1 e i
Initial
Values
yI :
[m]
y ITGT :
0.0
[m]
1524
[m]
h:
524
[m]
hTGT :
V:
154
[m/s]
VTGT :
154
[m/s]
[deg]
TGT :
0.0
[deg]
:
Parameter
values
-2000.0
0.0
Rd (desired distance):
n :
/3[rad/s]
k;
20 (1/s)
200 [m]
IV. SIMULATIONS
We conducted several simulations to demonstrate the
performance of the proposed integrated guidance and control
system using the YF-16 model [15], whose aerodynamics is
highly non-linear. One set of representative simulation results
is presented in this paper. Table 1 gives the initial condition
and parameter settings of these simulations. For comparison
purposes, the simulation results using a conventional PPG
with a dynamic inversion (DI) controller (PPG/DI) [6] are
also presented. A dynamic inversion velocity controller is
used to keep a desired distance from the target in both
PPG/DI and SMIGC simulations. Navigation constant for the
PPG is set as 2. A target aircraft is flying straight while a
UAV is initially located behind the target with some offset.
DI velocity controller is applied to keep the desired distance,
Rd . The following assumptions were made to simplify the
problem and to demonstrate the total system performance.
1) Ambient atmosphere is stationary and the earth is flat.
2) Mass of the aircraft is constant.
3) The aircraft states are available and aerodynamic
uncertainties are negligible.
4) The target aircraft's position, heading, flight path, and
velocity are available.
1601
REFERENCES
[1]
[2]
[3]
[4]
[5]
[6]
[7]
[8]
[9]
[10]
[11]
[12]
[13]
[14]
[15]
V. CONCLUSION
A sliding surface structure based on PPG and intermediate
control variables of the sliding surface vector are developed
for use in an IGC approach with sliding mode. The proposed
sliding surface vector achieves excellent roll and pull-up
motions. Performance of this technique where only 2
parameters need to be tuned was compared with the PPG/DI
approach having 7-parameter tuning and the results show that
the SMIGC is better in some representative simulations.
ACKNOWLEDGMENT
The first author wants to thank the National Defense
Academy of Japan for giving permission for conducting
guidance research at the Missouri University of Science and
Technology.
1602
2000
UAV
Target
h (m)
h (m)
2000
1000
0
UAV
Target
1000
0
12000
12000
10000
10000
8000
8000
6000
6000
4000
4000
2000
2000
xI (m)
0
-2000
1000
0
-1000
-2000
3000
R (m)
4000
3000
2000
1000
0
20
40
60
80
100
LOS (deg)
LOS (deg)
20
20
40
20
60
80
100
20
40
60
80
40
60
80
100
40
20
0
100
Time (sec)
4
2
0
(deg)
(deg)
20
40
60
80
100
0
-50
-100
(deg)
50
20
40
60
80
100
0.5
0
-0.5
(deg)
(deg)
40
60
(deg)
yI (m)
1000
Time (sec)
20
40
60
80
100
20
10
0
20
40
60
80
100
20
40
60
80
100
20
40
60
80
100
100
50
0
-50
10
0
-10
Time (sec)
Time (sec)
, , ,
e a r
10
, , ,
e a r
1000
2000
60
-2000
0
-1000
-2000
4000
yI (m)
R (m)
xI (m)
e -25 e 25
a -20 a 20
r -30 r 30
-10
-20
20
40
60
80
20
0
-20
0
100
20
40
60
80
100
Time(sec)
Time(sec)