Академический Документы
Профессиональный Документы
Культура Документы
Guowei Cai, Ben M. Chen, Kemao Peng, Miaobo Dong and Tong H. Lee
Abstract-We present in this paper a linearized hovering
model of a UAV helicopter obtained using the in-flight data
generated through a perturbation method. The UAV helicopter
is constructed from a radio-controlled helicopter by integrating
an onboard system, which includes a data processing unit,
a data acquisition system, a wireless communications and all
necessary sensors. A flight control law is then designed using a
newly developed nonlinear control technique, i.e. the composite
nonlinear feedback control. Actual flight testing shows that the
design is successful.
1. INTRODUCTION
(DSTA) of Singapore.
{gO301341,bmchen,elepkm,eledm,eleleeth}@nus.edu.sg
B'V
(1)
(46
I tanO sin
cosq
=0
sin
L
CosO0
tan Ocosq
,
-sin
cosX J
CosO0
given by
FJx
Jxz 1
0
J=
Jy 0
L-Jxz
Jz j
with the elements, J*, being related moments of inertia and
product of inertia, respectively. Q is a cross-product operator,
i.e.,
Q,
a.o x
Cos Cos
cos 0 sin<
-sin 0
-sinoXcos'ob+cosoXsin0sin b
sin ) cos 0
(3)
[-sinalsin&i
-cos3-
-CO5ai
s 1in
1
sin a, cos 01
[-a,
Mm
\VHmJ
Qm + QmpFm
gm
I9ai" D9MY(b10
0
(
(5)
()
()
a,
jI)Ht
j
sinai
Lo
where ai is the
climbs and
F 01
)Mt= I
L
Qt+QtpFtA
(9)
Zt
Ytl
0 - It
(10)
0
xt
LYt
where (xt yt Zt)
(xt 0 Zt) is the position of
the tail hub in the body frame. Tt, Ht and Qt are the
aerodynamic forces and moment generated from the tail
blade. The Tt is starboard and perpendicular to the tip path
plane of the tail blades. Ht is perpendicular to the tail rotor
shaft. Qt is with respect to the tail hub, which is starboard
and perpendicular to the tip path plane of the tail blades.
Ff
Zt
[-sin ai 0 -cos ai
0
1
-cos ai 0
0
sinai
L\
|S ',Mf
DJ
Mfx\
MfyI
(11)
MfzJ
where the lift L and drag D are expressed in the wind frame
[8] and the S is expressed in the body frame. Mf is defined
with respect to the gravity center of the helicopter.
Note that the orientation of the tip path plane of the main
blade with respect to the plane perpendicular to the main
rotor shaft is described with a, and
The dynamic of the
be expressed using the
tip path plane of the main blade can b1.
first harmonics in the Fourier series as follows,
1a
bi)
where 6pitch
At
PP
+ Btpp
pth
(bi) +roii~
(12)
bi
0
where Q is the sideslip angle and
=i ATAN2(ai, b1), az1 = (a2l + b2)1/2.
Ft= I1
Qtp
sina,1
az1Cos
cos 1-lnl sin
osi /3,a ( Tm
= sin
FmFm
F0 -Cos a 1 Tt
cos XcosO
h=-[0 0 1]P.
(7)
Wf
(8)
af~
~W,(3
where Wzf iS the state variable. aZf and bZf are constants. The
control input signal, dpeda1, to the yaw channel servo will
(vN
=At) K) + [Ri
0(
bi I
j +gEgyj, (16)
a
\pedal
a,
ao, bi b1-b0,
- blo,LI
where al a=a- a1,
b161=
5col =co1 - co1,0,
(5pedal = (pedal - 5pedal,O. alo and blo are the trim values of
a, and b, at the hovering respectively.
~ -g 0- -1 O0
~t* * 0 0 0
O g
O 1
0 A0\ 0 0 *
j
where
Ab
a,
0 * * 0
* 0 * *
clinearized
A 00 0
B2 B3]
B,
A
A
* A
A A
0 0
0 0
_* A A 0 0 A_ 0
B2=[0 0 A 0 0 A]/,RB3J0 * 0 * 0 A]',
where A denotes the key elements to be identified, * denotes
minor elements and 0 denotes 0 or near to zero. The
linearized model of the UAV helicopter can be obtained by
combining (16), (12), (13) and (14) as follows,
_%
bi
)
1Btpp
W~)Zf
0 1
| 0 tdrol
bzf]
l
r)
Btpprllj
o.
where 5-pedal
IV
Ab+R3
[0 dzf] B, R3Czf
0 ELO] Atpp o
~~*W!
5pedal 6-5pedal,Oi
-~~~
/i
zf
+g Eg I
f
R0
0R
wher
-1
Ax + Bu,
where
(18)
Sgx
wz7
and
-0.1778
0
A=_A=
0
-0.3104
0
0
00
1
0
0
-1
01
0
0
0
0
0
0
0
0
0.3326 -0.5353
-0.2940
00
00
0.1903
~ -
0
0
00
0
~~0
~~
2 005
ip-0.6821
0_Theidentified-0.1446
0
-0.1070
-5.5561
~~~~
lI
-9.7807
-9.7807
0
0
0
0
0
0
~~~0
00
172.6200
9.7807
0
1
0
0
0
0
0
T0
a
-36.6740
00
10
00
-8.1222 4.6535
-0.0921 -8.1222
0
0
0
~~
0.0496 2.6224
9.7807
75.7640 -59.958
343.86
01740
0242
0
0
0
1 0120 n
0170
0
0
00
~~~~~~~0
0
0
0 0
15.6491
1.6349
-58.4053
(z42 [ Eg]ign a s o p
Th
2.49
L0
0
l.gO
trim values of the control commands for hovering are
+0T
~~5pedal
~~(17) 6roll,O =0.05 rad, 5pitch,O =0.02 rad, 5co1,O -0.22 rad,
and 5pedal,O =0. The angular rate of the main blades is set
and
The perturbation method is adopted to identify the unknown parameters in the linear structural model. Since the
.5
726
725
727
728
729
730
731
732
733
726
725
727
728
729
730
731
732
733
735
734
734
7.35
734
7.35
-0.5
__------__
727 726 728
729
730
731
05,25
732
\;;- D.S.;;
v --
''--"'.,--
733
CA
(19)
z+ Ba(
consider
>-.0th
=C2X
-1.5
b. Velocity.
Fig. 2. Verification of the identified model. Solid line: experimental, Dashed
line: identified.
r
Ui
Control Law
AcWaors
-1
Outer
Control Law
Uf
FlightbyC
Scheduling
ut
-1
Fig. 3.
0 1 0 0 0 0 0 0 0 0
0 0 1 0 0 0 0 0 0 0
-=
Io
O-
0
0
1 o o o o o o o
00000
1 o00
o o o o10
o o0 01
o o
o o o o o o o o 1 o o
o0 o o o o o o o o 1 o-
C2 =
0 ]
0 0 0 0 0 0
000000 0 1 0 0
IO
L
00 0 0 0 0 0
UL Fx + Gr,
(20)
where r is the reference, r (V, wo)' with VI and wo,
being the velocity command and yaw angular rate command
respectively.
r 0 -0.0240 -0.0157 0.0169 -0.3015 0.0404 -0.1042
F=036
0 -.18-.29-.32-.95-.04
F
0
0
0
1.3900o
01, G-In07 n;
0
0.01 -0.1900 01
0
0 0.0854 0.0068 j
diag F .01
.01
.01
.01
.01
.01
.01 25
o
o
o
o
0
0
1.00 0
0
1.0000
3.5 x
.01
10-3 .011
j L
~~
~~
0
0
0
0
0
0
0
0
0
0
0
0
0
1.0000
0
0
0
0
~~~~~~~~~~~~~~~~~~~0
0
1.0000
-0. 1500-
0 0 0
B/P
0.0873
0.0445
0.0573
0.0877
0.9503
4.7897
0
0
0
0
0.0587
1.5038
(24)
~~~~~~~~~~~0I
u FJc+ Gr + pB'P(J-Ger),
0
0 1
where
the
nonlinear
function matrix p is chosen as
0
0
0.6760
0
0.3532
p = diag
-0.0864 0.2116
pi
P2
P4 }
(25)
uN = pBIP(x - Ger),
(21)
where p is the nonlinear function matrix to be defined later
and
- 10000
00000
0n
-0.000
1.00
0
0
_0 0175 -0.00021
Ge0=
Ge
0.0011
-0
0
0
1.000 -0.0000
1.0000
0.0011
-0.0011 0.0306
-0.0175 -0.0021
-0.0000
0.2474 -
Q2
Ve)
Fx + Gr + pB'P(x - Ger).
(22)
4=
kp(P- &Pc)
(27)
Kh bdiagm[
),(23)
up = UO +U,
(28)
where ut and uo are the practical control inputs and the trim
value of the control inputs at the hovering.
xc
Acxc + Bc(Y
*r = Cc ( y
xc
B, =
Lo
[0.0062 0.0201
0.0147
17.5 108
-5.6065
0.0297
0.0355
-2.2918
4.2 128
0/
-1.8334 0 0
-0.5275
0 0
0 0 -0.0217
0 0.0496 2.6224 0
0
0
2.4928 0.1740
0
0
4.4078 0
0 0.2452 -8.7608
K1010
0.0500
(29)
= (Ve WJze).
D. Simulation and Implementation
The overall flight control law is verified with simulation
and flight tests. In our simulation, the trim value is neglected
0 0 0 1.
~~~~~~ ~~
0
0
0 1.0 .0
00 0 0
0 1 00000
cc
=
00100
K
UO
-24.7156
0
0
- 16. 6131
~~~hovering
=-(1
~~~~~~~~~~~~~~2.2
2.4~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
0
0.6
-1
~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~0.
0.2
.2
~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~0-.
10.64
10
.18
10
10.
50
55
53
~ 11-01-11-~
~
~
~
7
17-1 01-1
~~~~~~~~~~~~~~~~~~~~~~~~~10
21
51
0......
I~~~~~~~~~~~~~2
...2
.0..
.2
helicopter
Fig.4.
Simulation:
hovering.
2 2 3
505)
55
Fig 5.
b.4Cotrolignal
InFiue40.6yz)' h eiotrsccsflyRFRNE
the initial state disturbaces. The flight control la has also
for nonlinear cotrol," Proc. of 1999 IEEE nternational Conference o
oiope tke
onro
d
UeposingCarie PhaeGpositonly, PhDeDisertto,SadnfodrdctUnivriy
~
~
~
1
0-3~
wthdfo h
heiotri4
~ ~ ~ ~ ~~~~~S,
95
aulmd oteatmtc
[]V arlt,A
in
withi
xy
-h
05
0.
22
07
ic
heebr,M
ytm fra ml
7]E2005.
N. Jono-
.K
.Dhe
.Frn
Ain
n andheiotrprorigagesv
ann
Aapietaetr
oto
....
CONCLUSION
Krige Pubisin Comany Floida USA, 1990.
3
0
0-3 2 4 6 8 1 0 1 211D1H Shm,H.J4Kim an S Ssty, Cotrl ystm esgnfo
~~~~~~~~~~~~~~~~~rtrrf-bae0 nand eilvhcl sn1ie-oansse
The modelingandflight ontrol system design ofthe
identification," Pro. of2000IEEE Internatioal Conference on Contro
002F
20
havbee prsne-oehrwt
iuato
n0cults
1]Manitliet0
2ueo4 .Hrn,S
aaua n .KtuDvlpeto
nandhliotr"Po.2f196EE nentoa
525