Professional Documents
Culture Documents
SaB3.6
Department of Automation
XiamenUniversity, Xiamen, 361005, China
Email: luodelinI204@xmu.edu.cn
Abstract-During th e formation
(Pill )
I. INTRODUCTION
Through decades of development, UAV technology
gradually becomes perfect even tend to mature. At the same
time, the application ofUAV is increasingly wide and becomes
more and more important in many military and civil tasks, such
as battlefield monitoring and investigation, border patrol, forest
fire detection, public security monitoring and so on. Multiple
UA V formation flight and carry out a task is a hot issue in
UA V research field for the formation flight muItip IeUA V has
obvious advantage to single UA V. F or example, it is easily
limited by the angle of sensor when a singleUAV carry out a
task for it can not observe the target area from different
positions. ill the same situation, when face a wide range search
task, it is hard for a single UA V to cover the whole
surveillance area effectively. When it comes to execute strike
mission, there are much limitation to single UA V in many
aspects, such as fight range, lethal radius, and attack capability
and so on, that will reduce the success rate of the whole task. ill
addition, once a UAV breaks down in the midway, it has to
give up the task and get back immediately. It would most likely
to delay the opportunity even destroy the whole battle plan.
One of the most important problems is formation keeping for
UA V in formation flight research and we should solve it first.
Nowadays, there are a lot of relevant research literatures of
formation control [1- 11]. Formation transform of UAVs is
another important problem, UA Vs formation usually has to
transform from one to another. For instance, the UAVs
formation enters into a narrow canyon from wide airspace,
some UA Vs quit from the formation, state changing or plan
changing and some other situation would require the formation
transform in a certain time. At present, the research onUAV
formation transformation technology is not very common. Out
is the velocity
uix
is the control
uiy
is the control
264
variable along
Vi
x/vj
SaB3.6
vl
VI; Y1
is the horizontal
u.
viy uiy
I vix Vi cos (Ji
lviy Vi sin (Ji
r v..'X
lX
(I)
formation.
I sin
ld cos 81 - -l
I X 7' = x I- d 81
2
2
I
I
..[;,
.
lY2' = YI- ----;-ld 81 + -:;ld cos81
, ()
"q- 'L" 2
/
/
..[;,
UAV#2 /
(2)
S111
,/
,{"
\
I
,f3
sin 8
I x3' =xI 2 ld cos81 +-I
d
1
2
13 s.
I s8
I
lY3, =Yl --I
d 11181 --ld co 1
2
2
r
B.
- -
(3)
Fig 2.
de
dc
I
zy
lu.Iy =KPy e.Iy +KIy fe.Iy dt+KDy dt
c
(4)
, K
and
= Xl -xd(t)
lCly=YI-Yd(t)
c
Jl
(5)
Jl
ej y
X -x '
j
j
ll
Y j - Y j'
2,3
(8)
Vll
I coslJ'31
B -l
-
-BllV3
Where
In
ejX
(7)
--
Where
1- 1 model
(6)
265
coslJ'32
sin lJ'3
1l
sin lJ'32
SaB3.6
"
-'x
I
-'
l y
"
qi32
dV3x
---
IA
dt
(9)
dV3y
--dt
mr,(n
. . .
,-1,0,1,"')
j V3X 1
V3
l yJ
Ell
,Bll
3!
UA V# 1 and
ji
i!
61
'
ll
l 1j
l
q
-/ ) J
Tr .
(11)
Le
"'"(d31-'31(0)
*,
"2 ","(d32-'32(0)
-'31
/-
_
----+
\\ '
3
\\
//i \ : \
:V: : : : : \L
i
2ji
::::::::::::::::::"
----+
61
/\\ '6
'
3
(e) Triangle formation shrinkage adjustment
p q
[0, I]
Ii i'\''L2
-I
' COSqi31 Sinqi3Il ( l VICOS(!1I-qi31) l ' I31 l
(10)
=
l cosqi32 sinqi32 J
V 2 cos(!1 2 -qi32)
32
1 J
/':'LI'
4r///
26
"
(o)U(T; )
(O)lt/(T; )
(12)
*2-'32
In
is
, the coordinate
xI'
xI
,gl
cos
( Xl' Yl )
fj,
...........
(81 : J
+
(14)
(15)
:'fj, 3
We define the velocity ofuA V# I' as V
I'
IVI, l
V'I I , I
lVI y J
=
266
I dxl, l
I-I
I dt I
I dYI' I
l'dt"'J
(16)
SaB3.6
II
Ell
completion time Tr
4.5s .The simulation total time is
2
1.\,
20s' when t lOs , the formation receive instructions
Id
Id
(0)
9m
Initial velocity:
V (0)
I
81(0)
Initial velocity:
V (0)
2
1 5m,y (0)
2
25m
28m Is;
8 (0)
2
15 .
FU UAV#3:
illitial position: x3(0)
Initial velocity:
V3 (0)
Om,y3(0)
.E
N:;-
26m Is;
83(0)
20
-x
::::J
K Py
20;
K Ix
K Iy
O. I;
K Dx
lu 1
y
,0::;
10 9 ,
10m I
s2
K Dy
lux I
10 .
,0::; 109
time
Trl
2.5s
UA V#3
20
-I1.
\______________
________
_
10
...
;;,
15
20
50
-50
-1006
100
t(8)
(b)
'
-'--_________
_-------
4,
6,
8,
10
I(s)
12
,
14
16
18
20
{ tL-----I ---
completion
15
1
::
ot\-------; ----,-O-----,5----;l
1OO
-30m
DO
J; 20
10
t(s)
;;,
::t
10 .
DO
_N 10
::t '-----------------------4]1.
FU UAV#2:
Initial position: x (0)
x(m)
(a)
8m
0.'
25m Is;
\, -" -
/""'''''''
/
/
-30 ----
25m, YI (0)
.....
............+
. ..........
......
-20f+-----+-----+-----+----+_----+_----r_--__+
. In the UA Vs vertical
LU UAV#l:
Initial position: xI (0)
-10H------t-----+-------t------+-----+_----r_--__+
30m/s
, -+--/_
10 --+-----+-----+----+_----+_----r_--__+
\.
-+----+_ ----2of--'.---+-----+---- -_
- - ..
,,
I
O. s later than UAV#2.
30 ---------r--.---
A. simulation
td
transformation
(c)
267
SaB3.6
til
100
.E
:J
Ni
:::J
10
t(8)
50 -
----------'
-50-
2.
-100 .
:I\ I I I I I I I I II
:F I I I I lJ I I I I
:R I I I I "1' [ [ [ [ [
,
4
10
12
t(8)
(d)
,
16
14
,
18
20
B, (0)
'"
10
\,
.--'
>
0-+--4---+----+---+--
100
',---
200
-----------
400
300
----------- --
500
600
16
18
20
10
12
14
16
18
20
10
t(s)
12
14
16
18
20
-10
10
t(s)
12
14
16
18
20
10
t(s)
12
14
16
18
20
10
t(s)
12
14
16
18
20
10
t(s)
12
14
16
18
20
(d)
Fig 5 . Simulation results of the transform from slash formation to triangle
formation
simulation 3
10-+--4---+----+---+--
------------ ---------- ---
14
::rH\_+-___-+__ __+-_---1__
-+-
12
t21DII I I I I I II
llrl I I I t I I I II
C.
50r-----'--'------
10
(c)
"--+---+---+----1j
40 -1"--\'""""
40m ,
-10
20 m , and 10m
Om, Y 3 (0)
IIII
rlrllllFlIIII
-10
I ':III I tI
simulation 2
(b)
700
x(m)
(a)
268
SaB3.6
VI. CONCLUSION
ill this paper, aiming at the UAV formation flight
formation transformation, using PID control method to design
the UA V formation flight distributed formation control law,
and to design three kinds of conventional formation of
switching strategy, and design the formation switch control
law, make formation complete transformation in limited
time .Simulation results demonstrated the effectiveness of the
design.
30
.......... Formation flight path
- Leader tracking trajectory
----- UAV#2 trajectory
.... UAV#3 trajectory
'.
o--"+
--_+-----'-"-----------------------+---------- --- --------'---i
,,-
-10
-20
I, ". . ....
__
'-'-'-'-'.'.'
..........._._._..
-.... ....... ./-"
+;----+---_+--------+_--_+------____+
----700
00------5
--. 00
------,.-!v
"'
,;
-----.
o!
00---2
0
00
30;,,
60"'0
4-!v
-30
0
x(m)
[1]
(a)
[2]
[3]
[4]
(b)
r1111111111
r1111 rill II
-50
0
-10
0
10
t(s)
10
t(s)
12
12
14
14
16
16
18
[5]
[6]
20
18
[7]
[8]
20
[9]
(c)
rg I I I I I I I I I
Ullo [ [ [ t [ [ [ [I
-10
0
-10
0
10
t(s)
10
t(s)
12
12
14
14
16
16
18
18
[10]
[11]
20
[12]
Q.J. Fan,
REFERENCES
Z.
Yang,
T.
Fang,
20
(d)
Fig 6. Simulation results of triangle formation shrinkage adjustment
269