Kineto-ElastodynamicCharacteristicsof theSix-Degree-of...

18
Hindawi Publishing Corporation Journal of Robotics Volume 2011, Article ID 489695, 17 pages doi:10.1155/2011/489695 Research Article Kineto-Elastodynamic Characteristics of the Six-Degree-of-Freedom Parallel Structure Seismic Simulator Yongjie Zhao Department of Mechatronics Engineering, Shantou University, Shantou City, Guangdong 515063, China Correspondence should be addressed to Yongjie Zhao, [email protected] Received 19 January 2011; Revised 19 May 2011; Accepted 3 June 2011 Academic Editor: Yangmin Li Copyright © 2011 Yongjie Zhao. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited. Based on the kineto-elastodynamic assumptions, the dynamic model of the six-degree-of-freedom parallel structure seismic simulator is developed by virtue of the finite element method and the substructure synthesis technique. The kineto-elastodynamic characteristics represented by the natural frequency, the sensitivity analysis, the energy ratios, and the displacement response of the moving platform are investigated. It is shown that the second-order natural frequency is much higher than the first-order natural frequency, and the first-order natural frequency is sensitive to the radius of the strut and the radius of the lead screw. In order to improve the dynamic characteristic of the manipulator, the mass of the moving platform should be reduced or the stiness of the strut should be increased especially for the sixth strut. For the investigated trajectory, the displacement response of the moving platform along the x direction is smaller than these displacement responses along the y direction and along the z direction. The angular displacement response of the moving platform rotating about z-axis is slightly larger than those angular displacement responses rotating about the x-axis and about the y-axis. 1. Introduction A seismic simulator is one of the most important equipments in the earthquake resistance testing. Due to the requirement of the large and variable load capability, these kinds of equipments are usually developed with the parallel structure manipulators [14]. The parallel manipulator is a closed- loop kinematic chain mechanism whose end eector is linked to the base by several independent kinematic chains [57]. For this type of manipulators, there are some potential advantages such as high accuracy, rigidity, and speed. They have been successfully used in the motion simulators, robotic end eectors, and other circumstances like fast pick-and-place operation. Many investigations have been carried out on the parallel manipulators since the concept was introduced. However, there is not many works on the flexible dynamics of the parallel manipulator [8, 9] compared with the vast of papers on the kinematics and rigid dynamics due to the following facts: (i) computational cost; (ii) geometrical complexity; (iii) unidentified mechanics property. For the 6-PSS (prismatic-spherical-spherical joint) flexible parallel manipulator under consideration in this paper, which is developed for the six-degree-of-freedom seismic simulator, the dynamics considering the structure flexibility is fundamental for the modeling, design, and control. The demands of high speed, high load, high precision, or lightweight structure from industry make it necessary to consider the deformation, stiness, and other dynamic characteristics for the parallel manipulator [1023]. Math- ematical modeling of a general flexible parallel manipula- tor is a challenging task since there is no availability of closed-form solutions to the inverse kinematic model for the flexible parallel manipulator. The nominal motion of the manipulator involves changing geometries resulting in varying system parameters. The equations of motion are

Transcript of Kineto-ElastodynamicCharacteristicsof theSix-Degree-of...

Page 1: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Hindawi Publishing CorporationJournal of RoboticsVolume 2011, Article ID 489695, 17 pagesdoi:10.1155/2011/489695

Research Article

Kineto-Elastodynamic Characteristics ofthe Six-Degree-of-Freedom Parallel StructureSeismic Simulator

Yongjie Zhao

Department of Mechatronics Engineering, Shantou University, Shantou City,Guangdong 515063, China

Correspondence should be addressed to Yongjie Zhao, [email protected]

Received 19 January 2011; Revised 19 May 2011; Accepted 3 June 2011

Academic Editor: Yangmin Li

Copyright © 2011 Yongjie Zhao. This is an open access article distributed under the Creative Commons Attribution License, whichpermits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Based on the kineto-elastodynamic assumptions, the dynamic model of the six-degree-of-freedom parallel structure seismicsimulator is developed by virtue of the finite element method and the substructure synthesis technique. The kineto-elastodynamiccharacteristics represented by the natural frequency, the sensitivity analysis, the energy ratios, and the displacement response of themoving platform are investigated. It is shown that the second-order natural frequency is much higher than the first-order naturalfrequency, and the first-order natural frequency is sensitive to the radius of the strut and the radius of the lead screw. In order toimprove the dynamic characteristic of the manipulator, the mass of the moving platform should be reduced or the stiffness of thestrut should be increased especially for the sixth strut. For the investigated trajectory, the displacement response of the movingplatform along the x direction is smaller than these displacement responses along the y direction and along the z direction. Theangular displacement response of the moving platform rotating about z-axis is slightly larger than those angular displacementresponses rotating about the x-axis and about the y-axis.

1. Introduction

A seismic simulator is one of the most important equipmentsin the earthquake resistance testing. Due to the requirementof the large and variable load capability, these kinds ofequipments are usually developed with the parallel structuremanipulators [1–4]. The parallel manipulator is a closed-loop kinematic chain mechanism whose end effector islinked to the base by several independent kinematic chains[5–7]. For this type of manipulators, there are some potentialadvantages such as high accuracy, rigidity, and speed. Theyhave been successfully used in the motion simulators,robotic end effectors, and other circumstances like fastpick-and-place operation. Many investigations have beencarried out on the parallel manipulators since the conceptwas introduced. However, there is not many works onthe flexible dynamics of the parallel manipulator [8, 9]compared with the vast of papers on the kinematics and rigid

dynamics due to the following facts: (i) computational cost;(ii) geometrical complexity; (iii) unidentified mechanicsproperty. For the 6-PSS (prismatic-spherical-spherical joint)flexible parallel manipulator under consideration in thispaper, which is developed for the six-degree-of-freedomseismic simulator, the dynamics considering the structureflexibility is fundamental for the modeling, design, andcontrol.

The demands of high speed, high load, high precision,or lightweight structure from industry make it necessaryto consider the deformation, stiffness, and other dynamiccharacteristics for the parallel manipulator [10–23]. Math-ematical modeling of a general flexible parallel manipula-tor is a challenging task since there is no availability ofclosed-form solutions to the inverse kinematic model forthe flexible parallel manipulator. The nominal motion ofthe manipulator involves changing geometries resulting invarying system parameters. The equations of motion are

Page 2: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

2 Journal of Robotics

usually configuration dependent and need to be computed ateach configuration of the manipulator [10]. The equations ofmotion of a flexible five-bar manipulator were developed bymeans of the instantaneous structural approach, and it hadbeen found that the mode shapes and natural frequencies ofthis particular manipulator are invariant throughout mostof the workspace [11]. The design, dynamic modeling, andexperiment validation of a three-degree-of-freedom flexiblearm were presented in [12] on the assumption that all thearm mass is concentrated at the tip and at the base. Sothe dynamic of the arm becomes a lumped single massmodel instead of the usual distributed mass model. Thefinite element method and the Euler-Lagrange formulationwere used in [13] to model the flexible link of a three-degree-of-freedom parallel manipulator by assuming that theinfluence of flexible motion on rigid motion is negligible.With the piston being modeled as a mass-spring damper,a set of twelve Lagrange equations for flexible Stewartmanipulator was derived by using tensor representation in[14]. The dynamic model of the 3-PRR planar parallelmanipulator with flexible links was formulated by usingthe Lagrange equations of the first type on the assumptionthat the intermediate links being modeled with pinned-free boundary conditions [15]. The Lagrange finite elementformulation was used to derive such a dynamic model forthe flexible planar linkage with two translational and onerotational degrees of freedom, and then the dynamic modelwas applied to the flexible link planar parallel manipulatorbased on standard Kineto-elastodynamic assumptions [16].Based on the model, strain rate feedback control usingPZT transducers was used to simulate the active control ofKineto-elastodynamic responses. The dynamic finite elementanalysis of the flexible planar parallel manipulator waspresented in [17] including the convergence analysis ofthe natural frequencies and the mapping of the first-ordernatural frequency with respect to the robot configuration.It had also been found that the geometric stiffness andthe dynamic terms have a negligible effect on the responsefor this particular manipulator. A substructure modelingprocedure was presented to develop the dynamic model forthe flexible planar parallel manipulator in [18]. The Craig-Bampton method was used to reduce the model order andassemble the complete dynamic model. On the assumptionthat the deformations of the intermediate links are smallrelative to the length of the links, a procedure for thedevelopment of structural dynamic model for the 3-PRRflexible parallel manipulator was presented in [19] based onthe assumed mode method. Without considering the effectof nominal motion, reference [20] provided the stationaryvibration model of the sliding-leg parallel kinematic machinewhere the links were modeled as finite elements and thejoint as virtual spring/dampers. Then, the nonstationarymodel of the same mechanism was developed with theelastodynamic method [21]. In the researches cited above,there is little investigation on the Kineto-elastodynamiccharacteristics of the six-degree-of-freedom parallel manip-ulator while considering the natural frequency, the sen-sitivity analysis, the energy ratios, and the displacementresponse.

wv u

yz

x

2b 2b

A2

O

A3

A1 h

A4

A5A6

2 CC1

C4

C5

C6

B2B6

h2

h22a2a

B1

B32c

B5

B4

C3

O′

h1 − a

h1 − a

Figure 1: Schematic diagram of the 6-dof parallel structure seismicsimulator.

This paper presents the Kineto-elastodynamic modelingand the Kineto-elastodynamic characteristics analysis of the6-PSS parallel structure seismic simulator. It is organizedas follows: in Section 2, the description of the seismicsimulator and the rigid dynamic equations are presented.Section 3 gives the Kineto-elastodynamic model of themanipulator developed by virtue of the finite elementmethod and the substructure synthesis technique. Section 4investigates the Kineto-elastodynamic characteristics rep-resented by the natural frequency, the sensitivity analy-sis, the energy ratios, and the displacement response ofthe moving platform through simulation. Section 5 givesthe conclusions.

2. System Description and Rigid Dynamics

2.1. Description. The schematic diagram of the 6-dof parallelstructure seismic simulator is shown in Figure 1. As shownin Figure 1, the parallel manipulator is composed of amoving platform and six sliders. In each kinematic chain,the platform and the slider are connected via spherical ball-bearing joints by a strut of fixed length. Each slider is drivenby DC motor via a linear ball screw. The lead screws of B1, B2,and B3 are vertical to the ground.

For the purpose of analysis, the following coordinatesystems are defined. As shown in Figure 2, the coordinatesystem O− xyz is attached to the fixed base; another movingcoordinate frame O′ −uvw is located at the center of mass ofthe moving platform. The pose of the moving platform canbe described by a position vector r and a rotation matrix oRo′ .Let the rotation matrix be defined by the roll, pitch, andyaw angles, namely, a rotation of φx about the fixed x axis,followed by a rotation of φy about the fixed y axis, and arotation of φz about the fixed z axis. Thus, the rotation matrixis

oRo′ = Rot(z,φz

)Rot

(y,φy

)Rot

(x,φx

), (1)

Page 3: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 3

w

v u

i

Ci z

yx

Ai

Bi O

O′

r

a

liwi

di

qiei

bi

Figure 2: Vector diagram of a PSS kinematic.

z

zi

ϕi

Ci

φi

xxi

y

yi

z′i

Ai

y′i

x′i

Figure 3: The local coordinate system of the ith strut.

where sφ denotes the sine of angle φ, and cφ denotes thecosine of angle φ. In the hypothesis of small rotations, theangular velocity of the moving platform is given by [24, 25]

ω =[φx φy φz

]T. (2)

The orientation of each kinematic strut with respect tothe fixed base can be described by two Euler angles. As shownin Figure 3, the local coordinate system of the ith strut can bethought of as a rotation of φi about the z axis resulting in aCi − x′i y

′i z′i system followed by another rotation of ϕi about

the rotated y′i -axis. So the rotation matrix of the ith strut canbe written as

oRi = Rot(z,φi

)Rot

(y′i ,ϕi

) =

⎢⎢⎢⎣

cφicϕi −sφi cφisϕi

sφicϕi cφi sφisϕi

−sϕi 0 cϕi

⎥⎥⎥⎦

,

i = 1, 2, . . . , 6.(3)

The unit vector along the strut in the coordinate system O −xyz is

wi = oRiiwi = oRi

⎢⎢⎢⎣

0

0

1

⎥⎥⎥⎦=

⎢⎢⎢⎣

cφisϕi

sφisϕi

cϕi

⎥⎥⎥⎦. (4)

So the Euler angles φi and ϕi can be computed as follows:

cϕi = wiz,

sϕi =√w2ix +w2

iy ,(0 ≤ ϕi < π

),

sφi =wiy

sϕi,

(ϕi /= 0

),

cφi = wix

sϕi,

(ϕi /= 0

),

if ϕi = 0, then φi = 0.

(5)

2.2. Rigid Dynamics. When the seismic simulator is not ata singular configuration, the rigid dynamic model can beformulated by means of the principle of virtual work and theconcept link Jacobian matrices [25]. It can be expressed as

F = −J−T⎡

⎣fe

ne

⎦− J−T⎧⎨

⎣mpg

0

⎦ +6∑

i=1

JTivω

⎣mi

iRo g

0

+JT[

(mc1g)Te1(mc2g

)Te2(mc3g

)Te3(mc4g

)Te4(mc5g

)Te5(mc6g

)Te6

]T⎫⎬

+ J−T

⎧⎪⎨

⎪⎩

⎢⎣

mpv

oIp ω

⎥⎦ +

6∑

i=1

JTivω

⎣mi

iviiIi iωi

⎦ + JT[mc1q1 mc2q2 mc3q3 mc4q4 mc5q5 mc6q6

]T⎫⎪⎬

⎪⎭

+ J−T⎧⎨

⎣0

ω ×(oIp ω

)

⎦ +6∑

i=1

JTivω

⎣0

iωi×(iIi iωi

)

⎫⎬

⎭,

(6)

Page 4: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

4 Journal of Robotics

where 0 =[

0 0 0]T

, Jivω is the link Jacobian matrix whichmaps the velocity of the moving platform into the velocity ofthe ith strut in the Ci − xi yizi coordinate system, mp, mci,and mi denote the mass of the moving platform, the massof the slider, and the mass of the ith strut, respectively, oIpis the inertia matrix of the moving platform taken aboutthe center of mass expressed in the O − xyz coordinatesystem, iIi is the inertia matrix of the ith cylindrical strutabout their respective centers of mass expressed in the Ci −xi yizi coordinate system, fe and ne are the external force

and moment exerted at the center of mass of the movingplatform, v and ω are the linear and angular accelerationof the moving platform, ivi, iωi, and iωi are the linearacceleration, the angular velocity, and acceleration of theith strut expressed in the Ci − xi yizi coordinate system,respectively. qi denotes the joint acceleration, g is the gravityacceleration, J is the Jacobian matrix which maps the velocityvector of the moving platform into the velocity vector ofthe actuating joint. F is the input force vector exerted at thecenter of the slider. And

J = diag( 1

wT1 e1

1wT

2 e2

1wT

3 e3

1wT

4 e4

1wT

5 e5

1wT

6 e6

)

×⎡

⎣w1 w2 w3 w4 w5 w6

a1 ×w1 a2 ×w2 a3 ×w3 a4 ×w4 a5 ×w5 a6 ×w6

T

,

Jivω =

⎢⎢⎢⎢⎣

[iRo −S

(iai)iRo

]+li2S(iwi

)Jiω

1li

{[S(iwi

)iRo −S

(iwi

)S(iai)iRo

]−(iwi× iei

)[ wTi

wTi ei

(ai ×wi)T

wTi ei

]}

⎥⎥⎥⎥⎦=⎡

⎣Jiv

Jiω

⎦,

S(iwi

)=

⎢⎢⎢⎢⎣

0 − iwiziwiy

iwiz 0 − iwix

− iwiyiwix 0

⎥⎥⎥⎥⎦

,

S(iai)=

⎢⎢⎢⎣

0 − iaiziaiy

iaiz 0 − iaix

− iaiyiaix 0

⎥⎥⎥⎦

,

iωi = Jiω

⎣v

ω

⎦,

qi = 1wTi ei

(wTi v + (ai ×wi)

T ω + wTi (ω × (ω × ai))−wT

i (ωi × (ωi × liwi)))

,

iωi = Jiω

⎣v

ω

⎦ +1li

(Δ1 + Δ2),

Δ1 = −(iwi× iei

)

wTi ei

((wTi ω)(

aTi ω)−(

wTi ai)(

ωTω)

+ li|ωi ×wi|2)

,

Δ2 =(iωT

iiai)(

iwi×iωi

)−(iωT iω

)(iwi× iai

),

ivi = Jiv

⎣v

ω

⎦ + S(iωi

)S(iωi

)iai +

12S(iwi

)(Δ1 + Δ2)− li

2S(iωi

)S(iωi

)iwi .

(7)

Page 5: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 5

ei, ai, and wi are shown in Figure 2; they are the unit vectoralong the lead screw, the vector O′Ai, and the unit vectoralong strut CiAi, respectively.

3. Kineto-Elastodynamic Model

The idea of substructure synthesis and the finite elementmethod are adopted to develop the Kineto-elastodynamicmodel of the 6-PSS parallel structure seismic simulator.The finite element method used here is based on thebasic assumptions [26] as follows. (1) The deflections ofthe links of the manipulator obey the small deflectiontheory. The small amplitude structural vibrations do nothave a significant effect on its rigid-body motion andthe coupling term between the elastic deformation andthe rigid-body motion is neglected. The true motion isregarded as the sum of the rigid-body motion, and theelastic motion. (2) The instantaneous structural approachis adopted. At each instant, the manipulator is modeled asan instantaneous structure undergoing elastic deformationsabout its mean rigid body configuration. (3) The model isbased on the Euler-Bernoulli beam theory. (4) The transversedeflections are modeled as a cubic polynomial of the nodaldisplacement, the longitudinal deflections and the torsionaldeflections are modeled as a first-order polynomial of thenodal displacement. The manipulator is divided into sevensubstructures, namely, one moving platform substructureand six kinematic chain substructures which are composedof the lead-screw assembly and the strut. Each strut is dividedinto three elements. The moving platform and the slidersare regarded as the rigid bodies since their deformations aresmall relative to the elastic deformations.

3.1. Strut Dynamic Equation

3.1.1. Element Model. The nodal elastic displacement of theelement is shown in Figure 4. So the elastic displacement ofthe element can be expressed as

δ =[δi δ j

]T, (8)

where

δi =[ui vi wi θix θiy θiz

]T,

δ j =[uj vj wj θjx θj y θjz

]T.

(9)

The elastic displacement vector of an arbitrary pointP within the element can be expressed by the nodaldisplacement of the element [27]

p =[u v w θ

]T = Nδ, (10)

where N is relational matrix which maps the nodal elasticdisplacement vector of the element into that of the point P.

The polynomial of the nodal displacement of the elementis chosen to formulate the displacement of the point P.The transverse displacement, the longitudinal displacement,

z

x

y

wi

w

wji

j

ui

P

O

v

θu

vi

v j

l

x

uj

θiz

θixθiy

θ j yθjx

θjz

Figure 4: Nodal elastic displacement of the element.

and the torsional displacement of the point P are modeledas a cubic polynomial and a linear function of the nodaldisplacement, respectively. So the longitudinal displacementand the torsional displacement of the point P are expressedas

u = a0 + a1x,

θ = d0 + d1x.(11)

The transverse displacements of the point P can be expressedas

v = b0 + b1x + b2x2 + b3x

3,

w = c0 + c1x + c2x2 + c3x

3.(12)

Substituting (11) and (12) into (10) yields

p =

⎢⎢⎢⎢⎢⎣

u

v

w

θ

⎥⎥⎥⎥⎥⎦=

⎢⎢⎢⎢⎢⎣

Hu(x)a

Hv(x)b

Hw(x)c

Hθ(x)d

⎥⎥⎥⎥⎥⎦

, (13)

where

a =[a0 a1

]T,

b =[b0 b1 b2 b3

]T,

c =[c0 c1 c2 c3

]T,

d =[d0 d1

]T,

Hu(x) = Hθ(x) =[

1 x]

,

Hv(x) = Hw(x) =[

1 x x2 x3].

(14)

Considering the node i and the node j, where x = 0 andx = l, respectively, yields

a = A−1uθ δu,

b = A−1vwδv,

c = A−1vwδw,

d = A−1uθ δθ ,

(15)

Page 6: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

6 Journal of Robotics

where

δu =[ui uj

]T,

δv =[vi θiz v j θjz

]T,

δw =[wi θiy wj θj y

]T,

δθ =[θix θjx

]T,

A−1uθ =

⎢⎣

1 0

−1l

1l

⎥⎦,

A−1vw =

⎢⎢⎢⎢⎢⎢⎢⎢⎣

1 0 0 0

0 1 0 0

− 3l2−2l

3l2

−1l

2l3

1l2

− 2l3

1l2

⎥⎥⎥⎥⎥⎥⎥⎥⎦

.

(16)

Substituting (15) into (13) yields

p =

⎢⎢⎢⎢⎢⎢⎣

u

v

w

θ

⎥⎥⎥⎥⎥⎥⎦

=

⎢⎢⎢⎢⎢⎢⎣

hu(x)

hv(x)

hw(x)

hθ(x)

⎥⎥⎥⎥⎥⎥⎦

Aδ = Nδ, (17)

where

hu(x) =[

1 0 0 0 0 0 x 0 0 0 0 0]

,

hv(x) =[

0 1 0 0 0 x 0 x2 0 0 0 x3]

,

hw(x) =[

0 0 1 0 x 0 0 0 x2 0 x3 0]

,

hθ(x) =[

0 0 0 1 0 0 0 0 0 x 0 0]

,

A=

⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎣

1 0 0 0 0 0 0 0 0 0 0 0

0 1 0 0 0 0 0 0 0 0 0 0

0 0 1 0 0 0 0 0 0 0 0 0

0 0 0 1 0 0 0 0 0 0 0 0

0 0 0 0 1 0 0 0 0 0 0 0

0 0 0 0 0 1 0 0 0 0 0 0

−1l

0 0 0 0 01l

0 0 0 0 0

0 − 3l2

0 0 0 −2l

03l2

0 0 0 −1l

0 0 − 3l2

0 −2l

0 0 03l2

0 −1l

0

0 0 0 −1l

0 0 0 0 01l

0 0

0 02l3

01l2

0 0 0 − 2l3

01l2

0

02l3

0 0 01l2

0 − 2l3

0 0 01l2

⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎦

.

(18)

Considering the knowledge of material mechanics, the strainof the point P is

ε =

⎢⎢⎢⎢⎢⎢⎣

ε0

εby

εbz

εr

⎥⎥⎥⎥⎥⎥⎦

=

⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎣

du

dx

−y d2v

dx2

−z d2w

dx2

G

E

16Jkπd3

dx

⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎦

, (19)

where ε0 is the axial strain, εby and εbz are the flexural strainin the plane Oxy and Oxz, respectively, εr is the torsionalstrain, y and z are the distance along the y and z directionfrom the axis of the element to the point P, G is the torsionalmodulus, E is the Young’s modulus, Jk is the polar momentof inertia of cross-section, d is the diameter of the strut.

Substituting (17) into (19) yields

ε =

⎢⎢⎢⎢⎢⎢⎢⎣

h′u(x)

−yh′′v (x)

−zh′′w(x)

G

E

16Jkπd3

h′θ(x)

⎥⎥⎥⎥⎥⎥⎥⎦

Aδ = Bδ, (20)

where

h′u(x) =[

0 0 0 0 0 0 1 0 0 0 0 0]

,

h′′v (x) =[

0 0 0 0 0 0 0 2 0 0 0 6x]

,

h′′w(x) =[

0 0 0 0 0 0 0 0 2 0 6x 0]

,

h′θ(x) =[

0 0 0 0 0 0 0 0 0 1 0 0].

(21)

So the stress is

σ = Eε. (22)

According to the knowledge of material mechanics, thestrain energy of the element can be expressed as

U = 12

∫∫∫

εTσdv. (23)

Substituting (20) and (22) into (23) yields

U = 12

∫∫∫

EδTBTBδdv = 12δTE

∫∫∫

BTBdvδ = 12δTkδ,

(24)

where

k = 12E∫∫∫

BTBdv (25)

is the element stiffness matrix. Substituting (20) into (25)yields

Page 7: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 7

k =

⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎣

EA

l0 0 0 0 0 −EA

l0 0 0 0 0

012EIzl3

0 0 06EIzl2

0 −12EIzl3

0 0 06EIzl2

0 012EIyl3

0 −6EIyl2

0 0 0 −12EIyl3

0 −6EIyl2

0

0 0 0GJkl

0 0 0 0 0 −GJkl

0 0

0 0 −6EIyl2

04EIyl

0 0 06EIyl2

02EIyl

0

06EIzl2

0 0 04EIzl

0 −6EIzl2

0 0 02EIzl

−EAl

0 0 0 0 0EA

l0 0 0 0 0

0 −12EIzl3

0 0 0 −6EIzl2

012EIzl3

0 0 0 −6EIzl2

0 0 −12EIyl3

06EIyl2

0 0 012EIyl3

06EIyl2

0

0 0 0 −GJkl

0 0 0 0 0GJkl

0 0

0 0 −6EIyl2

02EIyl

0 0 06EIyl2

04EIyl

0

06EIzl2

0 0 02EIzl

0 −6EIzl2

0 0 04EIzl

⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎦

, (26)

where Iy and Iz are the principal moments of inertiacorresponding to the y axis and z axis, respectively, A is thearea of the cross-section of the uniform beam.

Based on the presented assumption, there are kinematicsrelationships as follows:

pa = pr + p,

pa = pr + p,(27)

where pa and pa are the absolute velocity and the absoluteacceleration of a certain point within the element, pr andpr are the velocity and the acceleration of the rigid-bodymotion, and p and p are the velocity and the acceleration ofthe elastic motion.

It can be proved that (see [27])

pr = Nr δr = Nδr ,

pr = Nr δr = Nδr ,(28)

where δr and δr are the nodal velocity and the acceleration ofthe rigid-body motion.

So the kinetic energy of the element can be expressed as

T = 12

∫ l

0m(x)pTa padx

= 12

∫ l

0m(x)δ

Ta NTNδadx

= 12δTa

∫ l

0m(x)NTNdxδa

= 12δTa mδa,

(29)

where δa is the absolute velocity of the node. And

m = 12

∫ l

0m(x)NTNdx (30)

is the element mass matrix. For the uniform beam, the massfunction is

m(x) = ρA, (31)

where ρ is the density of the beam. So the element massmatrix is

Page 8: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

8 Journal of Robotics

m = ρAl

420

⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎣

140 0 0 0 0 0 70 0 0 0 0 0

0 156 0 0 0 22l 0 54 0 0 0 −13l

0 0 156 0 −22l 0 0 0 54 0 13l 0

0 0 0140JkA

0 0 0 0 070JkA

0 0

0 0 −22l 0 4l2 0 0 0 −13l 0 −3l2 0

0 22l 0 0 0 4l2 0 13l 0 0 0 −3l2

70 0 0 0 0 0 140 0 0 0 0 0

0 54 0 0 0 13l 0 156 0 0 0 −22l

0 0 54 0 −13l 0 0 0 156 0 22l 0

0 0 070JkA

0 0 0 0 0140JkA

0 0

0 0 13l 0 −3l2 0 0 0 22l 0 4l2 0

0 −13l 0 0 0 −3l2 0 −22l 0 0 0 4l2

⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎦

. (32)

Substituting (23) and (29) into Lagrange equation yields

d

dt

(∂T

∂δ

)− ∂T

∂δ+∂U

∂δ= f , (33)

where f denotes the resultant of the applied and the internalforces exerted at the element. Thus, the kinematic differentialequation of the strut element within ith kinematic chain canbe achieved as follows:

mδ + kδ = f −mδr . (34)

Equation (34) can be expressed in the coordinate system O−xyz as

MeiUei + KeiUei = Fei −MeiUeri, i = 1, 2, . . . , 6 (35)

where

Uei = RTi δ,

Uei = RTi δ, Ueri = RT

i δr ,

Fei = RTi f ,

Mei = RTi mRi,

Kei = RTi kRi,

Ri = diag( (

oRi Rot(y,−π

2

))T (oRi Rot

(y,−π

2

))T

(oRi Rot

(y,−π

2

))T (oRi Rot

(y,−π

2

))T )

(36)

3.1.2. Strut Dynamic Equation. For the strut within ithkinematic chain, the dynamic motion in the coordinatesystem O − xyz can be assembled as

M′siU

′si + K′

siU′si = F′si −M′

siU′sri, (37)

where

M′si =

3∑

j=1

ATj MeiA j ,

K′si =

3∑

j=1

ATj KeiA j ,

F′si =3∑

j=1

ATj Fei =

⎢⎢⎢⎣

F∗c2i018×1

F∗c1i

⎥⎥⎥⎦

,

A1 =[

E12 012×12

],

A2 =[

012×6 E12 012×6

],

A3 =[

012×12 E12

],

(38)

where A j is the connectivity matrix which maps the totalnodal coordinates U′

si of the strut within the ith kinematicschain into the jth nodal coordinate within the strut. U′

si

and U′sri denote the the nodal acceleration of the elastic

motion and the rigid-body motion of the strut within theith kinematics chain. E12 is the unit matrix of order twelve.F∗c1i is the internal force between the strut and the slider.F∗c2i is the internal force between the rigid moving platformand the strut. All the above coordinates are measured in thecoordinate system O − xyz.

3.2. Slider Dynamic Equation. The oscillation of the slideralong the axial direction of the lead-screw can be expressedas

mciUci + kciUci = fi −mciqi − eTi F∗c1i, (39)

where Uci is the elastic displacement of the slider along theaxial direction of the lead-screw. kci is the equivalent axial

Page 9: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 9

stiffness of the lead screw assembly that is composed of threeserially connected component, that is, lead screw, ball nutwhich links slider with lead-screw and the two sets of supportbearings at both ends. Let kcsi, kcni, and kcbi denote theirrespective axial stiffness then the equivalent axial stiffness canbe expressed as

1kci= 1kcsi

+1kcni

+1kcbi

, kcsi = AsEs(L1i + L2i)L1iL2i

, (40)

where As and Es stand for the cross-sectional area of thelead screw and its Young’s modular, and L1i and L2i arethe distances between the nut and the two sets of supportbearings located at each end of the lead screw.

3.3. Deformation Compatibility Condition. The compatibilityof the deformations between the rigid moving platform andthe flexible strut can be expressed as

Uc2i =[

E3 −S(ai)]

Up, (41)

where Up denotes the generalized coordinates of vibrationmotion of the moving platform, Uc2i = U′

si(1 : 3, 1 : 1)denotes the elastic displacement of the corresponding nodewithin the flexible strut, S(ai) is the screw matrix of ai, andE3 denotes the unit matrix of the order three.

The compatibility of the deformations between the rigidslider and the flexible strut can be expressed as

eTi Uc1i = Uci, (42)

where Uc1i = U′si(18 : 21, 1 : 1) is the elastic displacement of

the corresponding node within the flexible strut.

3.4. Substructure Motion Equation

3.4.1. Moving Platform Substructure. The oscillation equa-tion of the rigid moving platform substructure in thecoordinate system O − xyz is

⎣mpE3 03×3

03×3oIp

⎦Up

⎢⎢⎢⎢⎢⎣

fe −mpv −6∑

i=1

F∗c2i

ne − oIp ω − ω ×(oIp ω

)−

6∑

i=1

ai × F∗c2i

⎥⎥⎥⎥⎥⎦= 0.

(43)

3.4.2. Kinematic Chain Substructure. Employing the defor-mation compatibility conditions between the flexible strutand the rigid slider and the boundary conditions of the slider,the motion equation of the ith kinematic chain substructurecan be assembled as

MkiUki + KkiUki = Fkci + Fkdi, (44)

where

Uki =⎡

⎣U′si(1 : 18, 1 : 1)

Uci

⎦,

Mki =⎡

⎣M′

si(1 : 18, 1 : 18) M′si(1 : 18, 21 : 21)

M′si(21 : 21, 1 : 18) M′

si(21 : 21, 21 : 21) +mci

i = 1, 2, 3,

Mki =⎡

⎣M′

si(1 : 18, 1 : 18) M′si(1 : 18, 20 : 20)

M′si(20 : 20, 1 : 18) M′

si(20 : 20, 20 : 20) +mci

i = 4, 5,

Mki =⎡

⎣M′

si(1 : 18, 1 : 18) M′si(1 : 18, 19 : 19)

M′si(19 : 19, 1 : 18) M′

si(19 : 19, 19 : 19) +mci

i = 6,

Kki =⎡

⎣K′si(1 : 18, 1 : 18) K′

si(1 : 18, 21 : 21)

K′si(21 : 21, 1 : 18) K′

si(21 : 21, 21 : 21) + kci

i = 1, 2, 3,

Kki =⎡

⎣K′si(1 : 18, 1 : 18) K′

si(1 : 18, 20 : 20)

K′si(20 : 20, 1 : 18) K′

si(20 : 20, 20 : 20) + kci

i = 4, 5,

Kki =⎡

⎣K′si(1 : 18, 1 : 18) K′

si(1 : 18, 19 : 19)

K′si(19 : 19, 1 : 18) K′

si(19 : 19, 19 : 19) + kci

i = 6,

Fkci =

⎢⎢⎢⎣

F∗c2i015×1

0

⎥⎥⎥⎦

,

Fkdi =⎡

⎣018×1

fi

⎦−MkiUkri,

Ukri =⎡

⎣U′sri(1 : 18, 1 : 1)

qi

(45)

Fkci is the internal forces between the elements within thestrut, Fkdi is the resultant force of the generalized inertialforce and the outside force.

3.5. Kineto-elasticdynamic Model of the Manipulator. Gather-ing the dynamic equations of the substructures and employ-ing the deformation compatibility conditions between therigid moving platform and the flexible strut yields

DTM′DU + DTK′DU = DTF′c + DTF′d, (46)

Page 10: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

10 Journal of Robotics

where

D =

⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎣

E6 06×96

E3 −S(a1) 03×96

016×6 E16 016×80

E3 −S(a2) 03×96

016×22 E16 016×64

E3 −S(a3) 03×96

016×38 E16 016×48

E3 −S(a4) 03×96

016×54 E16 016×32

E3 −S(a5) 03×96

016×70 E16 016×16

E3 −S(a6) 03×96

016×86 E16

⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎦

,

U =

⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎣

Up

Uk1(4 : 19, 1)

Uk2(4 : 19, 1)

Uk3(4 : 19, 1)

Uk4(4 : 19, 1)

Uk5(4 : 19, 1)

Uk6(4 : 19, 1)

⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎦

,

F′c =⎡

⎣−⎡

⎣6∑

i=1

F∗c2i

T

−⎡

⎣6∑

i=1

ai×F∗c2i

T

FTkc1 FTkc2 FTkc3 FTkc4 FTkc5 FTkc6

T

,

F′d =[ [

fe −mpv]T [

ne − oIp ω − ω × ( oIp ω)]T

FTkd1 FTkd2 FTkd3 FTkd4 FTkd5 FTkd6

]T

(47)

Simplifying (46) yields the kineto-elasticdynamic model ofthe manipulator

MU + KU = Fd, (48)

where

M = DTM′D, (49)

K = DTK′D, (50)

Fd = DTF′d. (51)

4. Kineto-ElastodynamicCharacteristics Analysis

In this section, the investigation on the Kineto-elasto-dynamic characteristics of the 6-PSS parallel structure seis-

mic simulator is carried out through simulation. The pro-gram is developed by the MATLAB software. The parametersof the seismic simulator used for the simulation are given inTables 1, 2, 3, and 4.

The mass of the moving platform is mp = 200 kg. Theinertia parameters used in the simulation are given as

o′Ip =

⎢⎢⎢⎣

17.333 0 0

0 17.333 0

0 0 33.333

⎥⎥⎥⎦

kg ·m2,

iIi =

⎢⎢⎢⎣

1.279 0 0

0 1.279 0

0 0 0.005

⎥⎥⎥⎦

kg ·m2.

(52)

Other parameters used in the simulation are given asE = 2.06× 1011 Pa, G = 79.38× 109 Pa, Es = 2.06×

1011 Pa, As = 1.96 × 10−3 m2, L1i + L2i = 1.1 m, ρ =7800 kg/m3, di = 0.244 m, d = 0.05 m, h1 =2 m, h2 = 1.5 m, h = 0.01 m, z0 = 1.744 m.

4.1. Natural Frequency. According to the vibration theory,the rigidity of the system may be represented by the naturalfrequency. The seismic simulator with the higher frequencywould have the higher stiffness.

From (48), we get

det(−ω2M + K

) = 0, (53)

where ω denotes the natural frequency. The distribution ofthe natural frequency is shown in Figure 5 when the pose ofthe moving platform is given as φx = φy = φz = 0 and z = z0.

It is shown in Figure 5 that the second-order naturalfrequency is much higher than the first-order naturalfrequency.

4.2. Sensitivity Analysis. The sensitivity analysis is usuallyused to evaluate the effect of the structural design variableson the performance of the manipulator. From (48), we get

(−ω2rM + K

)ϕr = 0, (54)

where ϕr and ωr are the mode shape value and the naturalfrequency of the vibration in the rth mode. Taking thederivative of (54) with respect to the structural design valuepm such as the radius of the strut and the radius of the leadscrew yields

(

−2ωr∂ωr∂pm

M− ω2r∂M∂pm

+∂K∂pm

)

ϕr

+(−ω2

rM + K) ∂ϕr∂pm

= 0.

(55)

Page 11: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 11

Table 1: The parameters of the base platform (m).

1 2 3 4 5 6

xBi 0.400000 0.000000 −0.400000 0.400000 −0.400000 −2.000000

yBi −0.400000 0.400000 −0.400000 −2.000000 −2.000000 0.000000

zBi 0.000000 0.000000 0.000000 1.500000 1.500000 1.500000

Table 2: The parameters of the moving platform which are measured in the coordinate frame O′ − uvw (m).

1 2 3 4 5 6

xAi 0.400000 0.000000 −0.400000 0.400000 −0.400000 −0.681000

yAi −0.400000 0.400000 −0.400000 −0.681000 −0.681000 0.000000

zAi −0.166000 −0.166000 −0.166000 −0.037500 −0.037500 −0.037500

Table 3: The length of the strut CiAi (m).

1 2 3 4 5 6

li 1.000000 1.000000 1.000000 1.000000 1.000000 1.000000

Table 4: The mass parameters of the manipulator (kg).

1 2 3 4 5 6

mi 20 20 20 20 20 20

mci 50 100 50 50 50 100

Taking dot product of ϕr on both sides of the equation yields

ϕTr

(

−2ωr∂ωr∂pm

M− ω2r∂M∂pm

+∂K∂pm

)

ϕr

+ ϕTr(−ω2

rM + K) ∂ϕr∂pm

= 0.

(56)

Since

ϕTr(−ω2

rM + K) =

((−ω2rM + K

)ϕr

)T = 0,

ϕTr Mϕr = E.(57)

give

−2ωr∂ωr∂pm

− ω2rϕ

Tr

∂M∂pm

ϕr + ϕTr∂K∂pm

ϕr = 0. (58)

so

∂ωr∂pm

= − 12ωr

(

ω2rϕ

Tr

∂M∂pm

ϕr − ϕTr∂K∂pm

ϕr

)

. (59)

Figure 6 shows the sensitivity distribution of the manipulatorwhen the pose of the moving platform is given as φx = φy =φz = 0 and z = z0. It is shown that the first-order naturalfrequency is sensitive to the radius of the strut and the radiusof the lead screw.

4.3. Energy Ratio Distribution. The computation of theenergy ratio is usually used to evaluate the allocation of thestiffness and the mass of the manipulator. Suppose that TsrandVsr are the maximum kinetic energy and elastic potentialenergy of the substructures vibrating in its rth mode. TAr andVAr denote the maximum kinetic energy and elastic potentialenergy of the system vibrating in the rth mode. Thus,

TAr =N∑

s=1

Tsr ,

VAr =N∑

s=1

Vsr ,

(60)

where

Tsr = 12ω2rArT

s msArs ,

Vsr = 12

ArTs ksAr

s .

(61)

Ars is the oscillating amplitude array of the substructure

vibrating in the rth mode. ms and ks denote the mass matrixand the stiffness matrix of the substructure, respectively.

So the energy ratio of the substructure can be achieved as

TsrTAr

= γsr ,N∑

s=1

γsr = 1,

Vsr

VAr= μsr ,

N∑

s=1

μsr = 1,

(62)

where γsr and μsr denote the kinetic energy ratio and theelastic potential energy ratio of the substructure, respectively.Figure 7 shows the distributions of the kinetic energy ratioand the elastic potential energy ratio, respectively, when thepose of the moving platform is given as φx = φy = φz = 0and z = z0. It is shown that the mass of the moving platformshould be reduced or the stiffness of the strut should beincreased in order to improve the dynamic characteristics ofthe manipulator and the stiffness of the sixth strut must beincreased from the energy ratios computation.

Page 12: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

12 Journal of Robotics

ω1

(Hz)

(m) (m)

81

80

79

78

77

76

750.1

0.050−0.05

−0.1 −0.1−0.05

00.05

0.1

(a)

94

92

90

88

86

84

−0.1−0.05

00.05

0.10.1

0.050−0.05

−0.1

ω2

(Hz)

(m)(m)

(b)

Figure 5: Distributions of the natural frequencies in the workspace. (a) First-order natural frequency. (b) Second-order natural frequency.

∂ω1/∂p m

(Hz/

mm

)

0.18

0.16

0.14

0.12

0.1

0.08

0.06

−0.1−0.05

00.05

0.1

0.10.05

0−0.05

−0.1

(m)(m)

(a)

0.17

0.16

0.15

0.14

0.13

0.12

0.11

−0.1−0.05

00.05

0.1

0.10.05

0−0.05

−0.1

∂ω1/∂p m

(Hz/

mm

)

(m)(m)

(b)

Figure 6: Sensitivities of the first-order natural frequency to the structure parameters. (a) Radius of the struts. (b) Radius of the lead screws.

4.4. Displacement Response Analysis. The displacementresponse analysis will be carried out by solving (48) subjectto the initial conditions

U0 = U(0),

U0 = U(0),(63)

Since the damping in the structure is a very complex sub-ject [28], the modal damping ratios of σr = 0.1% are addedto the Kineto-elastodynamic model of the manipulator.

From (48), we get(−ω2M + K

)ϕ = 0. (64)

Neglecting higher-order terms, the displacement vector Uof a multi-degree-of-freedom system can be expressed interms of the four dominant modal contributions. Thus, thedynamic response of the system can be expressed as

U = ϕη, (65)

where ϕ =[ϕ1 ϕ2 ϕ3 ϕ4

]is the modal matrix.

Substituting (65) into (50) and adding the modal damp-ing ratio yields

ϕTMϕη + ϕTCϕη + ϕTKϕη = ϕTFd, (66)

where

ϕTMϕ = E4,

ϕTCϕ = C = diag(

2σ1ω1 2σ2ω2 2σ3ω3 2σ4ω4

),

ϕTKϕ = Ω2 = diag(ω2

1 ω22 ω2

3 ω24

)

(67)

E4 is the unit matrix of order four.Substituting (67) into (66) yields

η + Cη + Ω2η = N, (68)

where

N = ϕTFd. (69)

Page 13: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 13

−0.1−0.05

00.05

0.1

0.10.05

0−0.05 −0.1

Slider1Slider2Slider3

Slider4Slider5Slider6

γ sc1

0.25

0.2

0.15

0.1

0.05

0

(m)(m)

(a)

−0.1−0.05

00.05

0.1

0.10.05

0−0.05

−0.1

γ sm

1

0.75

0.74

0.73

0.72

0.71

0.7

0.69

(m)(m)

(b)

Strut1Strut2Strut3

Strut4Strut5Strut6

γ ss1

−0.1−0.05

00.05

0.10.1

0.050−0.05

−0.1

0.025

0.02

0.015

0.01

0.005

0

(m)(m)

(c)

−0.1−0.05

00.05

0.10.1

0.050−0.05

−0.1

μsc

1

0.25

0.2

0.15

0.1

0.05

0

(m)(m)

Slider1Slider2Slider3

Slider4Slider5Slider6

(d)

μsm

1

−0.1−0.05

00.05

0.1

0.10.05

0−0.05

−0.1

0.305

0.3

0.295

0.29

0.285

(m)(m)

(e)

μss

1

0.5

0.4

0.3

0.2

0.1

0

−0.1−0.05

00.05

0.10.1

0.050−0.05

−0.1 (m)(m)

Strut1Strut2Strut3

Strut4Strut5Strut6

(f)

Figure 7: Distributions of the energy ratios in the workspace. (a) Kinetic energy ratios of the sliders. (b) Kinetic energy ratio of the movingplatform. (c) Kinetic energy ratios of the struts. (d) Elastic potential energy ratios of the sliders. (e) Elastic potential energy ratio of themoving platform. (f) Elastic potential energy ratios of the struts.

Page 14: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

14 Journal of Robotics

The stiffness matrix and the mass matrix of the Kineto-elastodynamic model of the parallel manipulator are timevarying. The common strategy of solving this kind ofproblem is dividing the motion period into several smalltime internals and regarding the stiffness matrix and the massmatrix as constant in each small time interval [26].

Let T denote the motion period which is divided into nintervals

Δt = T

n. (70)

In the ith time interval (ti−1 < t < ti), the motion equation ofthe manipulator is

ηr + 2σrω(i)r ηr +

(ω(i)r

)2ηr = Nr , (r = 1, 2, . . . ,N). (71)

So the contribution of the rth mode to the displacementresponse is

ηr(t) = 1

ω(i)dr

∫ t

ti−1

Nr(τ)e−σrω(i)r (t−τ) sinω(i)

dr (t − τ)dτ

+ηr(ti−1)(1− σ2

r

)1/2 e−σrω

(i)r (t−ti−1) cos

[ω(i)dr (t − ti−1)− ψr

]

+ηr(ti−1)

ω(i)dr

e−σrω(i)r (t−ti−1) sinω(i)

dr (t − ti−1),

(r = 1, 2, . . . ,N),(72)

where

ω(i)dr =

(1− σ2

r

)1/2ω(i)r , (73)

ψr = arctanσr

(1− σ2

r

)1/2 . (74)

Substituting t = ti into (73) yields

ηr(ti) = 1

ω(i)dr

∫ ti

ti−1

Nr(τ)e−σrω(i)r (ti−τ) sinω(i)

dr (ti − τ)dτ

+ηr(ti−1)(1− σ2

r

)1/2 e−σrω

(i)r Δt cos

[ω(i)drΔt − ψr

]

+ηr(ti−1)

ω(i)dr

e−σrω(i)r Δt sinω(i)

drΔt, (r = 1, 2, . . . ,N).

(75)

Taking the derivative of (72) with respect to time andsubstituting t = ti into it yields

ηr(ti)

= 1

ω(i)dr

∫ ti

ti−1

Nr(τ)[−σrω

(i)r e

−σrω(i)r (ti−τ) sinω(i)

dr (ti − τ)

+ω(i)dr e

−σrω(i)r (ti−τ) cosω(i)

dr (ti − τ)]dτ

− ηr(ti−1)

⎣ ω(i)dr

(1− σ2

r

)1/2 e−σrω

(i)r Δt sin

(ω(i)drΔt − ψr

)

+σrω

(i)r

(1− σ2

r

)1/2 e−σrω

(i)r Δt cos

(ω(i)drΔt − ψr

)]

− ηr(ti−1)

⎣ σrω(i)r

ω(i)dr

e−σrω(i)r Δt sinω(i)

drΔt − e−σrω(i)r Δt cosω(i)

drΔt

(r = 1, 2, . . . ,N).(76)

It is shown from (75) and (76) that ηr(ti) and ηr(ti) can beachieved when ηr(ti−1) and ηr(ti−1) are given. As for ti = 0,

ηr(0) =(ϕ(r)

)TMU(0),

ηr(0) =(ϕ(r)

)TMU(0).

(77)

So the total displacement response can be achieved bycombining these modal contributions

U(ti) =N∑

r=1

ηr(ti)ϕr(ti), (78)

It is the sum of the steady-state response and the transientstate response.

Assuming that the investigated trajectory of the movingplatform used in the simulation is expressed as

x = −0.1 +amaxT2

(τ − 1

2πsin(2πτ)

),

y = −0.1 +amaxT2

(τ − 1

2πsin(2πτ)

),

z = 1.644 +amaxT2

(τ − 1

2πsin(2πτ)

),

φx = −0.1 +amaxT2

(τ − 1

2πsin(2πτ)

),

φy = −0.1 +amaxT2

(τ − 1

2πsin(2πτ)

),

φz = −0.1 +amaxT2

(τ − 1

2πsin(2πτ)

),

(79)

where amax = 9.8 m/s2, τ = t/T , T = √2πS/amax s

in seconds, and S = 0.2 m(rad). The motion period isdivided into 512 intervals. The displacement response ofthe moving platform is shown in Figure 8. It is shown that

Page 15: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 15

×10−5

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

8

6

4

2

0

−2

−4

−6

−8

−10

(m)

Time (s)

(a)

×10−4

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

2

1.5

1

0.5

0

−0.5

−1

(m)

Time (s)

(b)

×10−4

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

1.5

1

0.5

0

−0.5

−1

−1.5

(m)

Time (s)

(c)

×10−4

φx

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

3

2

1

0

−1

−2

−3

Time (s)

(d)

×10−4

Time (s)

φy

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

4

3

2

1

0

−1

−2

−3

(e)

×10−4

Time (s)

φz

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

4

2

0

−2

−4

(f)

Figure 8: Displacement responses of the moving platform.(a) x direction, (b) y direction, (c) z direction, (d) φx direction, (e) φy direction,and (f) φz direction.

Page 16: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

16 Journal of Robotics

the displacement response of the moving platform alongthe x direction is smaller than these displacement responsesalong the y direction and along the z direction. The angulardisplacement response of the moving platform rotatingabout z axis is slightly larger than those angular displacementresponses rotating about the x axis and about the y axis.

5. Conclusion

Based on the Kineto-elastodynamic assumption, the model-ing and the Kineto-elastodynamic characteristics of the 6-PSS parallel structure seismic simulator have been system-atically investigated through simulation. The conclusions aredrawn from the simulation as follows.

(1) The maps of the natural frequencies with respect tothe manipulator configuration have been achieved. Itis shown that the second-order natural frequency ismuch higher than the first-order natural frequency.

(2) From the sensitivity analysis, the first-order naturalfrequency is sensitive to the radius of the strut andthe radius of the lead screw.

(3) The mass of the moving platform should be reducedor the stiffness of the strut should be increased inorder to improve the dynamic characteristic of themanipulator, and the stiffness of the sixth strut mustbe increased from the energy ratios computation.

(4) For the investigated trajectory, the displacementresponse of the moving platform along the x-direction is smaller than these displacementresponses along the y direction and along the zdirection. The angular displacement response of themoving platform rotating about z-axis is slightlylarger than those angular displacement responsesrotating about the x-axis and about the y-axis.

Acknowledgments

This research is jointly sponsored by the National NaturalScience Foundation of China (Grant no. 50905102), theNatural Science Foundation of Guangdong Province (Grantsnos. 10151503101000033 and 8351503101000001), and theBuilding Fund for the Academic Innovation Team of ShantouUniversity (Grant no. ITC10003). The author would alsolike to thank the anonymous reviewers for their very usefulcomments.

References

[1] http://www.mts.com/en/products/producttype/test-systems/simulation-systems/seismic-simulators/6-dof-custom/index.htm.

[2] M. Ceccarelli, E. Ottaviano, and M. Galvagno, “A 3-DOFparallel manipulator as earthquake motion simulator,” inProceedings of the 7th International Conference on Control,Automation, Robotics and Vision (ICARC ’02), pp. 944–949,December 2002.

[3] M. Ceccarelli, E. Ottaviano, and G. Castelli, “An applicationof a 3-DOF parallel manipulator for earthquake simula-tions,” in Proceedings of the 22nd International Symposium onAutomation and Robotics in Construction (ISARC ’05), pp. 1–8,September 2005.

[4] Y. Zhao, F. Gao, W. Li, W. Liu, and X. Zhao, “Developmentof 6-dof parallel seismic simulator with novel redundantactuation,” Mechatronics, vol. 19, no. 3, pp. 422–427, 2009.

[5] J. P. Merlet, Parallel Robots, Springer, Dordrecht, The Nether-lands, 2nd edition, 2006.

[6] L. W. Tsai, Robot Analysis, the Mechanics of Serial and ParallelManipulators, John Wiley & Sons, New York, NY, USA, 1999.

[7] Z. Huang, Y. F. Fang, and L. F. Kong, Theory of Parallel RoboticMechanisms and Control, China Machine Press, Beijing, China,1997.

[8] http://www-sop.inria.fr/coprin/equipe/merlet/merlet eng.html.

[9] S. K. Dwivedy and P. Eberhard, “Dynamic analysis of flexiblemanipulators, a literature review,” Mechanism and MachineTheory, vol. 41, no. 7, pp. 749–777, 2006.

[10] Y. Zhao, F. Gao, X. Dong, and X. Zhao, “Elastodynamiccharacteristics comparison of the 8-PSS redundant parallelmanipulator and its non-redundant counterpart-the 6-PSSparallel manipulator,” Mechanism and Machine Theory, vol.45, no. 2, pp. 291–303, 2010.

[11] P. K. Subrahmanyan and P. Seshu, “Dynamics of a flexible fivebar manipulator,” Computers & Structures, vol. 63, no. 2, pp.283–294, 1997.

[12] J. A. Somolinos, V. Feliu, and L. Sanchez, “Design, dynamicmodelling and experimental validation of a new three-degree-of-freedom flexible arm,” Mechatronics, vol. 12, no. 7, pp. 919–948, 2002.

[13] A. Fattah, J. Angeles, and A. K. Misra, “Dynamics of a3-DOF spatial parallel manipulator with flexible links,” inProceedings of the IEEE International Conference on Roboticsand Automation, pp. 627–632, Nagoya, Japan, May 1995.

[14] J. D. Lee and Z. Geng, “A dynamic model of a flexible stewartplatform,” Computers & Structures, vol. 48, no. 3, pp. 367–374,1993.

[15] B. Kang and J. K. Mills, “Dynamic modeling of structurally-flexible planar parallel manipulator,” Robotica, vol. 20, no. 3,pp. 329–339, 2002.

[16] X. Wang and J. K. Mills, “FEM dynamic model for activevibration control of flexible linkages and its application to aplanar parallel manipulator,” Applied Acoustics, vol. 66, no. 10,pp. 1151–1161, 2005.

[17] G. Piras, W. L. Cleghorn, and J. K. Mills, “Dynamic finite-element analysis of a planar high-speed, high-precision par-allel manipulator with flexible links,” Mechanism and MachineTheory, vol. 40, no. 7, pp. 849–862, 2005.

[18] X. Wang and J. K. Mills, “Dynamic modeling of a flexible-link planar parallel platform using a substructuring approach,”Mechanism and Machine Theory, vol. 41, no. 6, pp. 671–687,2006.

[19] X. Zhang, J. K. Mills, and W. L. Cleghorn, “Dynamic modelingand experimental validation of a 3-PRR parallel manipulatorwith flexible intermediate links,” Journal of Intelligent &Robotic Systems, vol. 50, no. 4, pp. 323–340, 2007.

[20] Z. Zhou, J. Xi, and C. K. Mechefske, “Modeling of a fullyflexible 3PRS manipulator for vibration analysis,” Journal ofMechanical Design, vol. 128, no. 2, pp. 403–412, 2006.

[21] Z. Zhou, C. K. Mechefske, and F. Xi, “Nonstationary vibrationof a fully flexible parallel kinematic machine,” Journal ofVibration and Acoustics, vol. 129, no. 5, pp. 623–630, 2007.

Page 17: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

Journal of Robotics 17

[22] Y. Yun and Y. Li, “Design and analysis of a novel 6-DOFredundant actuated parallel robot with compliant hinges forhigh precision positioning,” Nonlinear Dynamics, vol. 61, no.4, pp. 829–845, 2010.

[23] Y. Li and Q. Xu, “Dynamic modeling and robust control of a3-PRC translational parallel kinematic machine,” Robotics andComputer-Integrated Manufacturing, vol. 25, no. 3, pp. 630–640, 2009.

[24] L. W. Tsai, “Solving the inverse dynamics of a Stewart-Goughmanipulator by the principle of virtual work,” Journal ofMechanical Design, vol. 122, no. 1, pp. 3–9, 2000.

[25] Y. Zhao and F. Gao, “Inverse dynamics of the 6-dof out-parallel manipulator by means of the principle of virtualwork,” Robotica, vol. 27, no. 2, pp. 259–268, 2009.

[26] C. Zhang, Y. Q. Huang, Z. L. Wang et al., Analysis and Synthesisof Elastic Mechanical Linkage, China Machine Press, Beijing,China, 2nd edition, 1997.

[27] Y. Q. Yu and Z. Li, Modern Dynamics of Machinery, BeijingUniversity of Technology Press, Beijing, China, 1998.

[28] A. K. Chopra, Dynamics of Structures: Theory and Applicationsto Earthquake Engineering, Pearson Education Asia Limitedand Tsinghua University Press, 2nd edition, 2001.

Page 18: Kineto-ElastodynamicCharacteristicsof theSix-Degree-of ...downloads.hindawi.com/journals/jr/2011/489695.pdf · Kineto-ElastodynamicCharacteristicsof theSix-Degree-of-FreedomParallelStructure

International Journal of

AerospaceEngineeringHindawi Publishing Corporationhttp://www.hindawi.com Volume 2010

RoboticsJournal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Active and Passive Electronic Components

Control Scienceand Engineering

Journal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

International Journal of

RotatingMachinery

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Hindawi Publishing Corporation http://www.hindawi.com

Journal ofEngineeringVolume 2014

Submit your manuscripts athttp://www.hindawi.com

VLSI Design

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Shock and Vibration

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Civil EngineeringAdvances in

Acoustics and VibrationAdvances in

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Electrical and Computer Engineering

Journal of

Advances inOptoElectronics

Hindawi Publishing Corporation http://www.hindawi.com

Volume 2014

The Scientific World JournalHindawi Publishing Corporation http://www.hindawi.com Volume 2014

SensorsJournal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Modelling & Simulation in EngineeringHindawi Publishing Corporation http://www.hindawi.com Volume 2014

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Chemical EngineeringInternational Journal of Antennas and

Propagation

International Journal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Navigation and Observation

International Journal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

DistributedSensor Networks

International Journal of