Professional Documents
Culture Documents
Abstract
In this paper, two nonlinear dynamic models of flexible manipulator with translational and rotational joints are
formulated based on Finite Element Method (FEM). Dynamic equations of manipulators are derived by using
Lagrange equations. The new model TR (Translational-Rotational) is developed based on single flexible link
manipulator with only rotational joint. The difference between flexible manipulators which have only
rotational joints and others with translational joint is presented in RT model. Dynamic behaviors of flexible
manipulators are analyzed through values of joints variable and elastic displacements at the end-effector
point. The numerical simulation results are calculated by using MATLAB/SIMULINK toolboxes. The results of
this study play an important role in modeling generalized planar flexible two-link robot, in designing the
control system and basing on select the suitable structure robot with the same request.
Keywords: Dynamic model, flexible link, translational joint, elastic displacements
2.1. General equations of motion The T-R model is shown as fig. 1. The
translational joint moves along its axis. The
In both model, the coordinate system XOY is translational joint variable d ( t ) is distance from
the fixed frame. The translational joint variable d ( t ) origin point of fixed coordinate to position of
is driven by force FT ( t ) . The rotational joint variable translational joint. Coordinate system X1O1Y1 is
q ( t ) is driven by torque ( t ) . Both joints are attached to end point of link 1. Coordinate system
X 2O2Y2 is attached to first point of link 2. Link 1
assumed rigid. Flexible link is divided n elements.
Elements are assumed interconnected at certain points with length L1 is assumed rigid and link 2 with length
which are known as nodes. Each element has two L2 is assumed flexibility. Symbol mt is mass of
nodes. Each node of element j has 2 elastic payload on the end-effector point. Coordinate r01 of
displacement variables which are flexural ( u2 j −1 ) and end point of link 1 on XOY is computed as
d ( t ) . Coordinate r2 j of element j on
T
slope displacements ( u 2 j ). Fundamentally, the r01 = L1
dynamic equations motion relies on the Lagrange
X 2O2Y2 can be found as
equations with Lagrange function L = T − P are
r2 j = ( j − 1) le + x j wj ( x j , t ) ;0 x j le . Where,
T
given by [9]
T T
d L L le =
L2
= F (t )
length of each element is and
− (1) n
dt Q ( t ) Q ( t )
wj ( x j , t ) = N j ( x j ) Q j
(t ) is total elastic
Where, T and P are kinetic and potential energy of
system. External generalized forces vector is defined displacement of element. The vector of shape
as function N j ( x j ) is presented in [9]. Coordinate of
F ( t ) = F1 ( t ) F2 ( t ) 0 . . 0 0
T
(2) element j on X1O1Y1 is r21 j = T21.r2 j . Where,
Specific generalized coordinate vector is given by cos q ( t ) − sin q ( t )
T21 = is transformation matrix
Q ( t ) = q1 ( t ) q2 ( t ) u1 . . u2 n +1 u2 n + 2 sin q ( t ) cos q ( t )
T
(3)
Elastic displacements vector of element j is from X 2O2Y2 to X1O1Y1 .
( t ) = u2 j −1
T
Q j
u2 j u2 j +1 u2 j + 2 (4)
( )
M ( Q ) Q + C Q,Q Q + KQ = F ( t ) (5)
Coriolis force are calculated as Fig. 1. T-R model
23
Journal of Science & Technology 127 (2018) 022-028
60 20
T −R
Each element of inertial mass matrix M j can be 1
m26 = − m2 le3 (5 j − 2);
computed as 60
T
r02 j r02 j
M j ( s, e ) = m2
le
T −R Total elastic kinetic energy of link 2 is yielded as
dx j ;
0
Q js Q je (11)
( )
n
1
TeT − R = T2Tj− R = QT − R ( t ) MTe − R QT − R ( t )
T
s, e = 1, 2,.., 6 2
(16)
j =1
th th
Where, Q js and Q je are the s , e element of
The mass matrix MTe − R is constituted from matrices
QTjg− R (t ) vector. It can be shown that MTj − R is of the
of elements follow FEM theory, respectively. The
form
generalized coordinate vector of system is defined as
T −R M rr M rf
Mj = (12) QT − R ( t ) = d ( t ) q ( t ) u1 . . u2 n +1 u2 n + 2
T
M fr M base (17)
Where, matrix Mbase is the base mass matrix which is Kinetic energy of payload is
given as
T T − R = mt . ( r0TE− R ) .r0TE− R and kinetic energy of
1 T
13 11 9 13 2 P
35 m2 le m2 le2
m2 le − m2le 2
210 70 420 system is determined as
11 m l 2 1 13
−
1 3
T T − R = T1T − R + TeT − R + TPT − R
3 2
m2le m2le m2le
210 2 e 105 420 140
M base =
( )
1 (18)
T T − R = QT − R ( t ) M T − R QT − R ( t )
T
9 ml 13 13 (13) 2
11
m l 2
m l − m l
70 2 e 420
2 e
35
2 e
210
2 e
2
13 1 11 1 T −R
− m2 le2 − m2 le3 − m2le2 m2le3 Matrix M is total mass matrix. The gravity effects
420 140 210 105 can be ignored as the robot movement is confined to
the horizontal plane. Defining E and I are Young’s
modulus and area moment of inertia link 2. Elastic
24
Journal of Science & Technology 127 (2018) 022-028
1 le w j ( x j , t )
2
2
P T −R
= EI dx j
x 2j
j
2 0 (19)
1
PjT − R = QTj (t )K Tj − R Q j (t )
2
Stiffness matrix of element j is defined as
0 0 0
K Tj − R = 0 0 0 (20)
0 0 K base
25
Journal of Science & Technology 127 (2018) 022-028
Where, TeR −T is the elastic kinetic and TPR −T is kinetic 4. Simulation results
R −T
energy of payload. Mass matrix M e and stiffness Simulation specifications of two flexible models
R −T
matrix K can be calculated by using FEM theory are given by Table. 1.
following mass and stiffness matrices of all elements. Table 1. Parameters of dynamic models
Mass matrix of element j with mass per meter m2 is
Property T-R model R-T model
given as MTj − R at recipe (12). It noted that Mbase is Length of link 1 (m) L1=0.1 L1=0.2
the same but others elements are difference. They are Mass of link 1 (kg) m1=1.4 m1=0.9
computed as Flexible link parameters
Length of flexible
m11 = f (m, le, j , L, d (t ), Q j (t )); L2=0.3 L2=0.8
link (m)
m2 le ( le u2 j − le u2 j + 2 + 6u2 j −1 + 6u2 j +1 )
1 Width (m) b=0.03 b=0.01
m12 = −
12 Thickness (m) h=0.003 h=0.002
Number of element n=5
m2 le (10 jle + 10d ( t ) + 10 L1 − 10 L2 − 7le )
1
m13 = Cross section area
20 A=9.10-5 A=2.10-5
(m2) (A=b.h)
m2 le2 ( 5 jle + 5d ( t ) + 5L1 − 5L2 − 3le )
1
m14 = (27) Mass density (kg/m3) =7850
60
Mass per meter
0.7 0.157
m2 le (10 jle + 10d ( t ) + 10 L1 − 10 L2 − 3le )
1
m15 = (kg/m) (m2=.A)
20 Young’s modulus
E=2.1010
m16 = − m2 le2 ( 5 jle + 5d ( t ) + 5L1 − 5L2 − 2le )
1 (N/m2)
60 Inertial moment of
I=b.h3/12=1.67.10-12
m22 = m.le ; m23 = m24 = m25 = m26 = 0; cross section (m4)
Mass of payload (g) mt=100 mt=20
R −T
Matrices M base and K Rj −T have format as Initial value at t=0
0 d0=0.4
T −R T −R (m)
M ,K .
base j β0 0
3. Boundary conditions Simulation time (s) T=10
In T-R case, rotational joint of link 2 is Dynamic equations (5) for both models are
constrained so that elastic displacements of first node solved by using MATLAB/SIMULINK toolboxes
of element 1 on link 2 can be zero. Thus variables with boundary conditions. The simulation results of
u1 , u2 are zero. The rows and columns 3th, 4th of T-R model are shown in fig. 3, fig. 4 and fig. 5.
Driving force and torque of joints are built using
matrices F ( t ) , Q ( t ) vectors
M, K , C and are Bang-Bang rule which are shown fig. 3. Driving time
eliminated as presented in FEM theory. is 0.5(s). Dynamic behaviors of system are described
through values of joint variables and elastic
In R-T case, the displacements of element k are displacements in fig. 4 and fig. 5. Maximum values of
zero because assumed that the translational joint hub translational and rotational joint are 0.075(m) and
is treated as rigid. The rows and columns 0.24(rad). These values are shown in fig. 4. Elastic
( 2k − 1) ; ( 2k ) of matrices M, K , C and F (t ) , Q (t )
th th
displacements at the end-effector point are presented
vectors are eliminated and values of these are in fig. 5. Maximum values of these displacements are
changed, too. It is noteworthy to mention that value 0.14(m) and 0.25(rad) at 0.6(s). These displacements
of k depends on time. This boundary condition is are fast reduced after that with 0.02(m) and 0.035
(rad). The simulation results of R-T model are shown
clearly different point between flexible link
from fig. 6 to fig. 8. The Bang-Bang rule in fig. 6 is
manipulator with only rotational joints and flexible
used for driving torque and force of joints. Fig. 7
link manipulator with combine translational joint and
shows values of joint variables. It note that value of
rotational joint. So now, size of matrices M , K,C is
rotational joint continuously increases while
( 2n + 2) ( 2n + 2) and ( 2n + 2) 1 is size of F ( t ) maximum value of translational joint increases from
and Q ( t ) vector. The k variable is continuously initial value 0.4(m) to 0.51(m) at 0.5(s). Values
different of rotational joint between both models can
updated for each time step in solving process. Vector
26
Journal of Science & Technology 127 (2018) 022-028
27
Journal of Science & Technology 127 (2018) 022-028
boundary conditions. The final models derived for the [5] Yuh. J and Young. T, Dynamic modeling of an
flexible robot are nonlinear and complex. Simulation axially moving beam in rotation: simulation and
results show that the response of flexible robots is experiment, Trans. ASME J. Dyn. Syst. Meas.
unstable especial without effect of structure damping Control. 113 (1991) 34–40.
and needs to control. Moreover, the effects of [6] Al-Bedoor. B. O and Khulief. Y. A, General planar
structure damping and varying payload on dynamic dynamics of a sliding flexible link, Sound and
characteristic of models have been studied and Vibration. 206 (1997) 641–661.
discussed. The results in this paper are helpful and [7] S. E. Khadem and A. A. Pirmohammadi, Analytical
important in development of modeling generalized development of dynamic equations of motion for a
planar flexible two-link robot which combines three-dimensional flexible manipulator with revolute
translational and rotational joints and designing and prismatic joints, IEEE Trans. Syst. Man Cybern.
control system. B Cybern. 33 (2003) 237–249.
28