Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Department of Mechanical and Manufacturing Engineering, Aalborg University, 9220 Aalborg, Denmark.
E-mail: gwu@m-tech.aau.dk
Abstract
This paper deals with the kinematic synthesis problem of a 3-RRR spherical parallel manipulator, based
on the evaluation criteria of the kinematic, kinetostatic and dynamic performances of the manipulator. A
multiobjective optimization problem is formulated to optimize the structural and geometric parameters
of the spherical parallel manipulator. The proposed approach is illustrated with the optimum design of
a special spherical parallel manipulator with unlimited rolling motion. The corresponding optimization
problem aims to maximize the kinematic and dynamic dexterities over its regular shaped workspace.
Keywords: Spherical parallel manipulator, multiobjective optimization, Cartesian stiffness matrix, dexterity, Generalized Inertia Ellipsoid
1 Introduction
A three Degrees of Freedom (3-DOF) spherical parallel manipulator (SPM) is generally composed of two
pyramid-shaped platforms, namely, a mobile platform
(MP) and a fixed base that are connected together by
three identical legs, each one consisting of two curved
links and three revolute joints. The axes of all joints
intersect at a common point, namely, the center of rotation. Such a spherical parallel manipulator provides
a three degrees of freedom rotational motion. Most
of the SPMs find their applications as orienting devices, such as camera orienting and medical instrument
alignment (Gosselin and Hamel, 1994; Li and Payandeh, 2002; Cavallo and Michelini, 2004; Chaker et al.,
2012). Besides, they can also be used to develop active spherical manipulators, i.e., wrist joint (Asada and
Granito, 1985).
In designing parallel manipulators, a fundamental
problem is that their performance heavily depends on
their geometry (Hay and Snyman, 2004) and the mu-
doi:10.4173/2012.3.3
(a)
(b)
Figure 1: 3-RRR unlimited-roll SPM: (a) CAD model, (b) application as spherically actuated joint.
the design space. It is known from (Gosselin and Angeles, 1989) that the orientation workspace of a SPM
is a maximum when the geometric angles of the links
are equal to 90o . However, maximizing the workspace
may lead to a poor design with regard to the manipulator dexterity and manipulability (Stamper et al.,
1997; Durand and Reboulet, 1997). This problem can
be solved by properly defining the constraints on dexterity (Merlet, 2006a; Huang et al., 2003). For the
optimum design of SPMs, a number of works focusing on the kinematic performance, mainly the dexterity and workspace, have been reported, whereas, the
kinetostatic/dynamic aspects receive relatively less attention. In general, the design process simultaneously
deals with the two previously mentioned groups, both
of which include a number of performance measures
that essentially vary throughout the workspace. On the
kinetostatic aspect, the SPM stiffness is an important
consideration (Liu et al., 2000) to characterize its elastostatic performance. When they are used to develop
spherically actuated joint, not only the MP angular
displacement but also the translational displacement of
the rotation center should be evaluated from the Cartesian stiffness matrix of the manipulator and should be
minimized. Moreover, the dynamic performance of the
manipulator should be as high as possible.
Among the evaluation criteria for optimum geometric parameters design, an efficient approach is to solve
a multiobjective optimization problem, which takes all
or most of the evaluation criteria into account. As the
objective functions are usually conflicting, no single solution can be achieved in this process. The solutions
112
(a)
(b)
Figure 2: Architecture of a general SPM: (a) overview, (b) parameterization of the ith leg.
sign optimization problem is illustrated with a 3-RRR
SPM shown in Figure 1, which can replace the serial
chains based wrist mechanisms. The non-dominated
solutions, also called Pareto-optimal solutions, of the
multiobjective optimization problem are obtained with
a genetic algorithm.
cs
ss
c
(1)
113
i
i + i $
i + i $
i
$O =
= i $
(12)
A
B
C
p
Let denote the angular velocity of the mobileplatform, the screws velocity equation via the ith leg
T
where p = [x, y, z] is linear displacement of
can be stated as
T
the rotation center and = [x , y , z ] is
i + i $
i + i $
i
$ =
= i $
(6) the MP orientation error. Note that this equation only
A
B
C
0
includes the joint variations, while for the real manipulator, link deflections should be considered as well.
with the screws for the revolute joints at points Ai , Bi
The screws associated with the link deflections are
and Ci expressed as
formulated as follows:
ui i
wi i
v
ri
ni
i
i =
i = $
i , $
i =
$A =
, $B =
, $C = i
$
,
$
(13)
u1
u2
C
u3
0
0
0
riC ri
riC ni
i = 0 , $
i = 0 , $
i = 0
Since the axes of the two passive revolute joints in each
$
u4
u5
u6
r
v
ni
i
i
leg lie in the plane Bi OCi , the following screw is reciprocal to all the revolute joint screws of the ith leg and where n = w v is the normal vectors of plane
i
i
i
does not lie in its constraint wrench system:
Bi OCi , ri = wi ni , and riC is the position vector of
point Ci from O. The directions of the vectors ri and
0
i =
$
(7)
ni are identical to ui4 and ui6 , respectively.
r
wi vi
By considering the link deflections ui1 ...ui6 and
variations
in passive joint angles and adding all the
Applying the orthogonal product () (Tsai, 1998) to
deflection
freedoms
to Eqn. (12), the mobile platform
both sides of Eqn. (6) yields
deflection in the ith leg is stated as
i $ = (wi vi )T = (ui wi ) vi i
$
(8)
r
i i
i + i $
i + i $
i + ui $
i
$iO =i $
A
B
C
1 u1 + u2 $u2
i i
i i
As a consequence, the expression mapping from the
i + ui $
i
+ ui3 $
u3
4 u4 + u5 $u5 + u6 $u6 (14)
mobile platform twist to the input angular velocities is
stated as:
The previous equation can be written in a compact
A = B
(9) form by separating the terms related to the variations
114
Ji fi = i , Jiq fi = 0, ui = Ki i
(a)
(18)
C11 C12
0
0
0
C16
bile platform, (b) link deflections and joint
C12 C22
0
0
0
C26
variations in the ith leg.
1
0
0
C
C
C
0
33
34
35
i
(21)
KL =
0
C34 C44 C45
0
0
0
in the passive revolute joint angles and those related
0
C35 C45 C55
0
to the actuator and link deflections, namely,
C16 C26
0
0
0
C66
(15) where the corresponding elements are given in Appendix A.
The matrix Ji of size 6 7 is the Jacobian matrix
with
related to the virtual springs and Jiq of 6 2, the one
i
h
i
i
i
i
i
i
i
i
J = $A $u1 $u2 $u3 $u4 $u5 $u6 (16a) related to revolute joints in the ith leg. The Carteh
i
sian stiffness matrix Ki of the ith leg is obtained from
i $
i
Jiq = $
(16b) Eqn. (19),
B
C
T
fi = Ki $iO
(22)
ui = i ui1 ui2 ui3 ui4 ui5 ui6 (16c)
where Ki is a 66 sub-matrix, which is extracted from
T
qi = i i
(16d) the inverse of the 8 8 matrix on the left-hand side of
P3
Eqn. (19). From f = i=1 fi , $O = $iO and f = K$O ,
Let the external wrench applied to the end of the ith the Cartesian stiffness matrix K of the system is found
leg be denoted by fi , the constitutive law of the ith leg by simple addition, namely,
can be expressed as
3
X
K
=
Ki
(23)
Krr Krt
fi =
fi = Ki $iO
(17)
T
i=1
Krt Ktt i p
$iO = Ji ui + Jiq qi
115
1
1
mp vpT vp + T Ip
2
2
(24)
with
vp = R cos p , Ip = diag [Ixx Iyy Izz ] (25)
where mp is the mass of the mobile-platform and Figure 4: The representation of the regular workspace
Ixx , Iyy , Izz are the mass moments of inertia of the
for the SPM with a pointing cone.
mobile-platform about x-, y-, z-axes, respectively.
The kinetic energy of the curved links is
Tl =
1
2
3
X
T
ml vli vli + Il i2
i=1
with
1
R i wi ui + vi
2
1
sin 2 cos 2
2
Il = ml R 1
2
2
(ui vi )
i =
= ji
(ui wi ) vi
vli =
13
s
g
l
1
(26)
s
g
4
+ JT Ip + mp R2 cos2 [p]T [p]
(27a)
(27b)
(27c)
where ml is the link mass and Il is its mass moment of inertia about wi .
The kinetic energy of the slide units is
3
3
X
X
1
2
T
T
[vi ] [vi ] + Il
ji ji J (30)
+ ml R
4
i=1
i=1
where [] stands for the skew-symmetric matrix whose
elements are from the corresponding vector and 13 is
the Identity matrix.
116
1
Ig n2g + ms Rs2 T
2
max
(34)
(37)
117
the curved link and the maximum positional deflection of the rotation center and angular deflection of
the moving-platform subject to a given wrench applied
i
on the latter. The control loop stiffness is Kact
=
6
10 Nm/rad. Let the static wrench capability be specified as the eight possible combinations of moments
m = [10, 10, 10] Nm, while the allowable maximum positional and rotational errors for the workspace
points are 1 mm and 2o = 0.0349 rad, respectively,
thus, the accuracy constraints can be written as:
Figure 6: Slide unit configuration of the 3-DOF SPM.
and make the mechanism compact, the following constraints should be satisfied:
12 , 23 , 31 = 10o
R0 = 0.120 m R sin 1 Rs = 0.200 m
p
x2n + yn2 + zn2 p
(41)
q
kkn = 2x, n + 2y, n + 2z, n r
kpkn =
where the linear and angular displacements are com(38) puted from $ = K1 f with the Cartesian stiffness
O
matrix (23) and p = 1 mm, r = 0.0349 rad.
(39) Mathematically, the multi-objective design optimization problem for the spherical parallel manipulator can
where A is the forward Jacobian matrix of the manip- be formulated as:
ulator defined in Eqn. (9) and > 0 is a previously
specified tolerance set to 0.001.
maximize f1 (x) = GCI
(42)
det(A) , bi = (ui wi ) vi
maximize
over
subject to
Maximizing the GCI and constraining the kinematic Jacobian matrix cannot prevent the prescribed
workspace away from ill-conditioned configurations.
For the design optimization in order to achieve a dexterous workspace, the minimum of the inverse condition number of the kinematic Jacobian matrix 1 (J),
based on 2-norm, should be higher than a prescribed
value throughout the workspace, say 0.1, namely,
min(1 (J)) 0.1
4.3.3 Accuracy constraints
(40)
f2 (x) = GDI
x = [1 , 2 , , a, R]
g1 : 45o
g2 : R0 R sin 1 Rs
g3 : 12 , 23 , 31 = 10o
g4 : det(A) , (ui wi ) vi
g5 : min(1 (J)) 0.1
p
g6 : x2n + yn2 + zn2 p
q
g7 : 2x, n + 2y, n + 2z, n r
xlb x xub
i = 1, 2, 3
The accuracy constraints of the optimization prob- where xlb and xub , respectively, are the lower and uplem for the SPM are related to the dimensions of per bounds of the variables x given by Table 1.
118
Population
size
40
Design
ID
I
II
III
Distribution
index
20
solutions
R [m]
0.1445
0.1533
0.1641
Objectives
GCI GDI
0.366 0.711
0.453 0.665
0.536 0.625
Dynamic dexterity
3 3
2
2
2
0.64
mp =
hR sin , ml = a R2
(43)
4
0.63
where is the mass density and h = 0.006 m is the
ID III
0.62
thickness of the moving platform. The total mass ms
0.35
0.4
0.45
0.5
0.55
Kinematic dexterity
of each slide unit, including the mass of the actuator,
gearhead, pinion and the manufactured components, is
equal to ms = 2.1 kg.
Figure 7: The Pareto front of the multiobjective optiThe previous formulated optimization problem (42)
mization problem for the SPM.
is solved by the genetic algorithm NSGA-II (Deb et al.,
2002) with Matlab, of which the algorithm parameters
strongly dependent as their correlation coefficient
are given in Table 2.
is equal to 0.975;
The Pareto front of the formulated optimization
problem for the SPM is shown in Figure 7 and three
both objectives functions GCI and GDI are
optimal solutions, i.e., two extreme and one intermedistrongly dependent on all design variables as all
ate, are listed in Table 3.
of the corresponding correlation coefficients are
Figure 8 illustrates the variational trends as well as
greater than 0.6;
the inter-dependency between the objective functions
and design variables by means of a scatter matrix. The
GCI is slightly more dependent than GDI of the
lower triangular part of the matrix represents the cordesign variables as all the corresponding correlarelation coefficients whereas the upper one shows the
tion coefficients of former are greater than those
corresponding scatter plots. The diagonal elements
of latter;
represent the probability density charts of each variable. The correlation coefficients vary from 1 to 1.
GDI is less dependent on the design variables
Two variables are strongly dependent when their corand a than the other variables although the two
relation coefficient is close to 1 or 1 and independent
former variables influence the SPM mass, this is
when the latter is null. Figure 8 shows:
due to the large portion of the slide unit mass in
the total mechanism mass.
both objectives functions GCI and GDI are
119
Figure 8: Scatter matrix for the objective functions and the design variables.
Variables [deg]
100
1
2
80
60
40
0.35
0.4
0.45
Kinematic dexterity GCI
0.5
0.55
Variables [deg]
100
1
2
80
60
40
0.62
0.63
0.64
0.65
0.66
0.67
0.68
Dynamic dexterity GDI
0.69
0.7
0.71
0.72
Variables [m]
0.18
10*a
R
0.16
0.14
0.12
0.1
0.62
5 Conclusions
0.63
0.64
0.65
0.66
0.67
0.68
Dynamic dexterity GDI
0.69
0.7
0.71
0.72
In this paper, the geometric synthesis of spherical parallel manipulators is discussed. A multiobjective design optimization problem based on the genetic algorithm was formulated in order to determine the mechanism optimum structural and geometric parameters.
The objective functions were defined on the basis of the
criteria of both kinematic and kinetostatic/dynamic
performances. This approach is illustrated with the
optimum design of an unlimited-roll spherical parallel
manipulator, aiming at maximizing the kinematic and
dynamic dexterities to achieve relatively better kinematic and dynamic performances simultaneously. It is
found that the parameter being equal to 90o is a preferred structure for the SPM under study. Finally, the
Pareto-front was obtained to show the approximation
of the optimal solutions between the various (antagonistic) criteria, subject to the dependency of the performance. The future work will aim to maximize the
orientation workspace and optimize the cross-section
type of the curved links.
120
Asada, H. A geometrical representation of manipulator dynamics and its application to arm design.
Optimal
ASME J. Dynamic Systems, Measurement and Con- Durand, S. L. and Reboulet, C.
design
of
a
redundant
spherical
parallel
matrol, 1983. 105(3):131142. doi:10.1115/1.3140644.
nipulator.
Robotica, 1997.
15(4):399405.
Asada, H. and Granito, J. Kinematic and static
doi:10.1017/S0263574797000490.
characterization of wrist joints and their optimal design. In IEEE International Conference Gosselin, C. M. and Angeles, J. The optimum kinematic design of a spherical three-degree-of-freedom
on Robotics and Automation. pages 244250, 1985.
parallel manipulator. ASME J. Mechanisms, Transdoi:10.1109/ROBOT.1985.1087324.
missions, and Automation in Design, 1989. 111:202
Bai, S. Optimum design of spherical parallel ma207. doi:10.1115/1.3258984.
nipulator for a prescribed workspace.
Mechanism and Machine Theory, 2010. 45(2):200211. Gosselin, C. M. and Angeles, J. A global performance
index for the kinematic optimization of robotic madoi:10.1016/j.mechmachtheory.2009.06.007.
nipulators. ASME J. Mechanical Design, 1991.
113(3):220226. doi:10.1115/1.2912772.
Bai, S., Hansen, M. R., and Andersen, T. O. Modelling
of a special class of spherical parallel manipulators
with Euler parameters. Robotica, 2009. 27(2):161 Gosselin, C. M. and Hamel, J. F. The Agile Eye:
a high-performance three-degree-of-freedom camera170. doi:10.1017/S0263574708004402.
orienting device. In IEEE International Conference
on Robotics and Automation. San Diego, CA, pages
Bonev, I. A.
Direct kinematics of zero-torsion
781786, 1994. doi:10.1109/ROBOT.1994.351393.
parallel mechanisms.
In IEEE International
Conference
on
Robotics
and
Automation.
Hao, F. and Merlet, J.-P. Multi-criteria optimal design
Pasadena, California, USA, pages 38513856,
of parallel manipulators based on interval analysis.
2008. doi:10.1109/ROBOT.2008.4543802.
Mechanism and Machine Theory, 2005. 40(2):157
171. doi:10.1016/j.mechmachtheory.2004.07.002.
Bonev, I. A. and Gosselin, C. M.
Analytical determination of the workspace of symmetrical spherical parallel mechanisms. IEEE Transactions on Robotics, 2006.
22(5):10111017.
doi:10.1109/TRO.2006.878983.
Caro, S., Chablat, D., Ur-Rehman, R., and Wenger, P. Hibbeler, R. C. Mechanics of Materials. Prentice Hall,
Multiobjective design optimization of 3-PRR planar
1997.
parallel manipulators. In Global Product Development, pages 373383. Springer-Verlag Berlin Heidel- Huang, T., Gosselin, C. M., Whitehouse, D. J., and
Chetwynd, D. G. Analytic approach for optimal
berg, 2011. doi:10.1007/978-3-642-15973-2 37.
design of a type of spherical parallel manipulaCavallo, E. and Michelini, R. C. A robotic equipment
tors using dexterous performance indices. IMechE.
for the guidance of a vectored thrustor. In 35th InJ. Mechan. Eng. Sci., 2003.
217(4):447455.
ternational Symposium on Robotics. Paris, France,
doi:10.1243/095440603321509720.
2004.
Kong, K. and Gosselin, C. M. Type synthesis of
Ceccarelli, M., Carbone, G., and Ottaviano, E. Multi
three-degree-of-freedom spherical parallel manipulacriteria optimum design of manipulators. In Bulletin
tors. Inter. J. Robotics Research, 2004. 23(3):237
of the Polish Academy of Technical Sciences, 2005.
245. doi:10.1177/0278364904041562.
53(1):918.
Krefft, M. and Hesselbach, J.
Elastodynamic
Chaker, A., Mlika, A., Laribi, M. A., Romdhane,
optimization of parallel kinematics.
In ProL., and Zeghloul, S. Synthesis of spherical paralceedings of the IEEE International Conference
lel manipulator for dexterous medical task. Fronon Automation Science and Engineering. Edtiers of Mechanical Engineering, 2012. 7(2):150162.
monton, AB, Canada, pages 357362, 2005.
doi:10.1007/s11465-012-0325-4.
doi:10.1109/COASE.2005.1506795.
121
(A-1b)
nism and Machine Theory, 2000. 35(9):12571267.
2
GIx
EIy
doi:10.1016/S0094-114X(99)00072-5.
s2
s7
R2
(A-1c)
C16 =
2
EIy
GIx
Lou, Y., Liu, G., Chen, N., and Li, Z. Optimal
R
s2
s1
design of parallel manipulators for maximum efC22 =
+
(A-1d)
2 GIx
EIy
fective regular workspace. In Proceedings of the
IEEE/RSJ International Conference on Intelligent
R2
s4
s2
C
=
(A-1e)
26
Robots and Systems. Alberta, pages 795800, 2005.
2
GIx
EIy
doi:10.1109/IROS.2005.1545144.
R2
C33 =
(A-1f)
EIz
Maxon. Maxon Motor and Gearhead products catalog.
s5 R2
2012. URL http://www.maxonmotor.com/maxon/
(A-1g)
C34 =
view/catalog/.
EIz
s6 R2
C35 =
(A-1h)
Merlet, J.-P.
Jacobian, manipulability, condition
EIz
number, and accuracy of parallel robots. ASME
s2 s3 R3
R s1
J. Mechanical Design, 2006a.
128(1):199206.
+
+
(A-1i)
C44 =
2A E
G
2EIz
doi:10.1115/1.2121740.
s8 R 1
1
s4 R3
C45 =
(A-1j)
+
Merlet, J.-P. Parallel Robots. Kluwer, Norwell, 2006b.
2A E
G
2EIz
R s1
s2 s2 R3
Pashkevich, A., Chablat, D., and Wenger, P. Stiffness
C55 =
+
+
(A-1k)
2A G
E
2EIz
analysis of overconstrained parallel manipulators.
R3
R2
s3
s2
Mechanism and Machine Theory, 2009. 44(5):966
+
C66 =
+
(A-1l)
982. doi:10.1016/j.mechmachtheory.2008.05.017.
GA
2
GIx
EIy
Stamper, R. E., Tsai, L.-W., and Walsh, G. C. Op- with
timization of a three-dof translational platform for
s1 = 2 + sin 2 cos 2
(A-2a)
well-conditioned workspace. In Proceedings of the
IEEE International Conference on Robotics and Aus2 = 2 sin 2 cos 2
(A-2b)
tomation. Albuquerque, NM, pages 32503255, 1997.
s3 = 32 + sin 2 cos 2 /2 4 sin 2
(A-2c)
doi:10.1109/ROBOT.1997.606784.
2
s4 = 1 cos 2 sin 2 /2
(A-2d)
Stock, M. and Miller, K. Optimal kinematic design
s5 = sin 2 2
(A-2e)
of spatial parallel manipulators: Application of lins6 = cos 2 1
(A-2f)
ear delta robot. ASME J. Mechanical Design, 2003.
s
=
2
sin
sin
cos
(A-2g)
7
2
2
2
2
125(2):292301. doi:10.1115/1.1563632.
2
s8 = sin 2
(A-2h)
Tsai, L.-W. The Jacobian analysis of parallel manipulators using reciprocal screws. In J. Lenarcic and where E is the Youngs modulus and G = E/2(1 + )
M. L. Husty, editors, Advances in Robot Kinemat- is the shear modulus with the Poissons ratio . Ix , Iy
ics: Analysis and Control, pages 327336. Kluwer and Iz are the moments of inertia, respectively. A is
the area of the cross-section.
Academic Publishers, 1998.
122