Dimensional_Synthesis_of_Bennett_Linkages
Dimensional_Synthesis_of_Bennett_Linkages
Dimensional_Synthesis_of_Bennett_Linkages
net/publication/228710121
CITATIONS READS
67 354
2 authors:
All content following this page was uploaded by Alba Perez-Gracia on 04 June 2014.
Abstract
This paper presents a synthesis procedure for a spatial 4R linkage,
known as Bennett’s linkage. It is known that the synthesis of the
spatial RR chain for three positions yields two solutions, which form
a Bennett linkage. While analytical solutions to these equations have
been developed previously, this paper uses the cylindroid that is known
to exist for a Bennett linkage to simplify the solution process. It is
interesting that geometric constraint associated with the spatial 4R
chain simplifies the solution of the RR chain design equations. An
example design is presented.
1 Introduction
In this paper we present a procedure to design spatial 4R chains known
as Bennett linkages, using the synthesis equations for the spatial RR
chain. Veldkamp [Veldkamp, 1967] solved the design equations of a
spatial RR chain for three instantaneous positions, and showed that
the two solutions form a Bennett linkage. Suh [Suh, 1969] solved the
problem for three finite positions, first numerically and later using
1
W
a
α H
γ g
G
Ground link
U
screw geometry, and showed that in all cases, the two solutions formed
a Bennett linkage. Tsai and Roth [Tsai and Roth, 1973] solved alge-
braically the 10 quadratic equations for three position synthesis using
the screw triangle formulation and showed that it always has two so-
lutions which form a Bennett linkage.
We use Huang’s result [Huang, 1996] that the finite displacement
screws of a Bennett linkage form a cylindroid to determine a coordi-
nate frame in which the design equations simplify. The result is three
linear equations and one cubic polynomial in four design parameters.
X
m
M = 6(n − 1) − pk ck = 6.3 − 4.5 = −2. (1)
k=1
However, the Bennett linkage moves with one degree of freedom,
due to its special geometry. In order to move, the twist angles and
link lengths of the opposites sides of this linkage, (α, a) and (γ, g),
must be equal. This together with the condition
sin α sin γ
= , (2)
a g
2
Moving Axis
Wi
α
G
a
End Effector
Fixed Axis B
Pi
3
[D] = [G][Z(θ, 0)][X(α, a)][Z(φ, 0)][H], (3)
where [G] and [H] are the initial and final transformations from the
fixed frame to the fixed axis and from the moving axis to the end
effector, respectively.
Choosing a reference configuration [D1 ], we can construct the set
of the relative displacements [D1i ] = [Di ][D1 ]−1 ,
where
ψ̂1i ∆θ ∆φ ∆θ ∆φ
cos( ) = cos cos − sin sin G · W1 , (6)
2 2 2 2 2
and the dual vector
ψ̂1i
sin( )S1i =
2
∆θ ∆φ ∆φ ∆θ 1 ∆θ ∆φ
sin cos G + sin cos W + sin sin G × W1 . (7)
2 2 2 2 2 2
The dual angle ψ̂1i defines the relative rotation and translation of the
end-link along the screw axis S1i . Notice that the pitch corresponds
to screws representing finite displacements [Parkin, 1992].
4
ψ̂1i ψ1i ψ1i t1i /2
sin( ) = (sin( ), sin( ) ). (8)
2 2 2 tan(ψ1i /2)
φ sin α+γ
2 θ θ
tan = α−γ tan 2 = K tan 2 , (9)
2 sin 2
K tan ∆θ 2 θ1
∆φ 2 (1 + tan 2 )
tan = . (10)
2 1 + (K 2 − 1) tan θ21 tan ∆θ 2
2 + K (tan
2 θ1
2)
where
K(1 + K12 )
Kθ = ,
2 K1 (K − 1)
1 + K 2 K12 + tan ∆θ 2
θ1
K1 = tan . (12)
2
5
Figure 3: The cylindroid as viewed first from the top along the central axis,
then from the side and finally, from an angle.
4 The Cylindroid
A cylindroid is a simply-ruled surface that has a nodal line cutting all
generators at right angles. In an appropiate coordinate frame, we can
write its algebraic equation as
6
must generate this cylindroid. This is the key to our formulation of
the RR design problem.
To describe the geometry of the cylindroid, let us consider the
screws obtained from the design positions. For this calculation it is
convenient to work with the vector part of the quaternion product (7)
and define the screws
ψ̂12 ψ̂13
Va = sin S12 , Vb = sin S13 . (13)
2 2
The dual number sin ψ̂21i = (sin ψ21i , t21i cos ψ21i ) contains the magnitude
and pitch of the screw,
ψ̂ ψ
sin = sin (1, P ), (14)
2 2
where the pitch P is given by the expression
t12 t13
Pa = ψ12
, Pb = . (15)
2 tan 2 2 tan ψ213
where we have absorbed sin ψ212 and sin ψ213 into the constants a and
b, respectively. The axes of the screws F form a cylindroid.
7
K
Y
S13
X
z0
σ
S12
Figure 4: The principal axes as located from the initial screws S12 and S13
variable angle. This surface has a set of principal axes consisting of the
common normal and the only pair of lines that intersect at an angle
of 90 degrees. This occurs at the midpoint of the cylindroid along the
central axis. The expression of the cylindroid in the coordinate frame
defined by the principal axes is considerably simpler. The following
formulation combines the results of [Hunt, 1978] and [Parkin, 1997] to
define the principal axes.
We locate the axis of the general screw F of the cylindroid using
the dual angle ζ̂ = (ζ, z), that is
and equate to (18). We separate the real and dual parts of this result,
½ ¾ · ¸½ ¾
cos ζ 1 cos δ a
F = (20)
sin ζ 0 sin δ b
and
· ¸½ ¾ · ¸½ ¾
− sin ζ cos ζ z P Pb cos δ − d sin δ a
F = a . (21)
cos ζ sin ζ P 0 Pb sin δ + d cos δ b
8
Now we eliminate the scalars a and b using both equations to
obtain
½ ¾ · ¸· ¸½ ¾
z(ζ) − sin ζ cos ζ Pa (Pb − Pa ) cot δ − d cos ζ
F =
P (ζ) cos ζ sin ζ 0 Pb + d cot δ sin ζ
(22)
This equation gives the pitch P and distance z of the screw for any
value of the angle ζ. We use this expression to locate the principal
axes of the cylindroid, as the screws with maximum and minimum
value of pitch. Computing the derivative of the above expression we
obtain
½ ¾ · ¸½ ¾
d z −(Pb − Pa ) cot δ + d (Pb − Pa ) + d cot δ sin 2ζ
= .
dζ P (Pb − Pa ) + d cot δ (Pb − Pa ) cot δ − d cos 2ζ
(23)
9
fixed axes. Let α and a denote the twist angle and distance between
these axes. Clearly they must remain constant during the movement.
Furthermore, the axes can not slide, so that the normal line to both
axes remains the same. These constraints can be found in Suh and
Radcliffe [Suh and Radcliffe, 1978], and [McCarthy, 2000]. Tsai and
Roth [Tsai and Roth, 1973] use a similar formulation based on the
equivalent screw triangle.
10
S12
C12
ψ12
2 W1
G t12
2
n1 P1 n3
βG βW
B
n2
2
[A1i − I] = [B1i − B1i
T
B1i ], (32)
1 + tan2 (ψ1i /2)
11
where [B1i ] is the skew-symmetic matrix corresponding to the rotation
axis vector, B1i = tan(ψ1i /2)S1i , and [S1i ]v = S1i × v. Then we just
need to write the direction equation as
kG · ([S1i ] − k 0 [S1i
T
S1i ])W1 =
kG · (S1i × W1 ) − kk 0 ((S1i × G) · (S1i × W1 )) (33)
to obtain
ψ1i G · (S1i × W1 )
tan = . (34)
2 (S1i × G) · (S1i × W1 )
G · (P1 − B) = 0,
W1 · (P1 − B) = 0, (36)
and
12
b K
W 1
P1
X
c
c
2
C1
G
Y
κ
B
a
13
la
α W1 α+γ
Kp
γ U1
(α+γ) H Yp
2 C1
G=Z0
P1
Y0 Q
X0 Xp
B b
lg
a =la+lg
2
b Kp
LPQ W1
NGH=X0
P1
Xp lg H
c
la θ1
c LBC
2 C1
G=Z0
Yp
κ
Y0
B
a
frame that will not change as the Bennett linkage moves. This is the
frame {NGH , G × NGH , G}.
It is interesting because of its simplicity, to look first at the location
of the cylindroid with respect to the tetrahedron when this is in the
folded position, that is, when we are measuring the angles from the
initial angle θ = 0.
We construct the expression of the relative screw axes generated
by the linkage in this new coordinate frame, using equation (11).The
screws of the relative displacement are given by the values of the
absolute angle θ,
K sin α tan2 2θ θ
Kla cos α tan2 2
S0i = −K sin α tan 2θ + ² −Kla cos α tan 2θ . (38)
θ
(1 + K cos α) tan 2 −Kla sin α tan 2θ
14
We can locate the principal axes, as before, as the screw axes with
maximum and minimum pitch. The pitch of the normalized screw
axes is given by
la +lg
2
z0 = 0 , (40)
0
0 0
Kp = cos α+γ + ² − 1
(l a + l g ) sin α+γ
, (41)
2 12 α+γ
2
sin α+γ
2 (l
2 a + l g ) cos 2
sin α sin θ1 la cos α sin θ1
W1 = − cos θ1 sin α + ² −la cos α cos θ1 , (42)
cos α −la sin α
15
and using eq.(11), we can construct the expression of the screws of the
relative displacement, which we are going to call S1i . The expression
for the direction part is
θ−θ1 θ−θ
K sin α sin (sin θ1 +cos θ1 tan 2 1 )
2
cos
θ1 θ θ θ
cos 2 +K 2 sin 21 sin 2
2
θ−θ1 θ−θ
K sin α sin (sin θ1 tan 2 1 −cos θ1 )
S1i = 2
, (43)
cos
θ1 θ
cos θ2 +K 2 sin 21 sin θ2
2
θ−θ1
K cos α sin
tan θ−θ
2 +
1
θ1 θ
2
θ θ
cos 2
cos 2
+K 2 sin 21 sin 2
θ−θ θ−θ
Kla cos α sin 2 1 (sin θ1 +cos θ1 tan 2 1 )
θ θ
cos 21 cos θ2 +K 2 sin 21 sin θ2
θ−θ1 θ−θ1
Kla cos α sin (sin θ1 tan −cos θ1 )
S01i = 2 2
. (44)
cos
θ1
cos θ2 +K 2 sin
θ1
sin θ
2 2 2
θ−θ1
Kla sin α sin
θ1 θ
2
θ θ
cos 2
cos 2
+K 2 sin 21 sin 2
2 la (cos α − cos γ) sin θ1
1
sin α sin θ1
K = sin γ − sin α cos θ1 + ² − 1
(cos α − cos γ)(l a cos θ 1 + l g ) ,
2 1 (cos2 α−cos2 γ)
cos α − cos γ l
2 a sin α
(45)
and apply the dot product with K = K + ²K0 , K being the direction
vector of the axis K, and S1i = Si1 + ²S01i . We obtain that
16
screws intersect the line K; hence this is the nodal line of the cylindroid
and forms its principal axes. To locate the Xp , Yp principal axes we
find the distance from a given axis of the cylindroid to the principal
axes, using equation (25). We obtain that the principal axes intersect
at the point
√
2 sin α sin γ sin θ1
tan κ = √ (48)
(cos α + cos γ) 1 − cos α cos γ − sin α sin γ cos θ1
17
The coordinates of the vertices are given by
a cos κ2 b cos κ2
B = a sin κ2 , P1 = −b sin κ2 ,
−c c
2 2
−b cos κ2 −a cos κ2
Q= b sin κ2 , C1 = −a sin κ2 . (49)
c −c
2 2
and
−2ac sin κ2
W1 = Kw (B − P1 ) × (C1 − P1 ) = Kw 2ac cos κ2 , (51)
4ab cos κ2 sin κ2
and
−2ac sin κ2 −a cos κ2 (4b2 sin2 κ2 + c2 )
W1 = Kw 2ac cos κ2 + ²Kw −a sin κ2 (4b2 cos2 κ2 + c2 ) .
4ab cos κ2 sin κ2 2abc(cos2 κ2 − sin2 κ2 )
(53)
18
By using the Bennett linkage coordinates to define G and W1 , we
reduce the number of design parameters from ten to four. Further-
more, the six equations (36) and (37) are identically satisfied. The
result is four equations (34) and (35) in the unknowns a, b, c and κ.
t12 κ κ
+ (a − b) cos δ1 cos + (a + b) sin δ1 sin = 0
2 2 2
t13 κ κ
+ (a − b) cos δ2 cos + (a + b) sin δ2 sin = 0
2 2 2
They can be solved to obtain
Ks Kd
a= κ + ,
2 sin 2 2 cos κ2
Ks Kd
b= − . (56)
2 sin κ2 2 cos κ2
2 ψ12
ψ12 Ks tan cy Ks sin δ1
tan ( − y 2 ) + c2 2 (y 2 (cos 2δ1 − 1) + cos 2δ1 + 1) − 2 K (cos δ1 + )
2 K2 2K 2 d Kd
d d
= 0,
K2 c2
( s − y2 ) + (y 2 (cos 2δ1 − 1) + cos 2δ1 + 1)
K2 2K 2
d d
(57)
19
Constant Expression
t12 cos δ2 −t13 cos δ1
Ks 2 sin(δ1 −δ2 )
t13 sin δ1 −t12 sin δ2
Kd 2 sin(δ1 −δ2 )
³ ´
t12 /2 1
K12 ψ sin2 δ1 −sin2 δ2
tan 212
³ ´
t13 /2 1
K13 ψ sin2 δ1 −sin2 δ2
tan 213
2 ψ13
ψ13 Ks tan cy Ks sin δ2
tan ( − y 2 ) + c2 2 (y 2 (cos 2δ2 − 1) + cos 2δ2 + 1) − 2 K (cos δ2 + )
2 K2 2K 2 d Kd
d d
= 0,
K2 c2
( s − y2 ) + (y 2 (cos 2δ2 − 1) + cos 2δ2 + 1)
K2 2K 2
d d
(58)
In order for this set of equation to have roots other than those
given by (59), the determinant of the coefficient matrix must be zero.
This yields an equation that is linear in c. Solve this to obtain
P : C3 y 6 + C2 y 4 + C1 y 2 + C0 = 0 (61)
20
with the coefficients given by
C3 = −Kd2 ,
C2 = Ks2 − 2Kd2 + 4(K12 − K13 )(K13 sin2 δ1 − K12 sin2 δ2 ),
C1 = 2Ks2 − Kd2 − 4(K12 − K13 )(K13 cos2 δ1 − K12 cos2 δ2 ),
C0 = Ks2 . (62)
Substitute z = y 2 , and solve the cubic polynomial to determine its
three roots.
This cubic polynomial has only one real positive root for z. To see
this we note that the value of the polynomial at z = 0 is positive; for
large positive values of z, the polynomial becomes negative because,
hence we have at least one positive root. For large negative values of
z, the polynomial remains positive. Now for z = −1, the value of the
polynomial is negative for all values of the coefficients, as we can see
in eq. (63). We conclude that there must be two negative roots.
P (0) = Ks2
P (∞) = −Kd2
P (−1) = −4(K12 − K13 )2 (63)
The square root of the positive root gives the two solutions for κ.
κ √
tan = ± z0 (64)
2
The result is two sets of solutions (a, b, c, κ) and (−b, −a, −c, −κ).
The design procedure yields two unique algebraic solutions for
the three position synthesis of the RR chain. Due to the symme-
try of the principal axes, the second solution given by the values
(−b, −a, −c, −κ) corresponds to the coordinates of the RR chain as-
sociated with the other two axes of the Bennett linkage, as defined in
Equation (54) and can be seen in Table 8. Hence this procedure yields
two RR chains, which combine to form a Bennett linkage.
Solution 1 Solution 2
G( a, b, c, κ) = H(−b, −a, −c, −κ)
W( a, b, c, κ) = U(−b, −a, −c, −κ)
H( a, b, c, κ) = G(−b, −a, −c, −κ)
U( a, b, c, κ) = W(−b, −a, −c, −κ)
21
x y z θ φ ψ
M1 0.0 0.0 0.0 0◦ 0◦ 0◦
M2 0.0 0.0 0.8 0◦ 0◦ 40◦
M3 1.11 0.66 0.05 18.8◦ -28.0◦ 67.2◦
9 Example
In Table 2 and Figure 8 we present three specified positions, given by
the distance (x, y, z) to the origin and the longitude, latitude and roll
orientation angles (θ, φ, ψ) of the moving frame.
We obtain the fixed joint lines G and H and moving joint lines
W and U1 . Table 3 presents their coordinates in the original frame.
1
Figure 9 shows the obtained Bennett linkage while passing by the three
specified positions.
10 Conclusions
This paper presents a new formulation of the solution for the three
position synthesis of a Bennett linkage. The procedure combines the
results of Tsai and Roth (1973) for the spatial RR chain with the
geometric properties of the cylindroid studied by Huang (1996). Using
the properties of the cylindroid, we were able to use the principal
axis frame of the cylindroid and a new set of design parameters to
simplify the original design problem from ten quadratic equations in
ten unknowns to four equations in four unknowns. We find algebraic
22
Figure 8: The specified positions
expressions for the unknowns and were able to prove that there are
two unique solutions that combine to form a Bennett linkage.
11 Acknowledgments
Shawn, Haijun, Balsells fellowship, bla, bla, bla....
References
[Alhers and McCarthy,2000] Ahlers, S. G., and McCarthy, J. M.,
“The Clifford Algebra of Double Quaternions and the Optimization
of TS Robot Design”. Applications of Clifford Algebras in Com-
puter Science and Engineering, E. Bayro and G. Sobczyk, editor,
(in press).
23
Figure 9: The Bennett linkage
24
[Bennett, 1903] Bennett, G.T., A New Mechanism. Engineering,
1903, vol. 76, pp. 777-778.
[Bottema and Roth, 1990] Bottema, O., and Roth, B., Theoretical
Kinematics, North-Holland, 1979, (reprinted by Dover Publica-
tions, 1990).
[Etzel and McCarthy,1999] Etzel, K.R., and McCarthy, J.M., “Inter-
polation of Spatial Displacements Using the Clifford Algebra of E4”.
ASME Journal of Mechanical Design, vol. 121(1), pp. 39-44.
[Ge,1995] Ge, Q.J., and Kang, D., “Motion Interpolation with G2
Composite Bezier Motions”. ASME Journal of Mechanical Design,
vol. 116, pp. 749-755.
[Huang, 1992] Huang, C., “On the Finite Screw System of the Third
Order Associated with a Revolute-Revolute Chain” Journal of Me-
chanical Design, 1994, vol. 116, pp. 875-883.
[Huang, 1996] Huang,C., “The Cylindroid Associated with Finite Mo-
tions of the Bennett Mechanism,” Proceedings of the ASME Design
Engineering Technical Conferences, Irvine, CA, 1996.
[Hunt, 1978] Hunt, K.H., Kinematic Geometry of Mechanisms.
Clarendon Press, 1978.
[McCarthy, 1990] McCarthy, J. M., Introduction to Theoretical Kine-
matics. The MIT Press, 1990.
[McCarthy, 2000] McCarthy, J. M., Geometric Design of Linkages.
Springer-Verlag, 2000.
[McCarthy and Alhers,1999] McCarthy, J.M., and Ahlers, S., “Di-
mensional Synthesis of Robots Using a Double Quaternion Formula-
tion of the Workspace”. 9th. International Symposium of Robotics
Research ISRR’99, pp. 1-6.
[Park,1995] Park, F. C, “Distance Metrics on Rigid Body Motions
with Applications to Mechanism Design”. ASME J. of Mechanical
Design, vol. 117(1), pp. 48-54.
[Parkin, 1992] Parkin, I.A., “A Third Conformation with the Screw
Systems: Finite Twist Displacements fo a Directed Line and
Point”.Mechanisms and Machine Theory, 1992, vol. 27, pp. 177-
188.
25
[Parkin, 1997] Parkin, I.A., “Finding the Principal Axes of Screw
Systems.” Proceedings of the ASME Design Engineering Technical
Conferences, Sacramento, CA, 1997.
[Suh, 1969] Suh, C.H., “On the Duality in the Existence of R-R Links
for Three Positions.” J. Eng. Ind. Trans. ASME, 1969, vol. 91B,
pp. 129-134.
[Suh and Radcliffe, 1978] Suh, C.H. and Radcliffe, C.W., Kinematics
and mechanisms design. John Wiley & Sons, 1978.
[Tsai and Roth, 1973] Tsai, L.W. and Roth, B., “A Note on the De-
sign of Revolute-Revolute Cranks”. Mechanisms and Machine The-
ory, 1973, Vol.8, pp 23-31.
[Tsai, 1972] Tsai, L.W., Design of open-loop chains for rigid body
guidance. Stanford University Ph.D.dissertation, 1972.
[Yu, 1981] Yu, H.C., “The Bennett Linkage, its Associated Tetrahe-
dron and the Hyperboloid of its Axes”. Mechanism and Machine
Theory, Vol. 16, pp. 105-114, 1981.
26