Professional Documents
Culture Documents
Google PDF
Google PDF
Usoro
A Finite Element/Lagrange
Division Director.
Approach to Modeling Lightweight
R. Nadira
Research Engineer.
Flexible Manipulators
Scientific Systems, Inc., This paper presents a finite element/Lagrangian approach for the mathematical
Cambridge, Mass. 02140 modeling of lightweight flexible manipulators. Each link of the manipulator is
treated as an assemblage of a finite number of elements for each of which kinetic
S. S. Mahil and potential energies are derived. These elemental kinetic and potential energies are
Assistant Professor, then suitably combined to derive the dynamic model for the system. It is contended
Department of Electrical Engineering, that satisfactory modeling and analysis of the manipulator dynamics can lead to the
Purdue University Calumet, use of advanced control techniques to solve some of the problems associated with
Hammond, Ind. 46323 the flexure of otherwise attractive lightweight manipulator arms. Detailed model
development and simulation results for the case of a two-link manipulator system
are presented.
Introduction
Flexible manipulator systems exhibit many advantages over element and Lagrangian methods and the use of the General-
their traditional (rigid-arm) counterparts: they require less ized Inertia Matrix (GIM) concept [9-11], This modeling ef-
material, have less (arm) weight, consume less power, are fort represents a first step towards solving the flexible
more maneuverable, require smaller actuators, and are more manipulator control problem. The manipulator system is
transportable. However, they have not been much favored in modeled as being composed of links attached to each other
production industries due in part to the fact that manipulators with the first link attached to a fixed base. Each link is assum-
are required to have a reasonable accuracy in the response of ed to be symmetrical about its longitudinal axis in the absence
the arm's end-point to the joint control system input com- of deformation (e.g., cylindrical cross-section), and is con-
mands and this is severely deteriorated by structural deforma- sidered as an assemblage of distributed elements of equal
tion, especially in the case of flexible links where the deforma- lengths which are rigid in compression but not in bending.
tion is oscillatory. Traditionally, these vibrations have been Primary control inputs (torques) are applied at the joints and
eliminated by increasing the rigidity of the arms, but this solu- can be used to effect the movement of the end point of the link
tion is not available in the case of flexible manipulators; along feasible trajectories. Additional controls may be applied
therefore, if the advantages associated with lightweight are not at intermediate points along the link for the purpose of damp-
to be sacrificed, efficient controls have to be developed. ing the vibration modes and also to enhance the quality of the
The flexible manipulator control problem is complicated by overall control of the system.
the fact that the dynamics of the system is highly nonlinear Viscous damping at the joints is ignored. Also, only the out-
and complex (this is true even in the rigid arm case). The effec- puts of the actuators (torques in this case) are considered and
tive inertia of the system changes as a nonlinear function of so the dynamics as well as damping associated with the ac-
the robot's configuration. Also, when the manipulator moves tuator system are not modeled. Although it is recognized that
with high speed, the coriolis and centrifugal forces become in many existing robots the flexibility of the power train con-
significant and cannot be neglected. Adding flexural dynamics stitutes a major consideration, often much more than the flex-
complicates the problem much further, and serious problems ibility of the links, the derivation presented here does not treat
are encountered in both the modeling and control of the the power train and only the flexure of the manipulator link is
system [1, 2]. The dynamics of a flexible manipulator system represented.
can be described by a set of partial differential equations
which represent a distributed (continuous) system. This is ef- Model Development Approach
fectively an infinite dimensional system. Two commonly used
approximations to such a system include finite element models A flowchart of the overall modeling approach for the
and modal expansion models [3-8]. general case of an /w-link system is shown in Fig. 1. The
This paper presents a methodology for modeling lightweight overall approach involves treating each link of the
flexible manipulators. The methodology is based upon finite manipulator (say link 0 as an assemblage of «,• elements of
length /,-. For each of these elements (say ij where subscript j
denotes the element number) the kinetic energy (or, in fact,
Contributed by the Dynamic Systems and Control Division for publication in
kinetic co-energy) Ty and potential energy Vy are computed in
the JOURNAL OF DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL. Manuscript terms of a suitably selected system of n generalized variables
received at ASME Headquarters, May 19, 1986. Q = (<7i. <?2> • • • In ] a n d their rate of change q. These energies
z
Divide link i into ns finite elements of length /f
T
Compute T{j for a generic element ij
Compute V,y for a generic element ij
I
Combine Ty, j = 1, 2, ..., n, to form J", = J T y
I
Compute X, = T, - V,
T Fig. 2 Schematic of a two-link flexible manipulator
Apply Boundary Conditions
Journal of Dynamic Systems, Measurement, and Control SEPTEMBER 1986, Vol. 108/199
r _rir rl _r cos(?
i -sine,] ^ y = [«2j-i «2y « y + i % + 2 l 7 ' , a n d
My(l,2) = - ^ - ( l Q / - 7 ) ,
and 0, is the joint angle between 01XI and OX (refer to Fig.
2). The vector r, is given by:
M lyJ (l,3) = — L l ( 5 y - 3 ) ,
(8) 60
1 p'2 r3rr 3r 1
r—^-r
L
a"2y + 2 J
(11)
where
'2j- (20)
where x2j is replaced by x for convenience and the shape func- Ky=/»,g[o nn
0-4-)
tions <j>j(x) are as given in (10). From (21) and (22) we con-
clude that r is independent of uh for / = 1, 2, . . . 2M,. *2y-l " 2 , + — u 2/+1 *2y + 2
12 12
T2j in equation (20) may be expressed as:
1
Ty- -YzjMyZj (24) (30)
Potential Energy Computation. The potential energy for The elements of Kx, the stiffness matrix, can be found in
the overall system is obtained by computing the potential [13].
energy for each element of the assemblage and summing over
Potential Energy for a Single Element '2j'. Considering
all the elements.
again OX as the reference, the potential energy V2J of they'th
Potential Energy for a Single Element 'lj' of Link 1: Con- element of link 2 is the sum of two components, one due to
sidering OX as the reference, the potential energy Vxj of ele- gravity and the other due to elasticity, i.e.,
Vy=\„
•i: ™2g[0 1]
L
n
. u
2n{ +1 _
+nn
(j-l)l2+x2J
yy
dx0: +-
i
\>m
r'2
dx2J
(y- i/2)/i
Li
2g[o im\u ]i2+n-n + -Y^2jKy^2j (34)
v 2j v
V-l 12 2 2y+l 2;+2
12
Journal of Dynamic Systems, Measurement, and Control SEPTEMBER 1986, Vol. 108/201
—nlti
+ rt -$lKi$i (36) L, \n\ti
"2/2 + T\ -^K2\p2
U
R,<^2 . 2n{ + 1 _
_ Riife . (42)
where iA2 = [w1 w2 . . . . w2„2+2],and
The overall Lagrangian for a two-link flexible manipulator
R, = [/2 o| .. /, 0
/2 /I can then be written as:
12
£ = £l(dl,u3,u4, . . . u2n +2 )
The elements of K2, the stiffness matrix, can be found in [13]. + £2(6l,u2„1+l,u2„l+2,e2,wi,w4, . . . w2„2+2) (43)
Boundary Conditions. The joint of link 1 is constrained to By applying Lagrange's equations (4) to the Lagrangian in (43)
have zero displacement (translational) and angular displace- and performing algebraic manipulations the dynamic model
ment of 0, with respect to the inertial axis OX This constrains of the system becomes
variables ux and u2 to be zero, i.e., u1(f) = 0 and u2(/)=0.
Also, the second link is constrained to have an angular where
displacement of 82 relative to the first. This constrains
variables wx and w2 to be zero. qr= [0,^02^].
By enforcing these boundary conditions, the kinetic and
potential energies for the links become Q r = [r1Ffr2F2r],Ff=[F11F12
F
r = [^21 E22 . . . F'2,2n
: \ 2
T^—qfM,q, (37)
_a e
i,2A:-i.^i,2/t PPli d force and torque at junction of
elements 'Ik' and '1(A:+ 1)' of link 1 {k<n{)
T2=— q\M2i\2 (38)
^ t - 1 > ^2,2*: ~ aPPlied force and torque at junction of
elements '2A:' and '2{k+ 1)' of link 2 {k<n2)
1
n\t\ Tj — driving torque at joint i
V^m.glO i m T + —+fK^l. (39)
M-{In [ + 2n2 + 2) x (2n, + 2«2 + 2) symmetric
positive definite Generalized Inertia Matrix of
V2 = m2gl0 1]TJ the system
1 and
•nW
nM + T\ 2 d£ [d(£1+£2) d£, d£,
f=-
*2n, +1 -[•
R11A2
d(£,+£2) d(£,+£2) d£2 d£2
+ —tlK24,2 (40) (45)
du1 du2n. +2 dd2 ' tyT2
where
Modification of the Model to Include a Point Mass at the
«2„ 1+ 2]. ^=[01^?] Tip as Load. The extension of the model to the case where a
i/-2r=[w3)>v4 w 5 V
point mass (m) is added at the tip of the manipulator follows
2n2+2J
from our discussion above in a straightforward manner. One
<5r can show that the matrix differential model of the overall
r= [<9l W2«j +1 «2n, +2 e»2^JJ system (i.e., with m at the tip) is of the form:
M[, M2, A'1, and K2 are the generalized inertial and stiffness Mrq — fT = QT (46)
matrices for the links and are obtained by eliminating the ap-
propriate rows and columns from M : , M2, Kx, and K2, con- where
sistent with the above specified boundary conditions. MT=M+Mm, tT = t + tm, Q r = Q + Q„
l.A
a.
ih
J p
AA/W u
>*
R. M\ r^ H
v\r V^
v V V, —M—
M v
— i —
'0.00 1.00 2.00 3.00 4.00 5.00
TIME(SEC)
Fig. 3 Initial conditions for the simulations
Fig. 4 Simulation results of the model without payload
Journal of Dynamic Systems, Measurement, and Control SEPTEMBER 1986, Vol. 108/203
1.00 2.00 3.00 5.00 'o.oo 1.00 2.00 3.00 4.00 5.00
TIME(SEC) TIME(SEC)
c u
1 llIII,' , iliki ML .ilUiL .Jl Ui M
* -8
SH o
PkJfluUi mlm
•3." X n^f ' W f W W W »P
en
a-a =8
E?' i S''
in
D
O
— i — 1 1 — i — 1
'o.oo 2.00 3-00 1.00 2.00 3.00 4.00 5.00
TIME(SEC) TIME!SEC)
relatively higher for the case where a mass is attached at the tip into which each link is divided. Of course the higher the
than when no mass is attached. number of elements per link, the higher the order of the
resulting model. The final model derived for the flexible
Discussion
manipulator is extremely nonlinear and complex. It reflects
A mathematical model of a two-link flexible manipulator the variation in the effective inertia of the system as the
has been developed based upon finite element and Lagrange's manipulator configuration changes as well as the interaction
methods. The modeling methodology involves lumping each between the rigid body dynamics and vibration modes of the
link into a number of elements, determining the Lagrange links. Simulation results show that the response of the flexible
functions for the overall system and invoking variational prin- manipulator is highly undesirable and in order to get the
ciples to derive the governing dynamic equations. The model is dynamics of the system to be acceptable for most practical
flexible to the extent that different levels of model accuracy purposes, very effective controls are needed to control the
can be obtained by selecting appropriate number of elements vibration modes.
Journal of Dynamic Systems, Measurement, and Control SEPTEMBER 1986, Vol. 108/205