Вы находитесь на странице: 1из 6

Dynamic Modelling of a Two-link Flexible

Manipulator System Incorporating Payload


M. A. Ahmad1 and Z. Mohamed2
1
Faculty of Electrical Engineering, Universiti Malaysia Pahang, 25000, Kuantan, Pahang, Malaysia
(E-mail: ash_usc@hotmail.com)
2
Faculty of Electrical Engineering, Universiti Teknologi Malaysia, 81310 UTM Skudai,
Johor, Malaysia (Tel: 607-5535290; E-mail: zahar@fke.utm.my).

Abstract-This paper presents dynamic modelling of a two- manipulator systems incorporating damping, hub inertia and
link flexible manipulator based on closed-form equations of payload [4,5,6]. Performance investigations of both
motion. The kinematic model is based on standard frame techniques in modelling of flexible manipulators have shown
transformation matrices describing both rigid rotation and that the FE method can be used to obtain a good
modal displacement, under small deflection assumption. The
Lagrangian approach is used to derive the dynamic model of
representation of the system [4]. It has been reported that in
the structure. Links are modelled as Euler-Bernoulli beams using the FE method, a single element is sufficient to
with proper clamped-mass boundary conditions. A dynamic describe the dynamic behaviour of a flexible manipulator
model of the system, incorporating structural damping, hub reasonable well [5].
inertia and payload, is developed using finite assumed mode AMM looks at obtaining approximate models by solving
methods. Explicit equations of motions are detailed by the partial differential equation characterising the dynamic
assuming two modes of vibration for each link. Moreover, behaviour of the system. Previous studies utilising this
effects of payload on the response of the flexible manipulator approach for modelling of a single-link flexible manipulator
are discussed. Extensive results that validate the theoretical have been reported [2,7,8]. It has been shown that the first
derivation are presented in the time and frequency domains.
two modes are sufficient to identify the dynamic of flexible
manipulators. A good agreement between theory and
I. INTRODUCTION
experiments has also been achieved utilising this approach
Research on the dynamic modelling and control of [2].
flexible manipulators has received increased attention due to Similar to the case of a single-link manipulator, the FE
their several advantages over rigid robots: they require less method and AMM have also been investigated for modelling
material, are lighter in weight, consume less power, require of a two-link flexible robot manipulator. However, the
smaller actuators, are more manoeuvrable and transportable, complexity of the modelling increases dramatically as
have less overall cost and higher payload to robot weight compared to the case of a single-link flexible manipulator.
ratio. These types of robots are used in a wide spectrum of Yang and Sadler [9] have developed the FE model to
applications starting from simple pick and place operations describe the deflection of a planar two-link flexible robot
of an industrial robot to micro-surgery, maintenance of manipulator. A dynamic model has been developed using the
nuclear plants and space robotics [1]. However, control of FE methods utilising a generalised inertia matrix [10]. De
flexible manipulators to maintain accurate positioning is an Luca and Siciliano [11] have utilised the AMM to derive a
extremely challenging. The complexity of the problem dynamic model of multilink flexible robot arms limiting to
increases dramatically for a two-link flexible manipulator. the case of planar manipulators with no torsional effects. The
Due to the flexible nature of the system, the dynamics are equations of motion which can be arranged in a
highly non-linear and complex [2,3]. In this respect, a computationally efficient closed form that is also linear with
control mechanism that accounts for both the rigid body and respect to a suitable set of constant mechanical parameters
flexural motions of the system is required. Moreover, the have been obtained. A systematic approach for deriving the
complexity of this problem increases when a flexible dynamic equations for n-link manipulator has also been
manipulator carries a payload. If the advantages associated presented [12]. The utilisation of AMM to derive the
with lightness are not to be sacrificed, accurate models and dynamic model of the system has also been reported [13].
efficient controllers have to be developed. However, modelling of a two-link flexible robot manipulator
Modelling of a single-link flexible manipulator has been using the AMM has not been adequately addressed in the
widely established. Various approaches have been developed literature. Moreover, the effects of other physical parameters
which can mainly be divided into two categories: the such as payload on the dynamic characteristics of the system
numerical analysis approach and the assumed mode method are not adequately discussed.
(AMM). The numerical analysis methods that are utilised This paper presents a generalised modelling framework
include finite difference (FD) and finite element (FE) that provides a closed-form dynamic equation of motion of a
methods. The FD and FE approaches have been used in two-link flexible manipulator system. Moreover, the works
obtaining the dynamic characterisation of single-link flexible presents the effects of payload on the dynamic behaviour of
the system. The Euler-Lagrange principle and assumed mode VII. The backlash in the reduction gear and coulomb
discretisation technique are used to derive the dynamic friction effects are neglected.
model of the system. The simulation algorithm thus
developed is implemented in Matlab. Angular position The physical parameters of the two-link flexible
responses of the system and the power spectral density manipulator system are shown in Table I. l, ρ and EI
(PSD) of the end-point acceleration are obtained in both time represent the length, mass density and flexural rigidity of the
and frequency domains. To study the effect of payloads, the links respectively. Mh2 is the mass considered at the second
results are evaluated with varying payloads of the flexible motor which is located in between both links, Jhi is the
manipulator. Simulation results are analysed in both the time inertia of the ith motor and hub. The input torque, τi(t) is
and frequency domains to assess the accuracy of the model applied at each motor and Gi is the gear ratio for the ith
in representing the actual system. motor. Both links and motors are considered to have the
same dimensions
II. THE FLEXIBLE MANIPULATOR SYSTEM TABLE I
PARAMETER OF THE MANIPULATOR
Fig. 1 shows a two-link flexible robot manipulator system
considered in this study. The links are cascaded in a serial Symbol Parameter Value Unit
fashion and both links are actuated by individual motors at ρ Mass density 0.2 kgm-1
the hub of the flexible manipulator. X0Y0 is the inertial co-
ordinate frame, XiYi is the rigid body coordinate frame EI Flexural rigidity 1.0 Nm2
) ) l Length 0.5 m
associated with the ith link and X i Yi is the moving
Jh Motor and hub inertia 0.02 kgm2
coordinate frame. θi is the angular position of ith link while
the transverse component of the displacement vector is G Gear ratio 1 -
designated as υ i ( x i , t ) . An inertial payload of mass MP with Mh2 Mass of centre motor 1 kg
inertia JP is attached at the end-point of link 2.
III. DYNAMIC MODELLING

A. Kinematic Formulation
Considering revolute joints and motion of the manipulator on
a two-dimensional plane, the rigid transformation matrix, Ai ,
from Xi-1Yi-1 to XiYi is written as

⎡cos θ i − sin θ i ⎤
(1)
Ai = ⎢
⎣ sin θ i cos θ i ⎥⎦

The elastic homogenous transformation matrix, Ei, due to the


Fig.1. Description of the two-link flexible manipulator system.
deflection of the link i can be written as

In this work, the following assumptions were considered in ⎡ ∂υ i ( xi , t ) ⎤


⎢ 1 − xi =li ⎥
the development of a dynamic model of the flexible ∂xi (2)
Ei = ⎢ ⎥
manipulator: ⎢ ∂υ i ( xi , t ) 1 ⎥
⎢ ∂x xi =li ⎥
⎣ i ⎦
I. Each link is assumed to be long and slender.
Therefore, transverse shear and the rotary inertia where υ i ( x i , t ) is the bending deflection of the ith link at a
effects are negligible.
II. The motion of each link is assumed to be in the spatial point xi (0 ≤ xi ≤ li ) and li is the length of the ith
horizontal plane. link. The global transformation matrix Ti transforming co-
III. Links are considered to have constant cross-sectional ordinates from X0Y0 to XiYi follow a recursion as below
area and uniform material properties, i.e. constant
mass density and Young’s modulus. Ti = Ti −1 Ei −1 Ai (3)
IV. Each link has a very small deflection.
V. Motion of the links can have deformations in the
Let i ⎧ xi ⎫⎪ be the position vector that
horizontal direction only. ri ( xi ) = ⎨ ⎬
VI. The kinetic energy of the rotor is mainly due to its ⎩υ i ( xi , t )⎪⎭
rotation only, and the rotor inertia is symmetric about describes an arbitrary point along the ith deflected link with
its axis of rotation. respect to its local CF (XiYi ) and 0 ri be the same point
referring to X0Y0. The position of the origin of Xi+1Yi+1 with link, the kinetic energy of all the n links can be found as
respect to XiYi is given by
n T
1 li
i
p i +1 = ri (l i )i
(4) TL = ∑
i =1
2
ρi ∫ 0
0
r&i ( xi ) 0 r&i ( xi ) dxi (12)

and 0 p i is its absolute position with respect to X0Y0. Using Referring to Fig. 1 and the kinematics formulation described
the global transformation matrix, 0 ri and 0 p i can be written previously, the kinetic energy associated with the payload
as can be written as

0
ri = 0 pi + Ti i ri , 0
pi +1 = 0 pi + Ti i pi +1 (5) 1 1 & + υ& ′ (l )) 2 ,
TPL = M p p& nT+1 p& n +1 + I P (Ω n n n (13)
2 2

B. Dynamic Equations
∑ ∑
n n −1
where Ω& n = θj + υ& ′ (l k ) ; n being the link number,
j =1 k =1 k
To derive the dynamic equations of motion of the flexible
manipulator, the total energy associated with the manipulator prime and dot represent the first derivatives with respect to
system needs to be computed using the kinematics spatial variable x and time, respectively. p& n +1 can be
formulations explained previously. The total kinetic energy determined using (4) and (5).
of the manipulator (T) is given by Next, neglecting the effects of the gravity, the potential
energy of the system due to the deformation of the link i can
T = TR + TL + TPL (6) be written as

2
where TR, TL and TPL are the kinetic energies associated with 1 li ⎛ d 2υ i ( xi ) ⎞
the rotors, links and the hubs, respectively. By using a very U =
2 ∫ 0
( EI ) i ⎜
⎜ dx 2 ⎟
⎝ i
⎟ dxi

(14)
small deflection assumption, the kinetic energy of the ith
rotor is given by
C. Assumed Mode Shapes
1
TRi = Gi 2 I riα& i 2 (7) Using the assumption of long and slender link, the dynamics
2
of the link at an arbitrary spatial point xi along the link at an
instant of time t can be written using Euler-Beam theory [10]
where α& i is the angular velocity of the rotor about the ith as
principal axis. The kinetic energy of a point ri ( xi ) on the ith
link can be written as ∂ 4υ i ( xi , t ) ∂ 2υ i ( xi , t )
( EI ) i + ρi =0 (15)
∂xi 4 ∂t 2
T
1 li
∫ (8)
0
TLi = ρi r&i ( xi ) 0 r&i ( xi ) dxi
2 0 where ρ i is the linear mass density of the ith link. Equation
(15) is solved by applying the boundary conditions of the
where ρ i is the linear mass density for the ith link and manipulator. Considering a clamped-mass configuration of
0
r&i ( xi ) is the velocity vector. The velocity vector can be the manipulator, the boundary conditions can be written as
computed by taking the time derivative of its position in (5):
υ i ( xi , t ) xi =0 =0, υ i′ ( xi , t ) xi =0 =0, (16)
0
r&i ( xi )= p& i + T&i i ri ( xi ) + Ti i r&i ( xi )
0
(9)
∂ 2υ i ( xi , t )
0 ( EI ) i xi =li
p& i in (9) can be determined using (4) and (5) along with ∂xi 2
d 2 ⎛ ∂υ i ( xi , t ) ⎞ (17)
i
p& i +1 = i r&i (li ) (10) = − I Ei ⎜ xi =li ⎟
dt 2 ⎝ ∂t ⎠
d 2 ⎛ ∂υ i ( xi , t ) ⎞
The time derivative of the global transformation matrix T&i − M DEi ⎜ xi =li ⎟
dt 2 ⎝ ∂t ⎠
can be recursively calculated from
)& )& )&
T&i = Ti −1 Ai + Ti −1 A& i , Ti = Ti E i + Ti E& i (11)

After determining the kinetic energy associated with the ith


∂ 3υ i ( xi , t ) B. Closed-form Equations
( EI ) i xi =li
∂xi 3 Using the generalised modelling scheme described in
Sections 2, 3 and 4, equations with two flexible links are
(υ ( x , t ) )
2
d (18) described in this section. In this case, the effective masses at
= M Ei i i xi =li
dt 2 the end of the individual links are set as
+ M DEi
d2
dt 2
(υ ( x , t ) )
i i xi =li M E1 = m 2 + M p ,
I E1 = I b 2+ J 2 + I p + M p l 22 , (24)

where M Ei , I Ei are the effective mass and moment of M DE1 = ( m2 lc 2 + M p l 2 cos θ 2 ) ,

inertias at the end of the ith link and M DEi is the


M E2 = M p ,
contributions of masses of distal links.
Bending deflections υ i ( xi , t ) can be expressed as a I E 2 = I p + M p l 22 , (25)
superposition of mode-shapes and time dependent modal M DE 2 = 0
displacements:

nm
In order to obtain a closed-form dynamic model of the
υ i ( xi , t ) = ∑φj =1
ij ( xi )qij (t )
(19) manipulator, the energy expressions derived in section 3 are
used to formulate the Lagrangian L = T − U . Using the
Euler-Lagrange equation
where φ ij ( xi ) and q ij (t ) , respectively, are the jth mode shape
∂ ⎛⎜ ∂L ⎞ ∂L
⎟− (26)
function and jth modal displacement for the ith link. The
∂t ⎜⎝ ∂Q& i ⎟ ∂Q = Fi
solution of (19) and (15) gives ⎠ i

qij (t ) = exp(ωij t ) (20) with the ith generalized co-ordinate of the system, Qi (Q=[
θ1, θ2, q11, q12, q21, q22 ]T), and the corresponding generalized
forces, Fi (F=[ τ1, τ2,0,0,0,0 ]T), a set of dynamic equations
and
can be written in compact form as
φij ( xi ) = mi [cos( β ij xi ) − cosh( β ij xi )
(21) ⎧⎪θ&&⎫ ⎧ f (θ ,θ&) ⎫ ⎧ g1 (θ ,θ&, q, q& ) ⎫
+ γ ij sinh( β ij xi ) − cosh( β ij xi )] M (θ , q)⎨ ⎬ + ⎨ 1 ⎬+⎨ ⎬
⎪⎩q&&⎭ ⎩ f 2 (θ ,θ&)⎭ ⎩g 2 (θ ,θ&, q, q& )⎭
(27)
where mi is the mass of the link i and γ ij is given as ⎧ 0 ⎫ ⎧ 0 ⎫ ⎧τ ⎫
+⎨ ⎬+⎨ ⎬ = ⎨ ⎬
⎩Dq& ⎭ ⎩Kq⎭ ⎩0⎭
M Li β ij
sin β ij − sinh β ij + (cos β ij − cosh β ij ) where M is the mass matrix, f1 and f2 are the vectors
ρi (22)
γ ij = containing terms due to coriolis and centrifugal forces, and
M Li β ij
cos β ij + cosh β ij − (sin β ij − sinh β ij ) g1 and g2 are the vectors containing terms due to the
ρi interactions of the link angles and their rates with the modal
displacements. K is the diagonal stiffness matrix which takes
and β ij is the solution of the following equation: on the values ω ij 2 m i and D is the passive structural damping
( Di = 0 . 1 K i , i = 3,..., 6 ).
1 + cosh β ij li cos β ij l i
M Li β ij
− (sin β ij l i cosh β ij li − cos β ij li sinh β ij l i ) IV. SIMULATION RESULTS
ρi
(23) In this section, simulation results of the dynamic behaviour
J Li β ij 3
− (sin β ij li cosh β ij l i + cos β ij l i sinh β ij l i ) of the two-link flexible manipulator system are presented in
ρi the time and frequency domains. A bang-bang signal of
M Li I Li β ij 4 amplitude 0.2 Nm and 1 s width is used as an input torque,
+ (1 − cos β ij l i cosh β ij li ) = 0 applied at the rotors of the manipulator. A bang-bang torque
ρi 2 has a positive (acceleration) and negative (deceleration)
period allowing the manipulator to, initially, accelerate and
then decelerate and eventually stop at a target location.
System responses are verified by undertaking computer
simulation using the fourth-order Runge-Kutta integration -7

method for duration of 5 s with a sampling time of 1ms. The 10


20 gram
angular position responses at both links of the system with -8
10 60 gram
the PSDs are obtained and evaluated. 100 gram

Magnitude ((m/sec/sec)*(m/sec/sec)/Hz)
To demonstrate the effects of payload on the dynamic -9
10

behaviour of the system, various payloads of up to 100 -10


grams weight were simulated. Figs. 2 and 3 show the angular 10

position response with various payloads for link-1 and link-2 -11
10
respectively. Moreover, Figs. 4 and 5 show the
corresponding PSDs for both links. It is noted that the -12
10
angular position for link-1 increases towards the negative -13
direction while for link-2 the angular position decreases with 10

increasing payloads. The time response specifications of -14


10
angular positions have shown significant changes with the
variations of payloads. Table II summarises the time -15
10
0 5 10 15 20 25 30 35 40 45 50
response specifications of angular positions for the two-link Frequency (Hz)
flexible manipulator system. Moreover, the PSD of the Fig.4. PSD of end-point acceleration of link-1
system response shows that the resonance modes of vibration
of the system shift to lower frequencies with increasing
payloads. This implies that the manipulator oscillates at -12
20 gram
60 gram
10
lower frequency rates than those without payload. Table III 100 gram

Magnitude ((m/sec/sec)*(m/sec/sec)/Hz)
summarises the relation between payload and the resonance -13
10
frequencies of the system.
-14
10
0
20 gram -15
10
-0.01 60 gram
100 gram -16
10
-0.02
-17
10
Link-1 positions (rad)

-0.03 -18
10

-0.04 -19
10
0 5 10 15 20 25 30 35 40 45 50
Frequency (Hz)
-0.05
Fig.5. PSD of end-point acceleration of link-2
-0.06
By comparing the results presented in Table II, it is noted
-0.07 that the settling time of the manipulator response was
0 0.5 1.0 1.5 2.0 2.5 3.0 3.5 4.0 4.5 5.0
Time (s) affected by variations in the payload. It is also evidenced that
Fig.2. Angular position response of link-1
the settling time response for both links decreases with
increasing payloads. It shows that, by incorporating more
2 weight at distal link resulted in a faster response. However,
1.8 the percentage overshoot results produce a contrast pattern
between link-1 and link-2 with variation of payloads. With
1.6
increasing payload, the overshoots of link-1 slightly decrease
1.4 whereas for link-2 the overshoots gradually increase. The
Link-2 positions (rad)

20 gram
1.2 60 gram changes of percentage of overshoot for link-1 are significant
100 gram as link-1 exhibits higher magnitude of vibration compared to
1
link-2. Besides, link-1 has to cater a higher mass of load
0.8 from the second rotor, link-2 and payload which produced a
0.6 smaller angular position as compared to link-2.
0.4

0.2

0
0 0.5 1.0 1.5 2.0 2.5 3.0 3.5 4.0 4.5 5.0
Time (s)

Fig.3. Angular position response of link-2


TABLE II [2] Martins JM, Mohamed Z, Tokhi MO, Sá da Costa J, Botto MA,
RELATION BETWEEN PAYLOAD AND SPECIFICATIONS OF ANGULAR POSITION “Approaches for dynamic modelling of flexible manipulator
RESPONSES OF THE FLEXIBLE MANIPULATOR systems,” IEE Proceedings-Control Theory and Application,
Time responses specifications of angular 2003;150:401-411.
[3] Benosman M, Vey GL, “Control of flexible manipulators: A
positions survey,” Robotica, 2004; 22:533-545.
Payloads Link-1 [4] Tokhi MO, Mohamed Z, Shaheed MH, “Dynamic characterisation
(grams) Rise time (s) Settling Overshoot of a flexible manipulator system,” Robotica, 2001;19:571-580.
[5] Tokhi MO, Mohamed Z, Azad AKM, “Finite difference and finite
time (s) (%)
element approaches to dynamic modelling of a flexible
0 0.652 1.769 26.20 manipulator,” Proceedings of IMechE-I: Journal of Systems and
20 0.677 1.765 21.18 Control Engineering, 1997; 211:145-156.
40 0.700 1.760 17.35 [6] Aoustin Y, Chevallereau C, Glumineau A, Moog CH.,
“Experimental results for the end-effector control of a single
60 0.721 1.754 14.41 flexible robotic arm,” IEEE Transactions on Control Systems
80 0.742 1.752 12.25 Technology, 1994; 2:371-381.
100 0.761 1.750 10.57 [7] Hasting GG, Book WJ., “A linear dynamic model for flexible robot
manipulators,” IEEE Control Systems Magazine, 1987; 7:61-64.
Link-2 [8] Azad AKM., “Analysis and design of control mechanism for
0 1.112 1.803 0.22 flexible manipulator systems,” PhD Thesis, 1994; The University of
20 1.113 1.802 0.34 Sheffield, UK.
[9] Yang Z, Sadler JP., “Large-displacement finite element analysis of
40 1.115 1.799 0.42 flexible linkage,” ASME Journal of Mechanical Design, 1990;
60 1.116 1.800 0.50 112:175-182.
80 1.119 1.796 0.58 [10] Usoro PB, Nadira R, Mahil SS., “A finite element/lagrange
100 1.121 1.798 0.61 approach to modelling lightweight flexible manipulators,”
Transactions of ASME: Journal of Dynamic Systems, Measurement
and Control, 1986; 108:198-205.
TABLE III [11] De Luca A, Siciliano B., “Closed-form dynamic model of planar
RELATION BETWEEN PAYLOAD AND RESONANCE FREQUENCIES OF THE FLEXIBLE multi-link lightweight robots,” IEEE Transactions on Systems, Man,
MANIPULATOR and Cybernetics, 1991; 21:826-839.
[12] Subudhi B, Morris AS., “Dynamic Modelling, Simulation and
Resonance frequencies (Hz) Control of a manipulator with flexible links and joints,” Robotics
Payloads and Autonomous System, 2002; 41:257-270.
(grams) Link-1 Link-2 [13] Morris AS, Madani A., “Static and dynamic modelling of a two-
flexible-link robot manipulator,” Robotica 1995; 14:289-300.
Mode 1 Mode 2 Mode 1 Mode 2
(Hz) (Hz) (Hz) (Hz)
0 2 35 6 32
20 2 27 4 25
40 2 23 4 23
60 2 22 3 21
80 2 20 3 20
100 2 19 3 19

V. CONCLUSION
Investigations into the development of a dynamic model of
a two-link flexible manipulator incorporating structural
damping, hub inertia and payload have been presented. A
closed-form finite dimensional dynamic model of a planar
two-link flexible manipulator has been developed using the
Euler-Lagrange approach combined with the AMM. The
derived dynamic model has been simulated with bang-bang
torque inputs and angular position responses of both links of
the system have been obtained and analysed in time and
frequency domains. Moreover, the effects of payload on the
dynamic characteristic of the system have been studied and
discussed. These results are very helpful and important in the
development of effective control algorithms for a two-link
flexible robot manipulator with varying payload

REFERENCES
[1] Dwivedy SK, Eberhard P., “Dynamic analysis of flexible
manipulators, a literature review,” Mechanism and Machine Theory,
2006;41:749-777.

Вам также может понравиться