Professional Documents
Culture Documents
Published by:
http://www.sagepublications.com
On behalf of:
Multimedia Archives
Additional services and information for The International Journal of Robotics Research can be found at:
Subscriptions: http://ijr.sagepub.com/subscriptions
Reprints: http://www.sagepub.com/journalsReprints.nav
Permissions: http://www.sagepub.com/journalsPermissions.nav
Citations: http://ijr.sagepub.com/content/10/5/454.refs.html
What is This?
Transformation matrices are widely used in robotics for Spherical pairs can be described as the composite of
kinematic analysis and trajectory planning. Screw geome- three linearly independent revolute pairs whose axes
try offers better geometric insight into such analyses. In intersect at a point; planar pairs can be described as
this article we unify the two approaches through the use the composite of two linearly independent prismatic
of invariant properties of orthogonal matrices under simi- pairs, a revolute pair whose axis is orthogonal to the
larity transformations. We give a complete expression for plane of the prismatic pairs.
the finite screw motion in terms of the entires of a 3 x 3 It is well known that Denavit and Hartenberg’s
dual-number transformation matrix. Our analysis suggests procedure can be used to form the closure equations
that the finite screw is suitable for trajectory planning, of a serial robot arm; a full explanation of the
and we develop a concise expression that gives the trans-
approach can be found in many places, for example,
formation matrix describing the displacement at each
point along the path of the finite screw motion.
Whitney (1972), Paul (1981), Paul et al. (1984), Pen-
nock and Yang (1985), and McCarthy (1986). What
is not widely recognized in robotics is that the
matrices used for generating these closure equations
1. Introduction form a representation of the group of rigid body dis-
In 1955, Denavit and Hartenberg devised a standard
placements. This is the so-called euclidean group in
three dimensions, denoted symbolically by E(3). The
representation of the lower kinematic pairs that can euclidean group is, in our opinion, fundamental to
be used to formulate closure equations of any spatial
mechanism theory and spatial kinematics, as all
linkage. The method is based on the transformation locations of a rigid body are uniquely described by
of spatial frames associated with the kinematics
the elements of this six-dimensional group. Our pri-
pairs. Starting with two adjacent pairs, z-axes are mary objective in this article is to elicit some of the
placed along each joint axis, and an x-axis is placed rich geometric structure of the euclidean group. In
along their common perpendicular. A y-axis is then particular, we demonstrate the relationship between
defined by the cross-product of the x- and z-axes, so
matrix representations of the group and screw
completing a Cartesian coordinate frame. When a geometry. In doing so we seek to give enlightened
third pair axis is added in series, then the same pro-
cedure gives a second frame, and so on. The spatial interpretation of the quantities and collections of
symbols that arise when the procedure of Denavit
relationship between successive frames is then and Hartenberg is applied. These expressions are
described by a standard transformation matrix.
Denavit and Hartenberg used 4 x 4 coordinate usually complicated, their structure and character
transformation matrices, but 3 x 3 dual-number being obscured by a mass of detail. Indeed, even for
relatively simple robots (Paul 1981), the complica-
orthogonal matrices serve the purpose equally well. tion becomes so great that it is nearly impossible to
As described, the method can be applied directly to
grasp the significance of the results, so the analyst
who pursues Denavit and Hartenberg’s procedure
The International Journal of Robotics Research, blindly can be forgiven for failing to recognize the
Vol. 1 U, No. 5, October 1991, geometry that is subjacent to the algebra.
© 1991 Massachusetts Institute of Technology. In section 2 we investigate the group structure of _
455
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
any certainty, be traced back before the works of
Leonhard Euler (1707-1783) (Gray 1980). Euler
made several significant contributions to our under-
standing of the laws that govern rigid body motions.
He demonstrated that every infinitesimal rotation
takes place about an instantaneous axis. He gave an
explicit notation for describing a general finite rota-
tional displacement in terms of rotations in three
successive planes (Euler angles); he showed that six
parameters are needed to specify a general spatial
displacement; and he demonstrated that a general
spatial displacement can always be factored as a
rotation, R, about an axis through an arbitrary point
together with a translation, d. This last observation
Fig. 2. Displacement offraine 19 to frame ~’. is sometimes referred to as the Euler parameteriza-
tion of E(3).
The set of rotations and the set of translations are
they body in that order, as Db-Da. To
act on the both subgroups of the euclidean group. The three-
show that displacements are associative, take a third dimensional rotation group can be represented by
displacement Doc. The effect of the three displace- the group of 3 x 3 orthogonal matrices with deter-
ments Du, Dh’ and Dc, taken in that order, will pro- minants equal to + 1. This is the so-called special
duce the same net displacement regardless of the orthogonal group in three dimensions, denoted by
way they are grouped, that is Dco(DboDa) = SO(3). A generic element R of SO(3) has the follow-
(DcoDh)oDa. Hence association holds. To demon- ing form:
strate the identity displacement, notice that there is
a family of motions that will return a body to its ini-
tial location. We call each member of this family a
- - - -
I --,
I
loop motion, and each corresponds to the identity
displacement-namely, the displacement that leaves The special orthogonal group in three dimensions is
the body unaltered. This is the identity element of a noncommutative group with composition given by
the set, and we denote it by Dp. Finally, it remains the standard matrix product.
to demonstrate that each displacement has an The three-dimensional translation group, denoted
inverse. To do so, consider an arbitrary displace- by T(3), has the three-dimensional vector space ~3
ment D of a body. Clearly there always exists a dis- as its natural representation. We can describe an
placement D-’ that returns the body to its initial element of T(3) by a three-vector
position. The combined effect of D and D- yields
the identity displacement (that is, D-’°D Do); =
456
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
structures, and a main theme of his work was to The 4 x 4 matrix of equation (4) is the basis of
show how the two combine. In doing so he estab- the unified description of the lower kinematic pairs
lished that the structure of the euclidean group is (in introduced in Denavit and Hartenberg (1955). The
modern mathematic terminology) the semidirect application of 4 x 4 coordinate transformation
product of the rotation group SO(3) with the transla- matrices to robot kinematics is discussed in Paul
tion group T(3): (1981) and in Paul et al. (1984).
The 3 x 3 dual-number matrix representation of
E(3) describes how lines (and screws) transform
Using the Euler parameterization, two general dis- under rigid body displacements. Consider an arbi-
placements (Ra, da) and (Rb, db) commute according trary line with Plfcker coordinates (appendix A):
to the following rule (Normand 1980; Selig and Roo-
ney 1989):
Under the displacement, $ is carried into the line $’
by
Another important idea conveyed in Rodrigues’
paper is embodied in what he calls the théorème
fondamental (Rodrigues 1840). (This states that where A is a 3 x 3 orthogonal matrix whose ele-
every finite displacement can be effected by a rota- ments are dual numbers. In equation (5), the lines $
tion about a definite axis combined with a transla- and $’ are given dual vectors
as (appendix A). In
tion along that axis-that is, by a finite screw terms of the matrices defined in equations (1) and
motion.) This result is more frequently attributed to (2), A is given by:
Chasles ( 1830)’ and has become known as Chasles’
Theorem (Hunt 1978). The importance of the finite
screw in the context of the euclidean group is dis-
cussed in sections 3 and 4.
the point P’ = (x’, y’, z’) where E is the 3 x 3 identity matrix. We denote the
group of all 3 x 3 dual-number matrices by OD(3).
Because the determinant of any matrix A satisfies
where d =
(dn dy, dz) gives the coordinates of the
origin of frame ~’ in frame ~, and the matrix R E
SO(3) gives the orientation of 16’ in ~. As is shown
in Denavit and Hartenberg (1955) and Bottema and elements of OD(3) must have determinant ± I . The
Roth (1979) (and indeed in many other places), equa- action of A is a proper displacement if det(A) = + 1
tion (3) can be written as a 4 x 4 matrix and an improper displacement if det(Â) = -1. Thus
O~ is the union of two sets; the group of proper dis-
placements, or the special orthogonal group of dual-
number matrices, denoted by SOD(3), and its com-
plement comprising all dual-number orthogonal
matrices with determinant - 1. This latter set is not
1. Rodrigues was familiar with Chasles’ work and attributed many a group, as it does not contain the identity. In this
of his results to him. article we consider only proper displacements,
457
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
which are those displacements that can be factored
as proper rotations (this excludes rotations formed
by inversions, reflections, and rotor-reflections)
together with translations (all of which are proper).
Three-by-three dual-number matrices are
described in Yang (1969), Bottema and Roth (1979),
Hsia and Yang (1981), Pennock and Yang (1985) and
McCarthy (1986). The articles by Pennock and Yang
(1985) and McCarthy (1986) are interesting in that
they show how 3 x 3 dual-number matrices can be
used to formulate the closure equations of serial
robot manipulators. Both do so by reformulating
Denavit and Hartenberg’s standard form for the Fig. 3. The parametric ball. Rotoation (01) corresponds to
lower kinematic pairs in terms of the 3 x 3 dual- the point P. The loclls of P traces a m>o-sphere with
number matrix. antipodal points identified.
3. The Lie Group Structure of the Euclidean clear that there is a one-to-one mapping that goes
Group both ways, between SO(3) and the points of the
A set that can be continuously parameterized by n parametric ball. The parametric ball is itself homeo-
parameters is an n-dimensional manifold (see appen- morphic to the projective three-sphere P S3-
dix B). A rigid body displacement is determined by namely, the manifold obtained by identifying each
six continuous parameters: three rotations and three point three-sphere (the set of points on [R4 at
on a
translations. Accordingly, the euclidean group has unit distance from the origin) with the point that is
the structure of a six-dimensional manifold. This is diametrically opposite it. The projective three-sphere
called the configuration manifold of E(3), and each can also be identified with the bundle of ~3 lines
point on the manifold corresponds to a rigid body through the origin of (R4. This latter construction
displacement. Its structure is best studied through defines a projective three-space.
the configuration manifolds of its subgroups SO(3) It is difficult to visualize the homeomorphism
and T(3). between P S3 and the parametric ball, as it takes
The configuration manifold of SO(3) is discussed place in real four-space [R4. There is, however, an
in numerous texts. Here we briefly sketch the con- analogous association between the disc D2 in [R2 and
struction that appears most frequently (Mishchenko the projective two-sphere P S’. The disc D2 is a
and Fomenko 1988). Any element R of rotation slice of the parametric ball taken through a great cir-
group SO(3) can be parameterized by the angle of cle and is a generator of the manifold of SO(3).
rotation 0 and axis of rotation I, which we write as Figure 4 shows a two-sphere, S2. The line joining
R( 01). This parameterization of a rotation is redun- any two antipodal points on S2 passes through the
dant in that it uses not three parameters but four- center of the sphere, and the bundle of all such lines
namely, the three direction components of I and the defines a projective two-space, 1P2. This establishes
angle 0. But normalizing I introduces a dependency
that reduces to three the number of free parameters.
The symbol 01 can be thought of as single quantity-
namely, a vector parallel to the axis of rotation of
modulus 0, with which we associate the point P =
458
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
a two-to-one correspondence between points on S2 Remark 3. The configuration manifold of the
and the space p2. We make this map (almost)
can euclidean group is a smooth six-dimensional mani-
one-to-one by taking only the upper hemisphere of fold that is isomorphic to the product of the projec-
S2, so that now only points on the equator map in tive three-sphere, P S3, with the real three-space,
two-to-one fashion. It is possible to make the corre-
fl~~ : E(3) * P S3 x 1R3. The manifold of E(3) is con-
spondence strictly one-to-one by excluding one half nected, but it is not simply connected nor is it compact.
of the equator, but for our purposes it is enough to
simply identify antipodal points. In Figure 4, the Each matrix A E SOD(3) identifies a point on the
upper hemisphere of S2 is denoted by S2 +. It is easy group manifold of E(3), and the nine dual-number
to see that S2 can be deformed into the disc D2, elements of A can be used to construct a coordinate
thus demonstrating that S~ and D2 have equivalent system E(3). Each such nine-tuple satisfies 13
on
topologic structures and are therefore homeo- constraints, 12 of which are implied by the orthog-
morphic. The deformation process is probably best onality condition [equation (7)], and the thirteenth
viewed as an orthogonal projection of each point of specifies that the displacement be proper: det(Â) =
S2 into a point of DZ (see Fig. 4). Observe that this + 1.Given another elementfi E SOD(3), the matrix
projection preserves the identification of antipodal product BA (which corresponds to the group opera-
points on the equator of S2 + by identifying diametri- tion of composition) defines a map mi - l§mi that
cally opposite points on D2. takes the point A into the point BA on E(3). Because
A manifold M is said to be (arcwise) connected if the coordinates of BA-namely, the elements of the
any two points a, b E M can be joined by a curve matrix BA-are (infinitely) differentiable functions of
on M. The manifold of SO(3) is connected, but it is the coordinates of A, the map h - BA is smooth.
not simply connected; that is, not every loop motior Moreover, if we treat the group operation of inver-
of the body corresponds to a curve on P S3 that can sion as a special composition, then it, too, is a
be contracted into a point. Recall from our earlier smooth map.
definition that a loop motion is any rigid body A set that is both a group and a smooth manifold
motion that returns the body to its original position on which composition and inversion appear as
in the ambient three-space. If the body is con- smooth maps is (by definition C3) a Lie group. Thus
strained to twist about a fixed axis I, then the we conclude the following:
obvious loop motion is a rotation about I through
2~r. On the group manifold, such a motion is a curv( Remark 4. The euclidean group, E(3), has the
that extends from the point a (the initial position) to structure of a Lie group.
the point b that is antipodal to a. Rotating the body
through a further 2?r radians (continuing in the same By similar arguments it is easy to show that the
direction) completes a great circle on S’, so that a subgroups SO(3) and T(3) are also Lie groups.
and b coincide once again. Clearly we can contract
the curve of the rotation through 47T to a point, but
we cannot do the same for the rotation through 21r,
3.1. Infinitesimal Motions and the Lie Algebra
despite the fact that both are loop motions. Hence The smoothness of its manifold endows the group
we conclude that the manifold of SO(3) is not a sim- E(3) with the special property that each of its points
ply connected manifold. has a tangent space (appendix B). The tangent space
at the general point P comprises all the vectors tan-
Remark 2. The group SO(3) has the structure of
gent to E(3) at P, giving it the structure of a real six-
a manifold that is isomorphic to a projective three-
dimensional vector space, [R6. Physically the vectors
sphere S’. This manifold is compact2 and con- of this space describe the first-order kinematic prop-
nected, but it is not simply connected. erties (velocities) of a rigid body motion. Of particu-
lar interest is the tangent space at the group identity.
Elements of the three-dimensional translation
This is the so-called Lie algebra of the group, and it
group, T(3), can be identified with vectors in ~3.
is usually denoted by e(3). Each vector in e(3) corre-
Thus the group manifold of T(3) is simply the
space ~3. By contrast with the manifold of SO(3),
sponds to an infinitesimal twist, so the space [R6 is
the space of twists. It is convenient to identify the
the manifold f~3 is simply connected but it is not
elements of e(3) with dual vectors (see appendix A).
compact. The term twist was introduced by Ball (1900) to
describe the infinitesimal displacement that results
2. The set is closed and bounded. when a body is rotated about an axis while simul-
459
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
taneously being translated parallel to that axis. This
is the most general form of motion that a body can
independent parameters are needed to specify a clude that n(t)Â T(t) is skew symmetric, that is
twist-namely, the five parameters of the screw $(h)
and the amplitude co. iAt)A T(t)
On any given screw there is a family of twists,
each member of which differs from the others only
in the value of its amplitude. In the space [R6, each
such family is a line through the origin, and the bun-
dle of all such lines defines a projective five-space
IP5 that is the space of screws. Thus screws are the A space of n x n skew-symmetric matrices defines
elements of the underlying projective five-space of a vector space of dimension n(n - 1)/2. So the set
the real vector space [R6. An important corollary of of 3 x 3 skew-symmetric matrices with dual-number
this observation is that each screw is a projective elements is a three-space of dual vectors. This space
twist. Twist and screws are fundamental concepts in shall be denoted by SkD(3), and we note that SkD(3)
kinematics, and the general theory is developed is isomorphic to the Lie algebra e(3). We identify
comprehensively in Ball (1900) and Hunt (1978). A every matrix ,f2(t)AT(t) E SkD(3) with a dual vector
comprehensive treatment of screws as elements of
the space p5 is given in Gibson and Hunt (1990).
We can make the foregoing remarks explicit by
considering an arbitrary path t ~ A(t) on E(3),
where t is a continuous parameter and A(t) E
SOn(3) for all t. The path is depicted in Figure 5. which is a twist of amplitude ~ ~ (wi + c:v~ +
For clarity we explicitly identify t with time, so that cvZ)’~2, acting on a screw $(h) of pitch
at time t the infinitesimal properties of the motion
are given by:
460
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
(from appendix A): Because the Lie bracket maps e(3) into itself, [X, Y]
E e(3) for all X, Y E e(3); hence the Lie algebra is
closed. Other properties of the algebra can be
inferred from the vector space structure of e(3) and
from the bilinearity of the bracket. For example:
quantities
in equation ( 12) is depicted in Figure 6.
algebra, e(3), has an algebraic structure that it inher- The pitch of this screw is easily found to be (h,, + hb)
its from the group structure on the manifold of E(3). + d cot B, where ha is the pitch of the screw on
A Lie algebra (Samelson 1969) is defined formally as which twist A acts, dcb is the pitch of the screw on
a vector space together with a bilinear product that which B acts, 0 is the angle between the axes of A
maps the space into itself. The product operator, and B, and d is the distance between the axes of A
denoted by [ , ], is .called the Lie bracket or commu- and B measured along the common perpendicular.
tator of the algebra, and it satisfies the following The amplitude of [A, B] equals wcob sin 0, where (Ùa
conditions: and w~ are the amplitudes of A and B respectively.
The twist [A, B] is depicted in Figure 7.
The Jacobi identity [property (b)] specifies the
condition for a body receiving twists about three
for all X, Y, Z E e(3). Property (a) is called skew screws, £1 [X, [Y, Z]], £2
=
[Y, [Z, X]], and £3 =
=
symmetry and (b) is called the Jacobi identity. [Z, [X, Y]], to resume the same position after the
last twist that it occupied before the first. The order
in which the twists are applied is of no consequence;
461
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
their accumulated effect simply maintains the body
in kinematic equilibrium. Hence the screws on
which the three twists act are linearly dependent
(each of the twists is the negated sum of the other
two), so they belong to the same two-system (Ball
1900; Hunt 1978; Gibson and Hunt 1990). The axes
of the screws of a two-system lie as generators on a
ruled surface; in general this surface is a cylindroid
(Fig. 8). The cylindroid is fundamental to the study
of screw and line geometry, and much more can be
said about it in the context of the Lie algebra. For
example, the three twists defined by the bracket
operations [.f, £2], [~2, ~3]. and [£~, jf]] share the
same axis, and this axis is precisely the nodal line of
the cylindroid (the central line that all of the screw Fig. 9. The standard basis of the Lie algebra e(3).
axes intersect at right angles). For an enlightened
discussion of this most fascinating surface we refer
the reader to Ball (1900). which is the Lie algebra of the three-dimensional
Any six linearly independent twists form a basis rotational group. Similarly the three infinitesimal
for e(3). The six unit twists shown in Figure 9, translations
which might well be regarded as normalized screws,
are the constituents of a basis called the standard
basis of e(3). Three of these describe infinitesimal
rotations, and the other three are infinitesimal trans-
lations. The three rotations are
I,
manifold of E(3), notionally depicted in Figure 10. identity, then the differential daldt £ is a twist, =
The group structure on the manifold E(3), and in and equation (14) becomes
particular the group property of closure under com-
position, ensures that every left shift LA maps V(£)
into itself, and so V(£) is invariant under a left shift.
For obvious reasons Vel) is called a left invariant Equation (15) is called the exponential map, and
from it we see how the infinitesimal twist £(c~, h)
vector field on E(3). Every twist i E e(3) defines a determines a (finite) group operation. The exponen-
distinct left invariant vector field on the group mani-
tial map hence plays a central role in describing how
fold, from which it follows that the field generated
the Lie algebra influences the structure of the group
E(3). Each i(co, h) E e(3) is called an infrnitesimal
generator of the group, as every group operation
can be generated by infinitely repeating (that is,
0, is
4. Finite Displacements
Equation (3) expresses the rule
by which a point P
transforms under rigid body displacement. rf P is
a
that takes frame 16 into ~’, depicted in Figure 2); hyperquadric Qo, sometimes called the Klein quad-
ric. For each point $(h) = u + cv* in ~5 there is a
then it is necessary to specify (1) the axis of the
screw, $~, ; (2) the angle rotated, 0; and (3) the dis- map
tance translated, T. We shall now show that it is
possible to express these three parameters in terms
of the nine elements of the matrix A that describes
the displacement.
that takes $(h) into the Klein quadric. This map
establishes the axis $(0) on which the screw $(h)
The reduction of an orthogonal matrix of general
acts. The line in P’ joining $(0) and $(h) intersects
form to one of a special form can be effected by a
all of the pitch hyperquadrics and represents all of
similarity transformation (Ayres 1962). We can the screws that can have $(0) as their axis.
make use of the properties of similarity transforma-
The euclidean group acts naturally in ¡p>5, mapping
tions to reduce any matrix A E SOD(3) to a matrix
of the form
points onto points according to the rule given by
equation (6). Under the group action, each pitch
hyperquadric is mapped into itself, and for a general
displacement, only one (real) point on each pitch
hyperquadric remains where it is. There is a
(straight) line L in ¡p>5 through these invariant points
that intersects all of the pitch hyperquadrics and
where matrix B E OD(3), and the matrices A and defines the family of all possible screws that may act
BAB&dquo;’ are said to be similar or equivalent. The on the axis of the finite screw of the displacement.
similarity transformation that gives equation (17) Under the exponential map, this family generates a
serves to align the z-axis of the reference coordinate symplectic subgroup of E(3) that we can identify
frame with the axis of the finite screw. Two similar with a cylindrical pair centered on the finite screw
matrices have the same trace (Ayres 1962) so axis. The point where the line L intersects the
hyperquadric Q*($) (that contains all the screws of
infinite pitch) is the vanishing line in the plane at
thus infinity of all planes perpendicular to the finite screw
axis (see Fig. 12).
Each screw on L is a projective twist; hence there
is a double infinitude of twists that, in general, are
where fiii aii + can, i
=
1, 2, 3, is the (ii)th ele-
=
465
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
which yields a cubic in A screw motion.’ To further emphasize the distinction
between 9 and the finite screw, we call the pitch of 9
the translation scalar, and its amplitude shall be
The three roots of equation (21) are
referred to as its modulus.
The translation scalar of 9 is denoted by ii, where
Let 9 =
(A - A I&dquo;). Clearly 9 E SkD(3), so we iden- As we have already seen, a general matrix A E
SOD(3) can always be reduced to the form of equa-
tify it with the dual vector
tion (17) by performing a similarity transformation.
From the Pliicker coordinates of the similar matrix,
equation (17), we can derive alternative expressions
for the modulus and the translation scalar of the sec-
We then rewrite equation (24) the
ondary isotropic twist.
can as cross-prod- From equation (27), the Plfcker coordinates of the
uct of two dual vectors, £ and 9
secondary isotropic twist of equation (17) are
and from equation (26) it follows that the twist s and which reveals that the modulus <~ is
£ coincide, and therefore 9 is an eigenvector of A
corresponding to the eigenvalue A + 1. =
The screw on which the twist 9 acts corresponds and translation scalar p is
to the point on the isotropic line L with Plucker
coordinates (appendix A)
A geometric interpretation of the secondary iso-
tropic twist, based on equations (31), (32), and (33),
is given in Figure 13.
Equations (30), (31), and (32) and a knowledge of
dual-number algebra reveals the alternative but
equivalent method for finding of the normalized
Placker coordinates of the finite screw axis. This is
In general, exponentiation of 9 does not yield the given by equation (34).
finite screw described by A; however, it will yield a
finite screw motion that takes place about the axis
of the finite screw. The use of the superscript t in
equation (27), in preference to the usual superscript 3. There is an unlimited number of screws on L that generate the
*, is meant to draw the reader’s attention to this finite screw motion of the displacement, as the pitch of this screw
point. We call i the secondary isotropic twist of A, may be r/(8 ± 2niT), n 0, 1, 2, 3, ... , where - o = 8 S 1r.
=
the primary isotropic twist being the infinitesimal The screw that we refer to here is specifically that whose pitch is
screw that, by exponentiation, generates the finite r18. Hunt (1978) calls this pitch the cardinal pitch.
466
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
The angle of rotation is 0 cos-’ (2(trace A - 1)),
=
Pure Translation
Thus Plucker coordinates of the axis of a pure trans-
lation follow can be written down by inspection as
where the rule for dividing two dual numbers is direction only and so can be regarded as a free vec-
defined in appendix A. In matrix form these expres- tor.
sions can be rewritten
rotation matrix
4.1. Special Cases
Two special cases of equation (27) are of particular
interest. They correspond to pure rotation and pure
translation. serves to orientate ~’ in 16. Using equation (6), the
3 x 3 dual-number matrix that describes the loca-
Pure Rotation tion of 16’ in 16 is
If the displacement is a pure rotation, the matrix A
becomes a rotation matrix, and the normalized
Pliicker coordinates of rotation axis are
Fig. 14. The finite screw $ which takes frame lq into 16.
467
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
From equation (27), the secondary isotropic twist of Equation (37) gives a concise formulation of the dis-
A is placement matrix describing the location of the mov-
ing frame ~’ in the fixed frame 19 (see Fig. 2), at
each point of a finite screw motion. This parameteri-
From equations (19) and (20), the angle of rotation zation is given directly in terms of the angle of rota-
tion 4J. Note that for 4J = 0 the matrix N( 4J) E,
=
and the translation component is found to be expected. In robotics it is usual to refer the location
of the gripper frame to some fixed base frame 7A,
usually located at the base of the manipulator.
If the location of frame 19 in 26 is given by the
We may use either equation (28) or equation (33) to matrix B, then by the group property of composi-
calculate the translation scalar as tion, the location of the moving ~6’ in frame 91, is
given by ~V(<~)F.
Although we have not implemented this approach
Then by either equation (30) or equation (34), the to trajectory planing in an industrial robot, it would
axis about which the twist takes place is appear that the method has some merit. This is par-
ticularly true when the manipulator’s working space
is free of obstacles that might otherwise interfere
This completes the solution of the problem. with its motion. Eminently suited to finite screw
motion is the &dquo;pick-and-place&dquo; class of operations,
where the manipulator is required to move its grip-
4.3. Generating a Finite Screw Motion per frame between two known locations. The effi-
It remains to show how the finite screw can be used ciency of such a task is perhaps best measured by
the cycle time, and so, provided that the manipula-
in trajectory planning. This requires the specification
tor does not become obstructively contorted, it
of the A matrices for all points along the path of the
finite screw motion. From equation (35), the infini- might well be that the finite screw motion is the
best.
tesimal screw that generates the motion is
Given that a finite screw describes the &dquo;canoni-
cal&dquo; motion of a rigid body between two locations,
it is perhaps surprising that researchers interested in
problems of trajectory planning have ignored this
and by equation (26), the finite twist about the screw solution. Typical path planning strategies break the
$ through an angle 4> (where 0 ~ ~ ~ 0) is
motion into movements along straight lines and rota-
tions about fixed axes (Paul 1981). Although these
are themselves finite screws motions-rotations are
finite screws of zero pitch and translations are finite
screws of infinite pitch-we are not aware of any
5. Conclusions
We have demonstrated the equivalence of screw
geometry with matrix representations of the
euclidean group. To do this we made extensive use
of the Lie group structure of E(3) and its corre-
sponding Lie algebra. Our analysis suggests that the
finite screw is suitable for trajectory planning, and
we have developed a concise expression that gives
the transformation matrix describing the displace-
468
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
ment at each point along the path of the finite screw form,
motion.
ported by Australian Research Council grant no. Similar expressions can be found for all other trigo-
A48716268. nometric identities. All trigonometric identities for
ordinary angles also hold for dual angles.
A dual vector is an ordered triple of dual numbers
Appendix A: Dual Numbers, Dual Vectors, (e7,, â2, fi3). This defines an ordered pair of vectors
and Screws A and A* combined in the form A A + EA * where
=
Provided that b # 0, the division alb is also defined: On each screw is defined a scalar quantity, called
the pitch, h, where
469
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
min and Pollack (1974), and Mishchenko and Fo-
menko (1988). This introduction aims to present the
material with simple geometric notions in preference
to rigorous definitions. For a more complete treat-
ment, the reader should refer to one of the texts
given above or another reputable text on the sub-
ject.
A set of points, which together comprise a regular
two-dimensional surface in the usual three-dimen-
sional space, 1R.3, serves to introduce the notion of a
manifold in an intuitive way. Two familiar surfaces
in [R3 are the sphere and the right circular torus,
both of which are two-manifolds. The two-sphere is
defined as the set of points in [R3 that are equidistant Fig. 16. A vector field on the two-sphere S2 and an inte-
from given point called the center. The two-torus
a gral curve to the vector field.
comprises the set points obtained by rotating a circle
in [R3 about a coplanar line through 2z radians. An
If the manifold M is smooth, then each point P on
alternative but equivalent definition of two-torus is M has a tangent space Tp(M). It is easy to visualize
the product of two circles in [R3. the tangent space of a two-manifold; it is simply the
Both the two-sphere and the two-torus have
plane that is tangential to the surface at the point P.
higher dimensional analogues. For example, in the In Figure 15 we depict the tangent space Tp(S’) of a
n-dimensional space fl~&dquo;, an (n - 1)-sphere is
defined as the set of points in R&dquo; that are equidistant
two-sphere, and we note that the tangent space has
the structure of a real vector space [R2 spanned by
from a given point. Similarly an (n - I)-torus is the
any two linearly independent tangent vectors t, and
product of (n - 1) circles. Both the (n - I)-sphere t,, to S2 at the point P. We can use analogy to visual-
and the (n - 1)-torus are (n - I)-dimensional ize the tangent spaces of higher dimensional mani-
smooth manifolds.
folds. For example, the tangent space of the three-
The formal definition of a manifold is a set M on
which each point P has a neighorhood that admits a
sphere S3 at each point P is a real three-space, [R3.
n
The tangent space to the manifold (~n is simply a
one-to-one continuous map into an open set of ~8&dquo;
space R&dquo;.
for some n. This means that every point on M looks
A vector field on a manifold M is a rule that
(locally) like the space l~’~. Given this, the simplest assigns a distinct tangent at each point P on M. A
manifold is the space U$&dquo; itself. In the context of the
euclidean group, the manifold ~3 is associated with
typical vector field on the the two-sphere S2 is
the translation group in three dimensions. The mani-
depicted in Figure 16. Any smooth curve on M
whose tangent vector at each point is in a vector
fold of the three-dimensional rotation group can be field at each of its points is called an integral currve.
identified with the three-sphere in [R4 on which dia-
An integral curve on a vector field on S2 is depicted
metrically opposite points have been identified. in Figure 16.
470
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
of the group. Formally, we say that G is a group if it Clifford, W. K. 1873. Preliminary sketch of biquaternions.
satisfies the following four axioms of group theory: Proc. London Math. Soc. 4:381-395.
Denavit, J., and Hartenberg, R. S. 1955. A kinematic
1. G is closed under the product operator; that is, matrices.
notation for lower-pair mechanisms based on
gl°gz E G for any gl, g2 E G; ASME J. Appl. Mech. 22:215-221.
2. The product operator is associative; that is, Gibson, C. G., and Hunt, K. H. 1990. Geometry of screw
gtUg2°t~,3~ - (91092)093 for any gl, g2, g3 E G; systems (in two parts). Mech. Machine Theory 25(1):1-
3. There is one element e E G such that g-e g 29.
e-g for all g E G. The element e is called
=
Gray, J. J. 1980. Olinde Rodrigues’ paper of 1840 on
the identity element of the group; transformation groups. Arch. History Exact Sci. 21:375-
4. For every g E G, there is an element g-’ such 385.
that g°g-’ Guillemin, V., and Pollack, A. 1974. Differential Toplogy.
g-log e. The element g-’ is
= =
471
Downloaded from ijr.sagepub.com at MARQUETTE UNIV on August 17, 2014
faces that cannot be gripped. Int. J. Robot. Res. Yang, A. T. 1969. Displacement analysis of spatial five
8(5):79-87. link mechanisms using 3 x3 matrices with dual number
Study, E. 1903. Die Geometrie der Dynamen, Leipzig, elements. ASME J. Mech. Trans. Automat. Des.
437 p. 91:152-157.
Veldkamp, G. R. 1976. On the use of dual numbers, vec- A. T. 1974. Calculus of In Spillers, W. R.
tors, and matrices in instantaneous kinematics. Mech.
Yang, screws.
(ed.): Basic Questions of Design Theory. Amsterdam:
Machine Theory11(2):141-156.
North Holland Publishing Company, pp. 266-281.
Whitney, D. E. 1972. The mathematics of coordinated
control of prosthetic arms and manipulators. ASME J. Zassenhaus, H. J. 1958. The Theory of Groups. New
Dyn. Sys. Meas. Control 94:303-309. York: Chelsea.