Professional Documents
Culture Documents
Determination of The Parallel Manipulators Orientation Workspace of
Determination of The Parallel Manipulators Orientation Workspace of
143
© 1995 Kluwer Academic Publishers. Printed in the Netherlands.
Abstract. An important step during the design of a parallel manipulators is the determination
of its workspace. For a 6-d.o.f. parallel manipulator workspace limitations are due to the
bounded range of their linear actuators, mechanical limits on their passive joints and links
interference. The computation of the workspace of a parallel manipulator is far more complex
than for a serial link manipulator as its translation ability is dependent upon the orientation
of the end-effector.
We present in this paper an algorithm enabling to compute the possible rotation of the end-
effector around a fixed point. This algorithm enables to take into account all the constraints
limiting the workspace. Various examples are presented.
1. Introduction
1.1. THE MECHANICAL STRUCTURE OF A PARALLEL MANIPULATOR
z~ I Ujoint
2. Notation
We define first two frames, one fixed (reference frame) and the other one attached
to the end-effector (relative frame).
The following symbols and variables will be used in this paper:
• A i , center of the passive joint of link i attached to the base of the robot.
® /?i, center of the passive joint of link i attached to the end effector.
• O, origin of the reference frame.
• z, y, z, axes of the reference frame.
® C, origin of the relative frame.
• Zr, Yr, Zr, axes of the relative frame. The zr axis is directed along the
normal to the mobile plate.
• V), 0, qS, Euler's angles defining the orientation of the end-effector.
• pi, length of link i.
If there is no ambiguity the subscripts will be omitted. A superscript r will be
used for vectors whose coordinates are expressed in the relative frame.
In the planar case Pennock [15] and Williams [21] have addressed this problem
especially to find the maximal workspace i.e. the set of positions of the end-
effector which can be reached with at least one orientation. But their methods
can not be extended for 6-d.o.f. robot.
3. Orientation Workspace
3.1. INTRODUCTION
In this paper we will assume that the center C of the relative frame is fixed in
the reference frame and we will try to determine what are the allowed rotations
of the end-effector around this point.
Representing the orientation of a rigid body is somewhat difficult. Plotting the
three angles defining this orientation (for example the three Euler's angles) does
not lead to a very understandable representation. Therefore we will introduce
another form of representation.
We consider a unit link N = CNe attached to the end-effector at point C. As
the end-effector rotates around C the extremity Ne of the link moves on the
unit sphere centered at C. If the end-effector can rotate freely, point N~ will
describe the whole unit sphere. If there are some restrictions on the rotation of
the end-effector, point Ne will describe only some regions on the unit sphere.
Therefore, if we are able to compute the border of the regions described by N~
during the possible rotations of the end-effector we will have characterized the
possible rotations with the exception of the rotations around the unit link. Hence
such a representation enables to describe two rotational degrees of freedom of
the robot. By choosing carefully the direction of the unit link we will be able to
represent all the possible rotations of the end-effector.
We will assume that we rotate first the end-effector around a fixed vector X1
with an angle 01. We then investigate the possible rotation of the end-effector
around a given vector X2 in the refence frame. During this rotation the extremity
Ne of N describes a circle C~ on the unit sphere in a plane perpendicular to X2
(Figure 2). The constraints on the manipulator imply that Ne may lie only on
some parts of the circle Ce. The purpose of our algorithm is to determine these
allowed parts. By computing these allowed parts for various values of 01 the
set of circles C~ will span approximatively the unit sphere and we will get the
possible regions for Ne on the sphere and therefore the orientation workspace of
the robot.
Zr
~ Y zr Ce
Fig. 2. Example of end-effector rotation. Here the unit link attached to the end-effector
at C directed along zr. The end-effector has been rotated around the axis x with an angle
01 (X1 = [1, 0, 0]). In this configuration when the end-effector rotates around the axis z (X2 --
[0, 0, 1]) point Ne describes a circle on the unit sphere (the ellipsis in dashed line).
Sc 1
Fig. 3. For any rotation around C, point B1 lies on the sphere Scl centered in C with radius
I]CB1N. This point must also lie inside the volume defined by the spheres S~1,Sil centered
in A1 with radii p l i n , plma x.
spheres S~i, Sii centered in Ai with radii Pmin,
i Pmax, the minimum and m a x i m u m
value of the leg length (Figure 3). Consequently the allowed zone ZB~ for Bi
on Sc~ is limited by the two circles Ce~,Ci~ which are the intersection circles of
the sphere Sc~ with the spheres Sei, Si~. For a given rotation angle of the end-
148 J.-R MERLET
CB i
CB i
Fig. 4. For given rotation angle of the end-effector around X1 point Bi describes a circle
CB~ (dashed line) when the end-effector rotates around X2. If CB~ lies inside the zone
defined by the two circles C~, Ci~ (thin dashed line) Bi can lie on the whole circle (1). At
the opposite, if CB~ is completely outside the zone no rotation is allowed (2). If CB~ has
intersection points with Ce~,Ci~ only some parts of CB~ are allowed for Bi (drawn as thick
line on the right).
Let CN~ be the relative coordinates of Ne and CB~ the relative coordinates of
B~. We may thus write:
= - ReCB (2)
Equation (3) enables to compute N (and therefore the location of Are) for a given
location of Bi. Consequently, we can calculate the position of the extremities
of the arc ,,4} corresponding to the extremities of the arc Aj.
i This enables to
compute the arcs of circle for Are on C N for which the constraints on the length
of link i are satisfied.
Ra R
Fig. 5. In thin lines, the allowable zones for a unit link directed along the zr axis of the
mobile plate when the mobile plate rotates around the z axis after being first rotated around
the z axis. On the left the angle of rotation around x is in the range [0,Tr] and on the right in
the range [Tr,27r]. The constraints limiting the rotation are the link lengths.
n3
nl
AI IP Yr
;rr
I I I II
XX x
Fig. 7. Modellation of the constraint on the joint at B: if the mechanical limits on the
joint are satisfied, the point A 1 lies inside a pyramid (left). From this pyramid we deduce
equivalent pyramid P'I centered at A I such that if the mechanical limits on the joint are
satisfied then point B1 lies inside P/1 (right).
the constraint on the joint at Bi are satisfied then point Ai lie inside the pyramid
(Figure 7, left). From this pyramid we deduce an equivalent pyramid P" to Pi,
whose center is Ai, such that if Ai lie inside Pi then Bi lie inside P~ (Figure 7,
right).
We consider the intersection points of the circle CB~ described by Bi with
the faces of the pyramid describing the constraints on the joint at Ai. These
intersection points, if any, define arcs of circle on CB~ such that for any position
of Be on the arc either the link AiBi is fully inside the pyramid (the constraints
on the joint are therefore satisfied) or some part of the link lies outside the
pyramid. For each of these arcs we take an arbitrary point on the arc (usually
the middle point of the arc) and test if the link is inside the pyramid for this
pyramid
Fig. 8. The intersection points of the circles CB~ and the pyramid (dotted points) enable to
compute the arcs (in dashed line) of the CB~'s, such that the passive joints constraints are
satisfied.
152 J.-E MERLET
position of t3i. If this is true then the arc is an allowable region for Bi from the
view point of the constraints of the joint (Figure 8). A similar algorithm is used
with the equivalent pyramid to find the allowable region for Bi from the view
point on the constraints of the joint at Bi.
From the allowable regions for Bi we deduce in a similar manner as for the
link lengths constraints the allowable regions AJ&B~ for N~ on C N due to the
constraints on the joints.
At this points we have computed a set ¢4{' of arcs on C N for which the
link lengths constraints are satisfied a set ..'AJA~B~of arcs on C N such that the
constraints on the joints at Ai, Bi are satisfied. The intersection of each arc in
the set ¢4{ with the set AJA~B~ defines the arcs on which all the constraints are
satisfied (Figure 9).
An important factor limiting the rotation of the mobile plate is clearly the links
interference.
We define the distance between two links as the minimal distance between any
pair of points on the links. It has been shown in [14] that the distance between
link i, j , is the m i n i m u m of the following quantities:
• the distance between the lines associated to the links if their common
perpendicular has a point on each link;
• the distance between a point B and its projection B p on the other link if
t3 p belongs to the link;
• the distance between a point A and its projection A p on the other link if
A p belongs to the link;
Range of rotation:0.00, 180.00 Range of rotation:IS0.00,360.00
Fig. 9. For the manipulator described in the Appendix we have determined the allowable
region for for the extremity of an unit link directed along the z,. axis of the mobile plate when
the mobile plate rotates around the z axis after being rotated around the z axis. On the left
the angle of rotation around x is in the range [0, rr] and on the right in the range [Tr,27r]. The
constraints limiting the rotation are the link lengths and the constraints on the base joints.
ORIENTATION WORKSPACE OF PARALLEL MANIPULATORS [ 53
• the distance between the points of one of the two pairs of points (Ai, Bj).
with Pi E Ai Bi PjcAj j
with PJA~ E AjBj
ct (B Bj) = + rj
(4)
with piAj E AiBi
with PBi E AjBj
with piuj E A~Bi d (Ai, Aj) = ri + rj
All the relations defined by (4) have the same form and can be written as:
where the ai coefficients are dependent only from the relation and the geometry
of the robot. This kind of equation leads at most to two solutions in 02, i.e. two
B2
bB2 O1
DAz B~
A2 A2
AI
AI
Fig. 11. At some points on CB~ the distance between link i and another link j is equal to
ri + rj (dotted points).
locations for the point Bi on the circle CBi such that the distance between link
i and link j is equal to d.
For the analysis of the possible positions of the point Bi on the circle CBi
with respect to links interference, we will compute the set of points on CB~ such
that the distance between links i, j is equal to d = ri + rj. This set is determined
through Equations (5) and an example is shown in Figure 11. Therefore on the
circle CB~ we get various set of critical points:
This set of critical points defines various arcs on CB~. We consider each of
these arcs of circle and test if the whole set of constraints is satisfied for one
specific point of the arc (usually the middle point). If this test is tree then the
arc is an allowable regions for Bi. From the set of allowable regions for Bi, we
deduce a set of allowable regions .Aft~ for N~ for which the constraints on link
i are satisfied. Then the intersection of the six ~A/N~defines the allowable region
for Are on C N.
Figures 12 and 13 show for example the possible regions for a unit link directed
along the y axis when the mobile plates rotates around the x, z axis: this illustrate
the possible rotation of the end-effector around the z axis. Clearly, a full rotation
around this axis is not possible as links interference will occur. It may be seen that
if links interference is not considered some of the circles C N can be completely
described by Are: the leg lengths ranges and mechanical limits on the passive
joints enable theoretically a full rotation. But as soon as links interference is taken
into account the same circles are split is smaller components: links interferences
have been detected.
ORIENTATION WORKSPACE OF PARALLEL MANIPULATORS 155
R R
Fig. 12. In thin line the allowable zones for a unit link directed along the -y~ axis of the
mobile plate when the mobile plate rotates around the z axis after being first rotated around
the x axis with a rotation angle in the range [~r/2 - 3rc/2]. On the left, the constraints are
only the link lengths and on the right, links interference have been taken into account.
R Range of rotation:270.00,450.00
~ ~-.
Fig. 13. In thin line, the allowable zones for a unit link directed along the - g r axis of the
mobile plate when the mobile plate rotates around the z axis after being first rotated around
the x axis with a rotation angle in the range [3~r/2 - 7r/2]. On the left, the constraints are
only the link lengths and on the right links interference have been taken into account.
4. Conclusion
limiting the orientation workspace: links lengths range, mechanical limits on the
passive joints, links interference. As this method is purely geometrical it imply
few calculations: consequently this leads to a very fast and efficient algorithm.
We plan extend this algorithm for computing the maximal workspace of parallel
manipulator.
ink 1 2 3 4 5 6
Fig. 14. Position of the base and mobile joints centers and minimum and maximum links
lengths (in mm).
ORIENTATION WORKSPACE OF PARALLEL MANIPULATORS 157
R R
R R
R R
Fig. 15. Representation of the possible regions for the extremity of a unit link directed
along the z r axis of the mobile plate when the mobile plate rotates around the z axis after
being first rotated around the z axis. The constraints are only the link lengths.
15 8 J.-R MERLET
P, p
R I
R It )
Fig. 16. Representation of the possible regions for the extremity of a unit link directed
along the zr axis of the mobile plate when the mobile plate rotates around the z axis after
being rotated around the z axis. The constraints are the link lengths and the constraints on
the base joints.
ORIENTATION WORKSPACE OF PARALLEL MANIPULATORS t59
H R
Fig. 17. Representation of the possible regions for the extremity of a unit link directed
along the zr axis of the mobile plate when the mobile plate rotates around the z axis after
being first rotated around the x axis. The constraints are the link lengths, the constraints on
the base joints and links interfere.
160 J.-P. MERLET
References
1. Agrawal, S. K.: Workspace boundaries of in-parallel manipulator systems, in ICAR,
Pise, June 19-22, 1991, pp. 1147-1152.
2. Arai, T., Cleary, K., and others: Design, analysis and construction of a prototype parallel
link manipulator, in IEEE Int. Workshop on Intelligent Robots and Systems, Ibaraki,
Japan, July 3-6, 1990, Vol. 1, pp. 205-212.
3. Bricard, R.: Mdmoire su la th6orie de l'octa~dre articul6, J. Math. Pures et Appliqudes,
LiouvilIe 3 (1897), 113-148.
4. Cleary, K. and Arai, T.: A prototype parallel manipulator: Kinematics construction,
software, workspace results and singularity analysis, in IEEE Int. Conf. on Robotics
and Automation, Sacramento, April 11-14, 1991, pp. 566-571.
5. Fichter, E. E: A Stewart platform based manipulator: General theory and practical
construction, Int. J. Robotics Res. 5 (1986), 157-181.
6. Gosselin, C.: Determination of the workspace of 6-dof parallel manipulators, in ASME
Design Automation Conf., Montrtal, September 17-20, 1989, pp. 321-326.
7. Gough, V. E.: Contribution to discusion of papers on research in automobile stability,
control and tyre performance, 1956-1957, Proc. Auto. Div. Inst. Mech. Eng.
8. Jo, D. Y. and Haug, E. J.: Workspace analysis of closed loop mechanisms with unilateral
constraints, in ASME Design Automation Conf., Montrtal, September 17-20, 1989,
pp. 53-60.
9. Landsberger, E. E. and Shanmugasundram, A. P.: Workspace of parallel link crane, in
IMACS/SICE Int. Symp. on Robotics, Mechatronics, and Manufacturing Systems, Kobe,
September 16-20, 1992, pp. 479--486.
10. Lee, K.-M. and Shah, D. K.: Kinematic analysis of a three-degrees-of-freedom in-
parallel actuated manipulator, IEEE of Robotics and Automation 4(3) (1988), 354-360.
11. Mac Callion, H. and Pham, D. T.: The analysis of a six degrees of freedom work
station for mechanized assembly, in Proc. 5th World Congress on Theory of Machines
and Mechanisms, Montrtal, July 1979, pp. 611-616.
12. Merlet, J.-P.: Parallel manipulators, Part 1. Research Report 646, INRIA, March 1987.
13. Merlet, J.-P.: Les Robots Parallkles, Hermes, Paris, 1990.
14. Merlet, J.-P.: Geometrical determination of the workspace of a constrained parallel
manipulator, in ARK, Ferrare, September 7-9, 1992, pp. 326-329.
15. Pennock, G. R. and Kassner, D. J.: The workspace of a general geometry planar three
degree of freedom platform manipulator, in ASME Design Automation Conf., Miami,
September 22-25, 1991, pp. 537-544.
16. Pierrot, F.: Robots Pleinement ParalIkles IAgers: Conception Moddlisation et Comande,
PhD Thesis, Universit6 Montpellier II, Montpellier, April 24, 1991.
17. Pooran, F. J.: Dynamics and Control of Robot Manipulators with Closed-kinematic
Chain Mechanism, PhD Thesis, The Catholic University of America, Washington, DC,
1980.
18. Reboulet, C. and Pigeyre, R.: Hybrid control of a 6 d.o.f, in parallel actuated mi-
cromacro manipulator mounted on a Scara robot, in 3rd ISRAM, Buruaby, July 18-20,
1990, Vol. 3, pp. 293-298, ASME Press Series.
19. Steward, D.: A platform with 6 degrees of freedom, Proc. Inst. of Mechanical Engineers
180(Part 1, 15) (1965-1966), 371-386.
20. Weng, T. C.: Kinematics of Parallel Manipulators with Ground-mounted Actuators,
PhD Thesis, University of Florida, Gainesville, 1988.
21. Williams II, R. L. and Reinholtz, C. E: Closed-form workspace determination and
optimization for parallel robot mechanisms, in ASME Proc. 20th Biennal Mechanisms
Conf., Kissimmee, Orlando, September 25-27, 1988, pp. 341-351.