Documentos de Académico
Documentos de Profesional
Documentos de Cultura
m2 g
Parameter
acceleration due to gravity
length of first link
length of second link
mass of first link
mass of second link
center of mass of first link
center of mass of second link
inertia of first link
inertia of second link
damping of first joint
damping of second joint
motor gain
motor electrical time constant
Value
9.81 ms2
0.1 m
0.1 m
0.125 kg
0.05 kg
-0.04 m
0.06 m
0.074 kgm2
0.00012 kgm2
4.8 kgs1
0.0002 kgs1
50 Nm
0.03 s
Physical Modeling
m1
l1
M () + C(, ) + G() =
0
with
m1 g
motor
Control Objective
Design a controller to stabilize the second link in the upright
position. It is easier to start with the stable equilibrium (both
links down) and just make a controller to damp the swing (like
an overhead crane). The controlled system should have zero
steady state error in 1 (small oscillations around the reference are permitted, as these are caused by Coulomb friction
and stiction and are difficult to avoid when using linear control only) and adequate disturbance rejection properties, i.e.,
it should be able to recover from a small tick against the pendulum.
T + e T = km u and =
1
2
Here, are the joint angles, M is the (positive-definite) inertia matrix, C contains the Coriolis and centrifugal forces, G
contains the effects of gravity, and T is the torque applied to
the first link. The matrices are:
P1 + P2 + 2P3 cos 2 P2 + P3 cos 2
M () =
P2 + P3 cos 2
P2
b1 P3 2 sin 2 P3 (1 + 2 ) sin 2
=
C(, )
P3 1 sin 2
b2
g1 sin 1 g2 sin(1 + 2 )
G() =
g2 sin(1 + 2 )
with
P1
P2
=
=
m1 c21 + m2 l12 + I1
m2 c22 + I2 ,
P3 = m2 l1 c2
g1
(m1 c1 + m2 l1 )g,
g 2 = m 2 c2 g
Simulink Template
A Simulink template rpendtemplate.mdl contains the
necessary real-time interface blocks and some scopes. Make
your own copy of this file and use it as a starting point for your
experiments. Before starting the first simulation, define the
sampling period h as a variable in the workspace of M ATLAB.