20
21
2.
Dynamics
of a Mechanical Drive
Power
Power
supply
supp/y
fO
b
a
c~JP
F
ig.
2.3.
Block
diagram
of
twin-inertia
drive
with
flexible
shaft
(a)
Model of mechanical
plant,
(b)
Reduced
order
model,
c)
Mechanical
transmission
with
backlash
2.2
Two
Axes
Drive
in
Polar
Coordinates
On
machine tools or robots
there
are
normally several axes of motion,
that
rnust be independently driven or positioned. An example is seen in Fig. 2.4
a, where
an
arm, carrying a tool or workpiece, is
rotated
by
an
angle e:(t)
around
a horizontal axis.
The
radial distance
r(t)
from
the
axis
to
the
cen-
ter
of
the
mass M
2
represents a second degree
of
freedom, so
that
M2 can
bc positioned in po
lar
coordinates in a plane perpendicular
to
the
axis.
The
rotary
and
radial motions
are
assumed
to
be
driven by servo motors, produc-
ing a controlled driving
torque
mM
and
a driving force
1M
through
a
rotary
gear
and
a
rotary
to
translational
mechanical converter, for instance a
lead
screw.
With
fast
current
control
the
motors are generating nearly
instanta-
\ICOIlS
impressed torques, serving as control
inputs
to
the
mechanical
plant
o
For simplicity,
the
masses are assumed
to
be
concentrated in
th.e
joints, re-
sltlt.ing in
the
inertias
h,
J
2
.
The
coupling
terms
of
the
motion can be derived
by
(~xpressillg
t,he
acc
e
h~ration
of
the
mass M 2 in complex
formo
dr
!l . )
(2.8)
(1'
( .
.1
'
('II
I
:i
r
w)
(
.3
~
,
dI
(li
,,
~
\
,(
J.
)'
(/L'II
I_,
.}
.
~
;I
,.
)
t'
I
(,
.
.\1 "
(
,
'~~
(LI
'
fi
I
'I'
Il
lU
)
('
j '
' I
(/
..
!J
)
. (
1<
i' )
dI
,
11
',
\
,II
~
,
d'
2.2
Two
Axes Drive
in
Polar
Coordinates
where w =
dE;
/ dt
and
v = dr/
dt
are
the
rotational
and
radial
veloci ties. After
separating
the
terms
of
acceleration in
tangential
and
radial direction
and
superimposing frictional
and
gravitational
components, Newtons law is ap-
plied in
both
directions, resulting in
the
equations for
the
mechanical
motion
of
the
centre
point of M
2
J
r,,-_~A
,
dw
(ll
+ h
+M2r2)
dt
=
Coriolis
Gravitation
,...-"'-...
,.-"'-----....
mM
-
2M
2
rwv-M
2
gr
cose:-mF
-mL,
(2
.10)
de:
dt
= w , (2.11)
C e
ntrifugai
Gravitation
dv
M
2
dt
= 1M +
,-"--..
M
2
r w
2
,...-"'-...
-
M
2
g sine: -
lF
-
h,
(2.12)
dr
dt
= v .
(2.13)
The
equations (2.10)-(2.13) are depicted in Fig. 2.4 b in
the
graphical form
of a block diagram, containing four integrators for
the
state
variables. Despite
the
simple mechanics,
there
are
complicated interactions, which become more
prominent with increasing
rotary
and
radial velocities.
The
control of this
mechanical
structure
is dealt
with
in a
later
chapter.
Clearly,
the
two motions
are
nonlinearly coupled
though
gravitational,
Coriolis-
and
centrifugaI effects; they are described by four nonlinear
state
equations.
mF,
lF
and
mL,
h are due
to
friction
and
external load forces
with
may
exhibit
their
own complicated geometric or dynamic dependencies,
If
it is
important
for
the
application
to
express
the
position of mass M
2
in
cartesian coordinates, this is achieved by a
polar-cartesian
conversion
x (t) = r cos
e:
,
(2.14)
y(t) = r sine: .
(2
.15)
Moving
the
arm
also in
the
direction of
the
axis
of
rotation,
so
that
the
mass
M
2
can be positioned in cylindrical coordinates, would introduce a
third
dccoupled degree of freedom.
The
dynamic
interactions for a general motion, involving six degrees of
r)'(
~e
dom
(three for
the
position,
three
for
the
orientation
of
the
tool) are ex-
('
cedilJgly complicated,
they
must
be dealt
with
when controlling
the
motions
01'
Jllult.i
a
x
(
~
s
ro
uots
with high dynamic performance [M53,
013,
849].