Beruflich Dokumente
Kultur Dokumente
1 Introduction simple analysis to be carried out. Since the three linear actuators
are geometrically parallel, the cross section of the workspace per-
A parallel robot is one in which there exist two or more closed
pendicular to the actuators is constant 共away from the practical
kinematic chains linking the base to the end effector. While the
limits of travel of the actuators兲, as are the Linear Delta’s proper-
majority of robots in use today are serial in nature, parallel robots ties 共such as manipulability兲 at any point in the cross section. For
exhibit many favorable characteristics, such as high speeds and most practical Linear Delta structures, the cross sectional area and
accelerations, low mobile masses, high stiffness, and superior ac- boundaries of the workspace may be found analytically. This phe-
curacy. The most notable drawback of parallel robots is their rela- nomenon is exploited to greatly simplify the process of kinematic
tively small workspaces. optimization.
The literature contains much information regarding the history In completing a kinematic optimization of the structure, four
and various types of parallel robots, e.g. 关1– 8兴. Most important dimensionless design variables are chosen such that the results are
here, however, is the development of the DELTA by Clavel at applicable to any scale of Linear Delta. The optimization is car-
the Institut de Microtechnique de l’Ecole Polytechnique Federale ried out with the goal of reaching a compromise between two
de Lausanne 关1,2,9兴. The DELTA consists of an equilateral often-conflicting design goals: manipulability and workspace size.
triangle base, with one arm 共actuated via a revolute joint兲 extend- Maximization of the workspace volume alone tends to produce
ing from each side of the base. The small, triangular traveling parallel or collinear joint axes 共resulting in the manipulator being
plate is connected to each arm via a pair of parallelogram fore- singular in all configurations兲, while considering manipulability in
arms. The result is three translational degrees of freedom, with isolation may lead to architectures with relatively small work-
one additional uncoupled rotational degree of freedom at the end spaces; a clear example of this phenomena may be found in the
effector resulting from one further motor fixed to the base and results of 关12兴. Accordingly, the utility function considered here is
connected to the end effector via a telescopic arm with two uni- a weighted sum of two performance indices.
versal joints. The first index is based on that of 关14兴, and measures the in-
The Linear Delta, Fig. 1, is an adaptation of the DELTA, which verse of the Jacobian’s condition number. This value is deter-
results from replacing the revolute actuators and upper arms mined at many points, distributed evenly across the workspace
with three geometrically parallel linear actuators or rails. Further- cross section, and a sum 共numerical integral兲 is taken. The result is
more, the fourth 共rotational兲 degree of freedom is discarded. normalized such that the index gives a measure of average ma-
The literature to date lacks any detailed treatment of the Linear nipulability over the cross section rather than a result dependent
Delta. on total cross sectional area.
The kinematics of the Linear Delta is simple, and is solved In order to overcome the limitations associated with the use of
herein via direct manipulation of the three second order geometric this index in isolation, a new performance index is proposed
constraint equations inherent in the structure. This approach is which measures space utilization, and reflects the ratio of the
known in the literature as the Polynomial Method 关4,10兴. The workspace size to the physical size of the robot’s structure. The
inverse of the 3⫻3 Jacobian matrix, and hence the Jacobian itself, size of the robot is estimated by the area of the bounding box
is determined by partial differentiation of the inverse kinematics enclosing the robot’s structure and workspace in the cross section.
equations with respect to the workspace coordinates. This index has been developed to penalize designs which are large
While there exist several methods of determining the volume and unwieldy yet produce small workspaces, such as those that
and boundaries of parallel manipulators’ workspaces 关1,11–13兴, result from optimizing manipulability alone.
the simplicity of the Linear Delta’s geometry allows a relatively
292 Õ Vol. 125, JUNE 2003 Copyright © 2003 by ASME Transactions of the ASME
⇒X 1 ⫽x⫺ 冑L 21 ⫺z 2 ⫺ 共 y⫺Y R 兲 2
共b兲 共 x⫺X 2 兲 2 ⫹ 共 y⫺Y A 兲 2 ⫹ 共 z⫺Z R 兲 2 ⫽L 22 (3)
冑
⇒X 2 ⫽x⫹ L 22 ⫺ 共 z⫺Z R 兲 2 ⫺ 共 y⫺Y A 兲 2
共c兲 共 x⫺X 3 兲 2 ⫹ 共 y⫹Y R 兲 2 ⫹z 2 ⫽L 21
⇒X 3 ⫽x⫺ 冑L 21 ⫺z 2 ⫺ 共 y⫹Y R 兲 2
Fig. 3 End view „ y - z plane… of wireframe representation show- 2.2.3 Forward Kinematics For Z R ⫽0. Solving the Forward
ing nomenclature
Kinematics of the Linear Delta involves finding the intersection
point of three spherical surfaces, illustrated in Fig. 5. The surface
of each sphere represents the range of motion of the lower end of
one of the arms when its upper end occupies a known position
exists only one solution—this corresponds to the physical situa 共determined from the geometry of the robot and the extension of
tion whereby the end effector is lying on the workspace boundary. the appropriate actuator兲. The radius of each sphere is equivalent
Fig. 4 Stick representation of the eight solutions for the inverse kinematics of
the Linear Delta
⫺F⫹ 冑F 2 ⫺4EG
冦
to the length of the corresponding arm, and the intersection
point共s兲 of the three sphere surfaces is 共are兲 the only possible when Z R ⬎0
position共s兲 that the end effector may occupy. 2E
x⫽
In the general case, there exist two intersection points. Other ⫺F⫺ 冑F 2 ⫺4EG
cases have been identified in 关15兴, including a situation where when Z R ⬍0
2E
infinite number of solutions exist when the centers of two or more
spheres coincide. For the Linear Delta, however, there exist only y⫽Ax⫹B (7)
three possibilities:
z⫽Cx⫹D⫺Z T P
1. General solution—two intersection points exist.
2. Singular solution—one sphere is tangent to the circle of in- 2.2.4 Forward Kinematics for Coplanar Actuators (ZR⫽0).
tersection of the two other spheres, resulting in one unique The solution given in Section 2.2.3 fails when Z R ⫽0, due to van-
solution. ishing denominators in 共5兲. A similar solution procedure may,
3. No solution—no intersection point exists. however, be adopted after substituting Z R ⫽0 into 共2兲. Expanding
It has been shown that solving for the intersection of three spheres and subtracting 共2a兲 from 共2c兲 yields:
may be completed in closed form 关15兴. Firstly, two of the con-
straint equations, 共2a兲 and 共2c兲, are expanded and rearranged: x⫽y 冉 2Y R
冊冉
X 3 ⫺X 1
⫹
X 3 ⫹X 1
2 冊⫽Hy⫹I (8)
y⫽x 冉 冊冉
X 3 ⫺X 1
⫹
X 21 ⫺X 23
冊 ⫽Ax⫹B (4) Similarly, expanding and subtracting 共2a兲 from 共2b兲 gives:
冉 冊冉 冊
2Y R 4Y R
Y R ⫺Y A L 22 ⫺L 21 ⫺Y A2 ⫹Y R2 ⫹X 21 ⫺X 22
A and B, used here for simplicity 共as with C, D, E, F, G, H, I, K, x⫽y ⫹ ⫽Ky⫹M
L, and M below兲, depend only on the geometry and actuator po- X 2 ⫺X 1 2 共 X 1 ⫺X 2 兲
sitions. A similar approach may be taken with constraints 共2b兲 and (9)
共2c兲. When the expression for the y coordinate given in 共4兲 is Equating 共8兲 and 共9兲 yield x and y. Substitution into 共2a兲 yields the
substituted into these equations, the result is an expression relating z coordinate:
x and z, of the form:
冉 冊冉 冊
1⫺M
X 3 ⫺X 2 ⫺A 共 Y R ⫹Y A 兲 ⫺1 y⫽
K⫺H
z⫽x ⫹ 共 Y R2 ⫺X 22 ⫹X 23 ⫺L 21 ⫹L 22
ZR 2Z R
x⫽Hy⫹I (10)
⫺Y A2 ⫺Z R2 ⫹2B 共 Y R ⫹Y A 兲兲 ⫽Cx⫹D (5)
z⫽⫺ 冑L 21 ⫺ 共 x⫺X 1 兲 2 ⫺ 共 y⫺Y R 兲 2
Substituting 共4兲 and 共5兲 into 共2b兲 yields a quadratic in x, of the
form: It should be noted that the denominator of 共8兲 vanishes under the
condition X 1 ⫽X 3 , in which case the following solution may be
Ex 2 ⫹Fx⫹G⫽0 employed:
E⫽1⫹A 2 ⫹C 2 x⫽M
(6)
F⫽2 共 AB⫹CD⫺X 2 ⫺Y A A⫺Z R C 兲 y⫽0 (11)
冤 冥
y⫺Y R z
1
冋 册
冑 L 1 ⫺z 2 ⫺ 共 y⫺Y R 兲 2
2
冑 L 21 ⫺z 2 ⫺ 共 y⫺Y R 兲 2
1 J ⫺1
12 J ⫺1
13
Y A ⫺y Z R ⫺z
J ⫺1 ⫽ 1 ⫽ 1 J ⫺1 J ⫺1 (12)
冑L 22 ⫺ 共 z⫺Z R 兲 2 ⫺ 共 y⫺Y A 兲 2 冑L 22 ⫺ 共 z⫺Z R 兲 2 ⫺ 共 y⫺Y A 兲 2 22 23
1 J ⫺1
32 J ⫺1
33
y⫹Y R z
1
冑L 21 ⫺z 2 ⫺ 共 y⫹Y R 兲 2 冑L 21 ⫺z 2 ⫺ 共 y⫹Y R 兲 2
The Jacobian is then obtained through the inversion of J ⫺1 . A relatively simple closed form expression is possible since the inverse
冋 册
Jacobian is a 3⫻3 matrix:
J ⫺1 ⫺1 ⫺1 ⫺1
22 J 33 ⫺J 23 J 32 J ⫺1 ⫺1 ⫺1 ⫺1
13 J 32 ⫺J 12 J 33 J ⫺1 ⫺1 ⫺1 ⫺1
12 J 23 ⫺J 13 J 22
1
J⫽ J ⫺1 ⫺1
23 ⫺J 33 J ⫺1 ⫺1
33 ⫺J 13 J ⫺1 ⫺1
13 ⫺J 23 (13)
J ⫺1 ⫺1 ⫺1 ⫺1 ⫺1 ⫺1 ⫺1 ⫺1 ⫺1 ⫺1 ⫺1 ⫺1
22 J 33 ⫺J 23 J 32 ⫺J 12 J 33 ⫹J 13 J 32 ⫹J 12 J 23 ⫺J 13 J 22
J ⫺1 ⫺1
32 ⫺J 22 J ⫺1 ⫺1
12 ⫺J 32 J ⫺1 ⫺1
22 ⫺J 12
Singularities occur within the workspaces of parallel manipulators singularity surface is the plane z⫽0, since the third column of
where det(J⫺1)⫽0. In these configurations, an external force may J ⫺1 consists entirely of zeros in this case. The surface becomes
infinitesimally move the end effector while the actuators remain more complex as Z R is varied, however all points on the surface
stationary, the actuator forces or torques required to move the end correspond to configurations in which the parallelogram arms are
effector in certain directions tend to infinity, and the manipulator coplanar.
gains additional degrees of freedom 关14,16兴.
Analysis of the Linear Delta’s workspace reveals that there A degenerate singularity also occurs when Y R ⫽0, as rows one
exists a singularity surface near the actuators. When Z R ⫽0, and and three of J ⫺1 become identical. Inverse singularities, where
the linear actuators are coplanar, it is simple to prove that this det(J)⫽0, have not been considered here.
2.4 Workspace Cross Section Analysis of Linear Delta. B in the y-z plane, denoted (A y ,A z ) and (B y ,B z ) respectively,
When considering regions away from the limits of travel of the allows the values of ␣,  and ␥ to be determined, which define the
actuators, the Linear Delta’s cross section in the y-z plane is con- angles subtended by each segment 共see Fig. 6兲:
stant, with its boundaries defined by: Y R ⫹A Y Y R ⫹B y
1. Three circles, each centered on one actuator’s position, with cos ␣ ⫽ cos  ⫽
L1 L1
(15)
冋 册 冋 册
a radius equal to the length of the corresponding parallelo-
gram arms (L 1 or L 2 ). B y ⫺Y A A y ⫹Y A
2. The plane z⫽0, through which the end effector cannot pass. ␥ ⫽arcsin ⫹arcsin
L2 L2
3. If Z R ⬍0, the position of the central actuator restricts the
inward motion of the outer arms. Finally, the cross sectional area may be calculated:
冋 册
stricted in their motion, and clashing within the parallelogram
structures is ignored. Two specific geometric cases are presented A z ⫹B z 1 1
⫻ ⫹ A z 共 L 1 ⫺Y R ⫺A y 兲 ⫹ B z 共 L 1 ⫺Y R ⫺B y 兲
here, encompassing the vast majority of practical architectures of 2 2 2
the Linear Delta—an exhaustive coverage of all possible struc- (16)
tures would be prohibitively lengthy and tedious, with little prac-
tical use. 2.4.2 Case 2: ZR⬍0. When Z R assumes a negative value, the
presence of the central rail further limits the workspace, since the
2.4.1 Case 1: ZR⭓0. Figure 6 illustrates this case, and de- range of motion of the outer arms is restricted. This is represented
fines the variables used below. The hatched area denotes the by the unshaded area at the top of Fig. 7.
workspace cross section. Note that the length of the central paral- The unshaded 共unreachable兲 region in Fig. 7 consists of two
lelogram arms, L 2 , is such that the arc transcribed by these sectors with a triangular overlap, and its area may be calculated
arms forms part of the workspace cross section boundary; increas- as:
ing L 2 until the intersection points A and B in Fig. 6 vanished
would considerably simplify the analysis. The coordinates of 1 2
points A and B may be determined by solving the following pairs Unreachable Area⫽ L 共 ⫹ ␦ 兲 ⫺ 关共 Y R ⫺Y T P 兲储 Z R 储 兴
2 1
of equations: (17)
储 Z R储 储 Z R储
tan ⫽ tan ␦ ⫽
A B 共 Y R ⫺Y T P 兲 ⫹Y A 共 Y R ⫺Y T P 兲 ⫺Y A
冋 共 y⫺Y A 兲 ⫹ 共 z⫺Z R 兲 2 ⫽L 22
2
冉 冊
matrix, J , has been used extensively in the literature to quantify
the kinematic properties of manipulators 关1,12,14,17,18兴. The first
冕 1
冉 冊
dA W
performance index, 1 , measures the average value of 1/ J over A W J AW
the workspace cross section, normalized by the cross sectional ⫽w 1 ⫹w 2
area, A W : AW Bounding Box Area
冕 1
A WK J
dA W 冕 1
A WK J
dA W
⫽w 1 1 ⫹w 2 2
where w 1 and w 2 are positive weighting factors that define the
(20)
冕
1⫽ ⫽ (18) relative importance placed on each performance index by the de-
AW signer. The function is bounded by the range 关 0(w 1 ⫹w 2 ) 兴 , and is
dA W
AW independent of both the overall scale of the design candidate to
which it is applied, and the limits chosen for the design variables
Adapted from 关14兴, this index possesses several favorable charac- 共since neither performance index is normalized by its maximum
teristics. The index is normalized by the workspace size, and observed value兲.
therefore gives a measure of kinematic performance independent
of the differing workspace sizes of design candidates. Further- 3.2.3 Computational Issues. An exhaustive 共brute force兲
more, the reciprocal of J is bounded between 0 and 1, and is search method has been utilized to solve the optimization prob-
more convenient to handle than J , which tends to infinity at lem. While computationally expensive, an exhaustive search is
singularities; hence, during numerical integration, the number of simple, reduces the probability of any local maxima being over-
sample points near singularities has a reduced effect on the result looked, and provides information regarding the behavior of the
since 1/ J approaches zero 共rather than infinity兲 at these points. utility function over the entire range of allowable values for each
Lastly, the 共dimensionless兲 value of the index lies between zero, of the design variables.
for a manipulator singular in all configurations, and unity, for a The limits selected for the design variables are as follows: 1.4
manipulator perfectly kinematically isotropic in all configurations. ⭐L 1 /Y R ⭐2.7; 0⭐Y A /Y R ⭐0.7; ⫺0.5⭐Z R /Y R ⭐0.5; 0.6
⭐L 2 /L 1 ⭐.1.8. Several of these limits are necessary to ensure that
3.2.2 Space Utilization. This performance index was devel- the resulting structure is practical. The remaining limits were cho-
oped in order to overcome the problems involved in applying sen heuristically, with alterations made on a trial-and-error basis
simple performance indices, in isolation, to the Linear Delta. For to yield a reasonably large range, and to ensure the inclusion of
example, attempts to optimize the structure by maximizing 1 any local maxima of the utility function. A notable exception is
alone led to an architecture with a large structural space require- the case where the manipulability index, 1 , was considered in
ment but a vanishing workspace size, due to the tending of L 2 /L 1 isolation 共i.e. w 2 ⫽0); in this situation L 2 /L 1 was allowed to ap-
towards zero; while the maximization of workspace cross sec- proach zero.
tional area caused the actuators to be collinear 共i.e. Y R ⫽0, since Since there exists no analytical means of calculating the Jaco-
area increases monotonically with decreasing Y R ) resulting in a bian’s condition number ( J ), and therefore no closed-form ex-
pression for the manipulability index, numerical integration is re-
quired to determine the value of the utility function. The integral
Table 1 Kinematic design variables
of Eq. 共18兲 may be approximated by a discrete sum:
冕
Variable Description Restrictions 1 1
L1
Ratio of outer arm length to actuator separation. ⭓1
AW J
dA W 兺
a苸A W J
YR 1⫽ ⬇ (21)
AW Na
YA Ratio of center actuator horizontal eccentricity
0–1 where each a is one of N a integration points in the y-z plane
YR to actuator separation.
ZR
workspace cross section. These points are generated by examining
Ratio of center actuator vertical eccentricity
the boundaries of the cross section and forming a uniformly dis-
YR to actuator separation.
tributed grid inside it.
L2
Ratio of center arm length to outer arm length. ⭓0 In the majority of cases 共such as that illustrated in Fig. 6兲, the
L1 closed form methods such as those shown in Sections 2.4.1 and
2.4.2 may be utilized to calculate the exact cross sectional area of
The complete four-dimensional optimization required approxi- While small increases in w 2 affect the results of the optimization,
mately three hours of computation time using a Pentium II 200 the change is limited to the variable L 2 /L 1 , with the greatest
MHz PC. possible variation being a decrease of just 0.03.