Professional Documents
Culture Documents
2010 Iros Reza SGP
2010 Iros Reza SGP
I. I NTRODUCTION
In recent decades, numerous research results has been reported
on the kinematics of parallel manipulators, and relatively fewer
results on the dynamics of parallel manipulators. Several approaches have been proposed for the dynamic analysis of parallel
manipulators. The traditional NewtonEuler formulation is used
for the dynamic analysis of general parallel manipulators [1]
and also for the Stewart-Gough platform (SGP), which is the
most celebrated parallel manipulator [2]. In this formulation the
equations of motion for each limb and the moving platform must be
derived, which inevitably leads to a large number of equations and
less computational efficiency. On the other hand, all the reaction
forces can be computed, which is very useful in the design of
a parallel manipulator. The Lagrangian formulation eliminates all
the unwanted reaction forces at the outset, and it is usually more
efficient [3]. However, because of the constraints imposed by the
closed loop kinematic chains of a parallel manipulator, deriving
explicit equations of motion in terms of a set of independent
generalized coordinates is a prohibitive task [4]. Other approaches
have also been suggested in the literature to tackle the dynamics
formulation of parallel manipulators, representatives of such research can be given as [5], [6]. In most of the reported researches,
partly straightforward routines were proposed in order to derive
the dynamic equation using NE formulation [7], Lagrange [4], or
Kane methods [6]. However, the final dynamics formulations are
usually very bulky and untractable especially for a six degrees of
freedom parallel manipulator like SGP. This is because of several
parameter substitutions in NE and several differential component
wise operations in Lagrange and Kane methods. Therefore, dynamic analysis of such equations are usually untractable and can
This research is supported by K.N. Toosi University of Technology under
grant MP1853 and INSF grant 8810125.
Authors are with the Advanced Robotics and Automated Systems (ARAS), Faculty of Electrical and Computer Engineering, K.
N. Toosi University of Technology, P.O. Box 16315-1355, Tehran,
Iran, E-mails:oftadeh.reza@ee.kntu.ac.ir, m aref@sina.kntu.ac.ir, and taghirad@kntu.ac.ir.
(1)
2772
in which,
bi = A RB B bi
(5)
x + bi
(6)
xi
i
a i + li s
(7)
Fig. 1.
ci1
i
ai + ci1 s
(8)
ci2
si
ai + (li ci2 )
(9)
II. K INEMATICS
A. Mechanism Description
Figure 1 shows a schematics of a Stewart-Gough Platform (SGP)
under study. In this manipulator the spatial motion of the moving
platform is generated by six pistoncylinder actuators. While these
limbs are generally considered identical, in this analysis they can
differ in both geometry and mass properties. Each pistoncylinder
actuator consists of two part connected with a prismatic joint. The
actuators connected the fixed base to the moving platform by spherical joints at points Ai and Bi , i = 1, 2, . . . , 6 respectively. Fixed
attachment points Ai s are connected to the base, while moving
attachment points Bi s are connected to the moving platform. Note
that in a geometrically general Stewart Gough platform which is
considered here, the attachment points are not necessarily lie in the
same plane. Further more the following assumptions are considered
for the manipulator. The cylinder and piston centers of masses lie
si
kx + bi ai k2
1
(x + bi ai )
li
(3)
(4)
E
+ E
(10)
(11)
i + li i s
i
x i = li s
(12)
(13)
(14)
1
1
i x i = s
i (x + bi )
s
li
li
(15)
2773
XP
next = nd +
6
X
bi f B i = A I P + A I P (26)
i=1
in which,
T
I P = A RB B I P A RB
(27)
Fig. 2.
Figure 2 shows also the free body diagram for the cylinder and
the piston. Let mi1 and mi2 be the mass and Ai I ci1 and Ai I ci2
be the inertia tensor of the cylinder and the piston, respectively.
Newton-Euler equations for the dynamics of the cylinder can be
written as:
X
(28)
f ext = f Ai f ci + mi1 g = mi1 aci1
Xc
i1
i f ci M ci
next = ci1
si f Ai + di1 s
= A I ci1 i + i A I ci1 i
i ) + li s
i
v ci2 = (li ci2 ) ( i s
(18)
i =
i + li i
x
li s
si + li i
si + li i
si + li i ( i
si ) (19)
i , respectively. By
Similarly, dot and cross multiply 18 and 19 by s
some simplification based on VTP and equations 14,
li and i ,
can be derived as:
li
i s
i + li | i |22
x
i + li | i |22 (20)
[
x + bi + ( bi )]T s
1
i x
i 2li i
s
li
1
si [
x + b
(21)
=
i + (bi )] 2li i
li
Also by differentiation of 16 and 17 the acceleration vectors of the
piston and the cylinder center of mass can be derived as:
i | i |22 s
i
aci1 = ci1 i s
(22)
i | i |22 s
i + 2li ( i s
i ) +
i
aci2 = (li ci2 ) i s
li s
(23)
i
(29)
(17)
in which,
Ai
and,
di1 = li ci1 2ci2
= A I ci2 i + i A I ci2 i
(33)
in which,
A
qi =
(24)
f ext =
6
X
f B i + mg + F d = m
x
(25)
(34)
,
) = 0
x
, , ,
f (x, x,
(31)
In this section the equations of motion for the limbs and the
moving platform is derived based on NewtonEuler formulation.
This yields to a set of implicit dynamic equations for SGP as:
(30)
i ai
s
|
si ai |2
i = s
i q
i
r
(35)
(36)
i x
q
i x
r
i x
s
A
i y
q
i y
r
y
RAi = s
i z
q
i z
r
z
(37)
, y
and z
are unit vectors along principle axes of
In which, x
the fixed frame A. Moreover, as described before the limbs are
considered to be symmetric. Hence, Ai I ci1 and Ai I ci2 (and
generally Ai I ci ) is in the form of,
Ixx
0
0
Ai
Ixx
0
I ci = 0
(38)
0
0
Izz
In order to simplify and eliminate internal forces in equations
2834, we may start using 28 to derive f Ai as a function of f ci :
i=1
2774
(39)
(41)
in which, f n
ci denotes the component of the force in a direction
i . Substitute f ci from 41, aci1 from 22, and di1 from
normal to s
31, into equation 40. This results in M ci as a function of f n
ci and
the actuator forces i . Using VTP and considering the fact that
i f ci = f n
s
ci , simplifies M ci to:
M ci = mi1 c2i1 i A I ci1 i i A I ci1 i
i g
i f n
(li 2ci2 ) s
ci + mi1 ci1 s
(42)
i . A I ci2 i i
I ci2 i s
i M ci
+ ci2 f n
ci + s
(49)
i (
+ mi1 ci1 s
si g)
Because of the nature of the prismatic joints of the limbs, and in
order to derive f bi in a vector form and not componentwise, we
have also separated f bi into two parts:
s
f bi = f n
bi + f bi
f sbi
(44)
fn
bi
in which,
and
are the contributions of f bi in the direction
i and a direction normal to s
i , respectively. This separation
of s
results into a better elimination of internal forces and thus simplification of dynamic equations for each limb. Note that while f n
bi
i , they are not generally parallel to each
and f n
ci are normal to s
other. By substitution of f ci , f bi , and aci2 from 41, 44 and 23
into 32, and through some manipulation the NE equation for the
piston results in:
n
s
i mi2 (li ci2 ) i s
i | i |22 s
i
fn
bi f ci + f bi =i s
i ) + li si + mi2 g
+2li ( i s
(45)
Equation 45 shows that separating f bi as described before is very
i , f sbi can be derived as a
useful since by dot multiplying 45 by s
function of the actuator force and the kinematic parameters of the
limb:
i + mi2 (li ci2 ) | i |22 s
i mi2
i + mi2 (
i
f sbi = i s
li s
si .g) s
(46)
i twice
Finding f n
bi is a little more involved. Cross multiply 45 by s
results into:
i s
i f n
i s
i f n
s
si i )
bi s
ci = mi2 (li ci2 ) (
i (
2mi2 li (
si i ) + mi2 s
si g)
(47)
n
Now using VTP rule, f n
ci can be found as a function of f bi :
n
fn
si i )
ci =f bi mi2 (li ci2 ) (
i (
si g)
2mi li (
si i ) + mi s
2
(48)
(51)
(53)
2775
Ti x i ; li s
i = s
i s
Ti x i
li = s
1
1
i x i ; | i |22 s
i = 2 s
i x Ti s
2i x i
i = s
li
li
(54)
Ti x
i ;
i li ( i i ) s
i = s
i s
Ti x
i
li li i . i = s
li s
(55)
1
i x
i ; i =
i x
i 2li i
li i + 2li i = s
s
li
Relations 54 and 55 are the main framework in order to derive
explicit dynamic equations from implicit formulations. By substitution of the kinematic parameters into dynamic equations 46 and
50 and using equations 54 and 55, and performing some simple
mathematical simplifications, f sbi and f n
bi can be converted to the
following form:
mi2 ci2
i s
Ti x
i +
i = mi2 s
i s
Ti g
i x Ti s
2i x i + mi2 s
f sbi i s
s
li2
(56)
1
A
A
=
fn
[
s
I
+
I
s
i
ci1
ci2
i
bi
li2
2 2
2
i x
i
+ mi1 ci1 + mi2 (li ci2 ) s
1
Ti A I ci1 + A I ci2 s
i
+ [ 2 i s
li
2
2li
i
3 mi1 c2i1 + mi2 (li ci2 )2 mi2 li (li ci2 ) s
li
i
i x i
+
si A I ci1 + A I ci2 s
1
2i g
[mi1 ci1 + mi2 (li ci2 )] s
li
(64)
X
ET
bi f Bi
Note that E T has been multiplied to both side of equation 64 to
harmonize these equations to that derived from Lagrange approach.
Equation 64 together with 25 can be rewritten in a complete explicit
form given in 62, whose terms are given as follows,
mmp I 33
033
M mp =
(65)
033
E T I mp E 66
#
"
033
033
(66)
C mp =
+ ET E
033 E T I mp E
I mp E
66
mmp g
(67)
Gmp =
031
61
P
f bi
F mp =
(68)
T P
bi f bi 61
E
in which, I 33 is a 3 3 Identity matrix.
(57)
Note that in deriving dynamic equations for the piston it is assumed
that f bi is acting upon the piston, and therefore, first negate 56
i and x i to
and 57 and then add them together. Then factor x
yield to a single equation for the dynamics of the limb i, based
on intermediate generalized coordinate xi . Factor this equation
according to 51 leads to:
1
i A I ci1 + A I ci2 s
i
Mi = 2 s
li
(58)
2
i + mi2 s
i s
Ti
+ mi1 c2i1 + mi2 (li ci2 )2 s
Ci =
mi2 ci2
1
i x Ti s
2i 2 i s
Ti A I ci1 + A I ci2 s
i
s
2
li
li
2li
+ 3 mi1 c2i1 + mi2 (li ci2 )2 mi2 li (li ci2 ) s2i
li
+
si A I ci1 + A I ci2 si
i s
Ti +
mi2 s
I 33
bi E
1
2i g (60)
(mi1 ci1 + mi2 (li ci2 )) s
li
J i = 033 ( bi ) E + bi E
h
i
= 033 bi E + bi E + bi E
i
F i = f bi + i s
(59)
Gi =
(61)
(71)
i + C li x i + Gli = F li
M li x
(72)
M li = J Ti M i J i
C li = J Ti M i J i + J Ti C i J i
(74)
in which,
+ C mp X + Gmp = F mp
M mp X
(70)
Gli = J Ti Gi
(75)
J Ti F i
(76)
F li =
2776
(73)
(77)
in which,
f i =
i
i s
i
i E T bi s
(78)
i=6
X
i=1
i=6
X
i=1
i=6
X
i=1
i=6
X
M li + M mp
(79)
C li + C mp
(80)
Gli + Gmp
(81)
f i
(82)
i=1
These equations completely define the detail terms of the equations of motion of SGP given in 1 in an explicit form. Moreover,
these terms consists of kinematic structures of the limbs and the
moving platform in a matrix form, and therefore, they are very
compact and tractable. It is worth mentioning that these equations
can be systematically derived without use of any symbolic manipulation software.
V. V ERIFICATION
In order to verify the obtained equations of motions for SGP,
M i is derived by means of Lagrange method, and the results are
compared. Let x i denote a generalized coordinate and T i denote
the kinetic energy of the limb, M i can be found from,
1
x i M i (xi ) x i
(83)
2
Furthermore, the kinetic energy of the limb is:
1
1
Ti = v Tci1 mi1 v ci1 + Ti A I ci1 + A I ci2 i
2
2
(84)
1
+ v Tci2 mi2 v ci2
2
By means of relations given in 54, , v ci1 and v ci2 can be
transformed to:
Ti =
ci1 2
1
i x i ; v ci1 =
i x i
s
s
li
li
(li ci2 ) 2
T
=
si + si si x i
li
i =
v ci2
(85)
(86)
Now, substitute , v ci1 and v ci2 from 85 into 84 and use equations
86, to simplify:
1
Ti = x Ti
2
+
1
i A I ci1 + A I ci2 s
i
s
2
li
mi1 c2i1
2
!
(87)
2
T
si +mi2 si si xi
2777