Professional Documents
Culture Documents
Abstract A co-simulation method for rigid-flexible coupling case, parallel robots are easily modeled with independent
system is proposed in this paper, it is simple and easily carried out. In coordinates, while parallel robots with flexible links [4] are
order to solve the dynamics of 3-TPT parallel robot more accurately, more difficult to model because of the unavailability of
its three driven links are regard as flexible bodies and the other parts
closed-form solutions. Consequently, dynamics coupling
are rigid bodies to form the rigid-flexible coupling system, and the
dynamics equation of the coupling system is educed by Lagranges
effects amongst the various kinematic chains of the
equation, but it is very complex and difficult to educe number mechanisms, and coupling between rigid body motion and
solution, so the co-simulation method using ADAMS and ANSYS is flexible motion are generally more complex to model than in
put forward, which the dynamics analysis is fulfilled in ADAMS and the serial mechanism case.
stress analysis in ANSYS. The concrete steps are also introduced. In Fattah et al.[5] use a linear elasticdynamics approach to
order to observe the simulation results better, The simulation results model a parallel platform by assuming that the influence of
are compared with rigid system, and the results show that the forces flexible motion on rigid body motion is negligible. While
applied on flexible bodies appear high nonlinear, This state is closer ignoring this coupling leads to a simplified linear dynamic
to the truth, so the simulation results are more authentic and can
model, the validity of this assumption is questionable when the
reflect actual dynamics characteristic of 3-TPT parallel robot.
effects of flexible motion on rigid body motion are not
ignorable[6]. In cases in which the effects of flexible motion
on rigid body motion must be considered[7,8], dynamic
I. INTRODUCTION formulations that include nonlinear coupling of rigid body
motion and flexible motion must be adopted.
Parallel robot as a kind of new type mechanism has some This paper is organized as follows: section 2 presents the
merits such as high stiffness, stronger carrying capacity, fast dynamics equation of rigid-flexible coupling system of 3-TPT
respond speed and small error, so they have extensive applied parallel robot using Lagranges equation. In section 3 we
domain. With their further application and study, the studies explain how to unite ANSYS and ADAMS software to set up
on their theory and application have become scholastics complicated rigid-flexible coupling system model of parallel
popular tasks. In general, there are some achievements on robots, and then give the 3-TPT parallel robot dynamics
researches of kinematics analysis, performance analysis, simulation results. Finally, conclusions are given.
dynamic characteristics and control methods. The flexible
deformation of slender links has a great effect on rationality of II. LAGRANGES EQUATION OF RIGID-FLEXIBLE COUPLING
result during the course of structure optimization, kinematics SYSTEM OF 3-TPT PARALLEL MACHINE TOOL
analysis, dynamics analysis and dynamics simulation. In the
past dynamics researches, the slender links were regarded as
Dynamics modeling of rigid-flexible coupling system
rigid bodies and their deformation was often neglected, which
can be completed by various dynamics principles such as: law
leads to the results that are not conform to the fact and cause
of conservation of energy, Newton-Eulers equations,
errors. In order to better describe the structural characteristic
Lagranges equation and Kanes equation, etc. Among them
of 3-TPT parallel robots, in this paper we take its driven links
Lagranges equation is built based on the viewpoint of energy.
as flexible bodies to simulate and analyze its dynamics
The method of modeling which using Lagranges equation
characteristic.
[9,10,11] is mature, so a lot of software adopts this method
Modeling rigid-flexible system has attracted intense interest
including ADAMS. But it is very complex, and there is a large
for more than three decades [1]. However, many of the
calculation mount for computing, but the method also has
research reports have been conducted on serial mechanisms,
some advantages that it can easily fulfill recurrence modeling
i.e. open-loop mechanisms, while there is less work on
and can directly describe boundary conditions and physical
closedloop structures, such as four-bar linkage mechanisms[2]
characters.
or slide-crank mechanisms[3]. Dynamics modeling of parallel
The 3-TPT parallel robot which is made up of base
robots, which are characterized by multiple closed-loop chains,
platform, mobile platform and driven links is showed in Fig.1.
has not been studied extensively. We note that in the rigid link
The driven links are regarded as flexible bodies due to its 1 0 0 0 0
0 0
2
weak stiffness, and the other bodies are regarded as rigid = 0 1 0 (1 )l 0 0 l
bodies. The dynamics equation will be built by above 0 0 1 (1 )l 0 0 l
assumption using Lagranges equation, we firstly built the
mass matrix, stiffness matrix and generalized force matrix of Where, = x / l , = z / l , = y / l
branched chain and constraint equations, and then assembled The Euler quaternion is P = [ E0 , E1 , E2 , E3 ]T the rotated
them into the overall Lagranges equation.
transformation matrix of mobile coordinate system relative to
stable one is:
1 2 E22 2 E32 2( E1 E2 E0 E3 ) 2( E1 E3 + E0 E2 )
3
A = 2( E1 E2 + E0 E3 ) 1 2 E12 2 E32 2( E2 E3 E0 E1 )
2( E1 E2 E0 E2 ) 2( E2 E3 + E0 E1 ) 1 2 E12 2 E22
The position vector of arbitrary point in branched
chain when it is deformed is expressed as u :
q f 5 + l + (1 )q f 1
4
u = u0 + u f = (1 )q f 2 + q f 6 (1 )l q f 4 l q f 8
(1 )q + q (1 )l q l q
f3 f7 f4 f8
Fig.1. The sketch of 3-TPT parallel robot
Where, u0 is position vector when the body have no
qf 3 qf 7 deformation.
qf 4
A. The mass matrix, stiffness matrix and generalized force
qf1 C qf 5 matrix of branched chain
A
C The mass matrix of branched chain can be expressed as
qf 2 qf 8 q
f6
M:
Fig.2 The sketch of flexible driven link with coordinate
mRR mR mRf
5
The length of the driven link is l , mass density is , M = m R m m f
elastic modulus is E , sectional area is A , the mobile platform m fR mf m ff
is a equilateral triangle, length of side is a , each link only Where, mRR is the inertia of rigid mobile part of follow-up
consider its gravity. According to the character of motion and
frame of reference of branched chain;; mR is the inertia
deformation, the coordinates is set as in Fig.2, the undeformed
line between the end points C and A is picked as the x2 coupling between rigid movement and rotation of follow-up
axis of mobile coordinate system, so the elastic deformation frame of reference of branched chain; mRf is the inertia
relative to mobile coordinate system is equal to the vibration coupling between rigid movement and deformation of
of a space element, then the deformation amount of each point follow-up frame of reference of branched chain; m f is the
on flexible driven link can be expressed: as equation (1).
inertia coupling between rigid rotation and deformation of
u f = q f 1
follow-up frame of reference of branched chain; m is the
Where q f = [q f 1 , q f 2 , q f 3 , q f 4 , q f 5 , q f 6 , q f 7 , q f 8 ]T is the inertia coupling of rigid rotation of follow-up frame of
generalized coordinate of corresponding elastic deformation, reference of branched chain; m ff is the inertia of elastic
they represent the corners and displacements in x direction deformation of follow-up frame of reference of branched
of end points C and A ; q f 1 , q f 5 are displacements in x2 axis chain.
direction; q f 2 , q f 6 are displacements in y2 axis direction; The stiffness matrix of branched chain corresponds to
2 elastic coordinate q f can be expressed as equation (6).
q f 3 , q f 7 are displacements in z axis direction; q f 4 , q f 8 are
torsions around x2 axis; is matrix of Ritz primary function, In the external forces of branched chain CA , the
the Ritz primary function can be expressed: as equation (2).: restraint forces are appeared with the Lagrange multiplier
4 EI 4 EI C (a11 a22 ) = (a11 )T a22 = 0
l 0 0 0 C (a1 // a1 ) =
1 2
l
C (a1 a3 ) = (a1 ) a3 = 0
1 2 1 T 2
0 4 EI 2 EI 7
0 0 C (d12 a2 ) = ( d12 ) a2 = 0
2 T 2
l l 6
C (d12 // a12 ) =
C (d12 a3 ) = ( d12 ) a3 = 0
2 T 2
K ff = 0
EA
0 0 0
l
2 EI
4 EI C (a1 a 2 ) = ( a1 )T a 2 = 0
0 0 0 2 1 2 1
l l There are five constraint equations in the equation group.
2 EI 4 EI
0 0 0 1
There is only one freedom of degree which a1 slips along
l l
items. So there is only need to consider active forces, so the 2
with a1 between the two links.
generalized force can be written two parts, one part Q f is (2) The constraint equations of Hook joints in branched
leaded by gravitate, the other is caused by time varying of chain
mass matrix and the elastic deformation of branched chain, so The branched chain1 is connected with mobile platform
there is generalized force QV correlated with quadratic term of by Hook joints. Firstly we set a unite vector a0 on base
velocity, which are centrifugal force of inertia and Coriolis platform and its direction is from O to B1 . And the body
force of inertia.
coordinate of swing link1 is also set on B1 , so the cross axle
The mass matrix and generalized force matrix of base
center of Hook joint is the overlap point, the vectors
platform can be got with the same method when taking no a0 and a11 in cross axle are the unite vectors on the two bodies,
account of the effect of elastic deformation. they are perpendicular all the time. These two conditions
determine the constraints of hook joints as follows:
B. The constraint equations
C ( B1 = o1 ) = RO1' + A1u1 RB1 A0u = 0 8
' '
3-TPT parallel robot is a closed loop system, its
constraints are many and complicated. We will analyse them
C ( a0 a1 ) = ( a0 ) a1 = 0
1 T 1
detail as follows.
(1) The constraint equations of mobile joint in branched There are four scalar equations in above equation group,
chain1 and they restrict the four freedoms of motion of swing link and
they only have two rotate freedoms of motion which around
1
the vector a0 and a1 .
The branched link1 is also connected with base platform
by Hook joints, the analytical method is similar to above one,
and we also can get four constraint equations. For branched
chain 2 and 3, we also can build their constraint equation refer
to above analytical method. So in each branched chain, there
are 13 constraint equations and in this parallel mechanism
there are 39 constraint equations brought by motion constraints
in all.
Fig.3. The sketch of branched chain 1 of 3-TPT parallel robot with coordinates B. The overall control equation
The branched chain 1 showed in Fig.3, the body After getting all the constraint equations, we can
coordinate o1 x1 y1 z1 and o2 x2 y2 z2 of the swing link1 and the assemble them into the overall control equation. The general
expression of system control equation is:
driven link 1 are set on points B1 and A1 respectively, and the
Mq&& + Kq + CqT + (CPP )T T = QV + QF 9
vector a = [ a1
1 1 T
a12 a31 ] and a1 = [a11 a12 a31 ] are
T
C ( q , t ) = 0
their unit vectors. d12 is the vector connected A1 and B1 , Where is the Lagrange multiplier.
the two links are connected by translation joint, the constraint From above we can see that after assembling the
equations can be expressed as equation (7).: constraint equations into the control equation, it must be very
complicated and difficult to work out its solution. So we
suggest the following co-simulation method to solve it. node numbers; the more it has the more precise the simulate
results will be.
III. CO-SIMULATION WITH VIRTUAL PROTOTYPING AND FINITE (2) Interface points: The interface points are exterior
ELEMENT TECHNIQUE nodes; they are used for connecting flexible bodies with other
parts in ADAMS. If the constraints and forces need to be
Virtual prototype (VP) is an engineering technique that applied on flexible bodies, they are only can be applied on
can build model of mechanism similar to physics prototype, its them. So they are very important.
core parts are multibody system kinematics, dynamics (3) Unit: The unit must be appointed for finite element
modeling and corresponding numerical algorithm and it can analysis when creating the modal neural file. Because it will
simulate system motion and dynamics characteristic in the real be transformed into ADAMS, It must conform to the unit in
environment. At present ADAMS software is broadly applied , ADAMS.
its inner module ADAMS/Flex can fulfill dynamics modeling
and analyze of elastic body.
There are two ways to generate flexible bodies in
ADAMS[12]: one is that rigid bodies automatically generate
flexible bodies, it creates modal neutral file (MNF) by using
ADAMS/AutoFlex module; the other is that the modal neutral
file creates in finite element software such as: ANSYS,
NASTRAN and is translated into these software relying on
date interface between ADAMS/Flex module and finite
element software.
A. The realization of co-simulation of rigid-flexible coupling Fig.4. The finite element model of driven links
system with ANSYS and ADAMS
REFERENCES
[1] A.A. Shabana, Flexible multibody dynamics: review of past and recent
developments, Journal of Multibody System Dynamics 1, vol. 2, pp.
189_222, 1997.
[2] C.Y. Liao, C.K. Sung, An elastodynamic analysis and control of flexible
linkages using piezoceramic sensors and actuators, ASME Journal of
Mechanical Design, vol. 115, pp. 658-665, 1993.
[3] S.B. Choi, C.C. Cheong, B.S. Thompson, et al, Vibration control of
flexible linkage mechanisms using piezoelectric films, Mechanism and
Machine Theory, vol. 29, pp. 535_546, April 1994.
[4] B.S. Yuan, J.W. Lee, W.J. Book, Dynamic analysis of light weight arms
with a parallel mechanism, in: Proceeding of Advances in Flexible