Академический Документы
Профессиональный Документы
Культура Документы
I. INTRODUCTION
ij
ij
ij
lij
d
Leader
Follower
Authorized licensed use limited to: IEEE Xplore. Downloaded on January 27, 2009 at 12:29 from IEEE Xplore. Restrictions apply.
mi
Mi = 0
J xi
0
0 , Ji = 0
mi
J xzi
0
mi
0
0
J yi
0
J xzi ,
J zi
(12)
NEDi
Bi
Bi
Bi
Bi
Bi
B = J i 1 B J i B + J i 1TB
i
PN EDi = B Bi V Bi
where V = [U ,V ,W ]T is
Bi
i
i
i
is
B = [ Pi , Qi , Ri ]T
(3)
(4)
the
the
velocity
angular
of i th
UAV;
velocity
of
i th
N i , Ei
i th UAV ; TB
i th
UAV; with
0
Bi = Ri
Qi
Ri
0
Pi
Q
Pi
(5)
,
tan i cos i
sin i
cos i
cosi
1 tan sin
i
i
i ( ) = 0
cos i
sin i
0
cos i
(6)
(7)
2i
1i
d 1i
1i
1i
1i
2i
d 1i
1i
Define e = x x
, and therefore x = e + x
.
2i
2i
d 2i
2i
2i
d 2i
(10)
i ( )
J i 1
(11)
e1i = g 1i ( x 1i ) e 2 i + g 1i ( x 1i ) x d 2 i x d 1i + d 1i
2i
there
law x
exists
1
1i
= g ( x1i )[ xd 1i
d 2i
(16)
desired
feedback
control
1
,
where
is
a
known
k e ]
g (x )
1i 1i
1i
1i
Using x
d 2i
where
,
d 1i
2i
Substituting
2i
cosi cosi
cosi sini
sini (8)
BBi = cosi sini +sini sini cosi cosi cosi +sini sini sini sini cosi
sini sini +cosi sini cosi sini cosi +cosi sini sini cosi cosi
i
1i
1i
and
(14)
j =j
1i
g o' = [0 0 9.805]T ,
(13)
ui = [ FBTi , TBTi ]T
(2)
i = i ( ) B i
J xzi = ( xi zi )dm
Authorized licensed use limited to: IEEE Xplore. Downloaded on January 27, 2009 at 12:29 from IEEE Xplore. Restrictions apply.
(17)
e 2 i = x 2i x d 2 i = f 2 i ( x1i , x 2 i ) + g 2 i u i x d 2 i + d 2 i
2i
2i
1i
2i
d 2i
rewritten as
e2 = F2 (.) + g 2 ui + d2 .
Now select a feedback control law
i
(19)
(20)
F2i (.) can be expressed as F2i (.) = W2Ti i (V2Ti z2i ) + 2i , where
z2i = [ x1T , x2T , xdT 2i ]T andV2 andW2i denote constant ideal weights,
i
and
Theorem 2.1: Consider the ith UAV dynamics given in (9) and
(10) and let the Assumption 1 and Fact 1 hold. Let the
unknown disturbances be bounded by d1 d1m
i
1i 1i
2i
2i
2i
2i
2i
k1 g1i (.) ,
0 with di d M i using
ki = i
di =
k2i
2
0
Assumptions defined above. Hence
2
(26)
V
x + tr{k x (W T W W T W )} + x d
where
min i
where
min
2i
2i
2i
2i
Mi
2i
2i
2i
2i
2i
2i
2i F
2i F
2i
we have
2
Vi mini xi
2i 2i
2i
2i
where
F2i (i) = F2i (.) F2i (.) = W2Ti i + 2i W2Ti i = W2Ti i + 2i .
1
1
1
Vi = e1Ti e1i + tr{W2Ti 2i1W2i } + e2i T e2i
2
2
2
(22)
or
)2
(30)
enough so that
[kiW2 M i 2 / 4 + d M i ] mini < bxi .
Therefore, any trajectory xi (t ) beginning in U x evolves
completely within U x . According to a standard Lyapunov
i
(23)
demonstrates
(28)
Authorized licensed use limited to: IEEE Xplore. Downloaded on January 27, 2009 at 12:29 from IEEE Xplore. Restrictions apply.
the
UUB
of
C. Formation Control
The desired trajectories for the follower can be obtained by
solving the kinematic equations (14) using input/output
feedback linearization technique as
cos 1
ij =
[ j lij ( ijd ij ) Vi sin ij + liji + ij sin i ]
(31)
d
V j = ij d j tan 1
th
(33)
where
e2 j = x2 j xd 2 j
B jd
PNEDd j = [ PN j , PE j , h jd ]T
equation
(34),
B = [ Pj , Q j , j ]
jd
jd
h jd
is
the
desired
flying
height.
Combining , P
and equation(9), W , P , Q can be
j
j
jd
NEDd j
j
calculated respectively. So x =[vT ,T ]T from (34).
d 2j
Bjd
Bjd
Now considering e = x x , its derivative is given by
2j
2j
d2j
(35)
e 2 j = x 2 j x d 2 j = f 2 j ( x1 j , x 2 j ) + g 2 j u j x d 2 j + d 2 j
where d
2j
(36)
2j
2j
(37)
2j 2j
(i )
is the
d sin i
d cos i x j
lij
vj
=
j
expressed
ij
as
ij
ij
(34)
T
2j 2j
where
weights, and
2 2N
j
.Since W is the
2j
2j
or
F2 j (i) = W j (V z ) + 2 j
T
2j
ij
j =
vi cos ij
cos i
sin
fij ( xij ) = vi sin ij
,
g
(
x
)
=
i
i ij ij
lij
lij
ij
i and j are
rewritten as
j = j
vj
2j 2j
2j
2j
Authorized licensed use limited to: IEEE Xplore. Downloaded on January 27, 2009 at 12:29 from IEEE Xplore. Restrictions apply.
1 T
1
1
eij eij + tr{W2Tj 21j W2 j } + e2 j T e2 j
2
2
2
(39)
(40)
bounded.
Theorem 2.3: Consider the ith UAV dynamics given in (9) and
(10) and let the Assumptions 1 and 2 hold. Let the unknown
disturbances for each UAV be bounded. Let the control input
for each UAV be given by (20) and NN weight tuning be
provided by (23) for the leader UAV. Let the desired
trajectory and its derivatives for the leader, for instance i = 1 , is
bounded. Let the desired control input for the follower UAVs
be provided by (37). Then the formation is stable.
Proof: The proof follows from Theorem 2.1 and 2.2.
III.
Authorized licensed use limited to: IEEE Xplore. Downloaded on January 27, 2009 at 12:29 from IEEE Xplore. Restrictions apply.
IV.
SIMULATION RESULTS
1331.41
J xz =
VI.
REFERENCES
1.
2.
3.
4.
5.
6.
7.
8.
9.
Follower1
Follower2
Initial Condition
x0
y0
z0
v0
0
-50
50
0
0
0
0
0
0
0
0
0
0
0
0
Leader1
13
12
l12
l13
Follower3
Follower2
CONCLUSIONS
Authorized licensed use limited to: IEEE Xplore. Downloaded on January 27, 2009 at 12:29 from IEEE Xplore. Restrictions apply.