Академический Документы
Профессиональный Документы
Культура Документы
Magnus Gfvert
1. Introduction
This report contains derivation of the dynamics of the ETH helicopter laboratory process, see Figure 1, using the Euler-Lagrange approach. The process is designed at the Automatic Control Laboratory at ETH in Zrich,
see Mansour and Schaufelberger (1986) and Schaufelberger (1990). A description of the setup is found in Morari, M., W. Schaufelberger and A.
Glattfelder (1995). The process is of MIMO type with nonlinear dynamics, and static input nonlinearities, as will be shown below. The present
model is derived with the purpose of accurate simulation of the helicopter
process. It may also prove helpful for nonlinear controller design. Identification of a linear model, and a linear controller design is presented in
kesson, Gustafson and Johansson (1996).
Figure 1
2. Kinematics
It is assumed that the mass distribution on the lever arm is restricted to a
straight line between the rotors, a distance h from the pivot point. Denote
by O P an origo on this line. Let [r x ( R), r y ( R), r z ( R)] denote a point P on
the lever arm parameterized in the distance R from O P , expressed in an
earth fixed reference system with origo in O and oriented with ez along the
3
l1
PSfrag replacements
R1
l2
R2
OP
L
ez
O
ey
ex
Figure 2
(1)
(2)
The squared magnitude of the velocity of P is then given by v2( R) = v2x( R)+
v2y( R) + v2z ( R):
v2( R) = R2 2 + cos2 2 + h2 2 + sin2 2 2hR cos sin 2
(3)
3. Energy expressions
The kinetic and potential energies are derived from
Z
1
v2( R) dm( R)
T=
2
Z
V = g r z ( R) dm( R)
4
(4)
(5)
where g is the acceleration of gravity. With (3) inserted this yields for lever
arm
TL =
1
1 2
+ cos2 2 JL h cos sin 2 mlc + h2 2 + sin2 2 m
2
2
(6a)
VL = mg sin lc + mg h cos
(6b)
(6c)
(6d)
* R
where the inertia of the lever arm JL = R2 dm( R), the center of gravity
* 1 R
* R
of the lever arm lc = m
R dm( R), the lever arm mass m = dm( R),
and the center axle inertia JA have been introduced. The total kinetic and
potential energies are
T = TL + TA
V = V L + VA
(7)
(8)
4. Equations of motion
Forming the Lagrangian
(9)
L=TV
the equations of motion are given by
d VL
dt V
d VL
dt V
VL
=
V
VL
=
V
(10)
2 cos sin + cos2 JL +2h sin2 cos2 cos sin mlc
+ h2 2 sin cos + sin2 m + JA = (11a)
+ cos sin 2 JL + h sin2 + cos2 2 + g cos mlc
+ h2 h2 sin cos 2 g h sin m = (11b)
D ( , ) + C( , , , ) + g( , ) =
(12)
Figure 3
0
2 cos sin JL 2h sin2 cos2 mlc 2h2 sin cos
JL + h2 m
cos sin JL + h sin2 cos2 mlc + h2 sin cos m
2 cos sin JL 2h sin2 + cos2 mlc + 2h2 sin cos m
*
N ( , , , ) =
g( , ) =
*
C( , , , ) =
cos sin JL + h sin2 cos2 mlc + h2 sin cos m
cos sin JL + h sin2 + cos2 mlc h2 sin cos m
D ( , ) =
5. Rotors
The rotors are driven by DC-motors without current-control. The motor
operation is described by
d
ia = Ra ia k + u
dt
d
J = Td TL
dt
La
(13a)
(13b)
where Ra and La are the rotor-circuit resistance and inductance respectively, and k the motor constant. The driving moment is described by
Td = kia
(14)
TL = D e e
(15)
Ra D
0 e 0 e+ k 0 k 0
k
(16)
(17a)
(17b)
and for R2 :
1, = D1 1 e 1 ecos
1, = l1 C1 1 e 1 e
(18a)
(18b)
2, = l2 cos C2 2 e 2 e
2, = D2 2 e 2 e
(19a)
(19b)
= 1, + 2,
= 1, + 2,
(20a)
(20b)
6. Simulation model
The complete set of equations describing the helicopter process is given by
(11) together with (17)(20). Rewriting these on state-space form gives
1
d 2
= cos JL 2h cos sin mlc + h2 sin2 m + JA
dt
2 cos sin JL 2h sin2 cos2 mlc 2h2 sin cos m
+ D1 1 e 1 ecos + l2 cos C2 2 e 2 e]
(21a)
d
=
(21b)
dt
1
d
= JL + h2 m
cos sin 2 JL h sin2 + cos2 2 mlc
dt
g cos mlc + h2 sin cos 2 m + mg h sin + l1 C1 1 e 1 e+ D2 2 e 2 e
(21c)
d
=
(21d)
dt
1
1
d
1 = 1 +
u1
(21e)
dt
T1
k1 T1
1
1
d
u2
(21f )
2 = 2 +
dt
T2
k2 T2
7. Equilibrium points
Equations (11), (17) (20) may be solved for stationary points ( 0 , 0, u1,0 , u2,0 )
by setting = = = = 1 = 2 0:
0 = D1 1,0 e 1,0 ecos + l2 cos C2 2,0 e 2,0 e
(22a)
(22b)
mg
mg
[h sin lc cos ] =
[h cos 0 + lc sin 0 ] + O ( 2)
JL
JL
mg cos 0 2
=
h + lc2 + O ( 2) (23)
hJL
*
8. Parameters
Parameters for a real helicopter process are presented in Morari et al.
(1995). Geometric and interial parameters are presented directly. Motor
and rotor properties are presented in graphs resulting from experiments.
The corresponding parameters presented here are computed from the graphs.
Description
Parameter
Value
Unit
Arm length to R1
l1
0.1995
Arm length to R2
l2
0.1743
ml
0.280
0.0298
mw
0.158
lw
0.090
m1
0.3792
Mass of rotor R2
m2
0.1739
T1
1.1
T2
0.33
k1
1.00 102
k2
1.39 102
C1
2.50 105
C2
1.58 106
D1
2.90 107
D2
1.76 107
[m ]
[m ]
[kg]
[m]
[kg]
[m]
[kg]
[kg]
[s]
[s ]
[Vs/rad]
[Vs/rad]
[Ns2 /rad2]
[Ns2 /rad2]
[Nms2 /rad2 ]
[Nms2 /rad2 ]
Pivot height
Mass of weight
Distance to weight
Mass of rotor R1
(nominal1 )
Table 1
(24)
The moment of inertia for the lever arm is the sum of the moment of inertia
for the solid lever bar and for the point masses of the rotors and the weight:
JL =
ml l13 + l23
2
+ m1 l12 + m2 l22 + mw lw
3 l1 + l2
(25)
(26)
m l ( l 1 l 2 ) + m 1 l 1 m2 l 2 mw l w
m
(27)
9. Bibliography
kesson, M. and E. Gustafson and K. H. Johansson (1996): Control Design
for a Helicopter Lab Process, Preprints 13th World Congress of IFAC,
San Francisco, California.
Mansour, M. and W. Schaufelberger (1989): Software and laboratory experiments using coomputers in control education. IEEE Control Systems Magazine, 9:3, pp. 1924.
Morari, M., W. Schaufelberger and A. Glattfelder (1995): Klassische Regelung
eines Helikoptermodells, Fachpraktikumversuch A50, Institut for Automatik, ETH, Zrich, Rev. 6, Nov. 1996.
Schaufelberger, W. (1990): Educating future control engineers. Proc. of
IFAC World Congress. Tallin, Estonia, pp. 3951.
Weick, F. E. (1926): Propeller design I: practical application of the blade
element theory, NACA TN 235, Langley Memorial Aeronautical Laboratory, Washington.
10