Professional Documents
Culture Documents
R. W. Brockett
Division of Applied Sciences
Harvard University
Cambridge, Massachusetts 02138
ABSTRACT. The manipulation of rigid bodies by manipulators which are motor driven
kinematic chains is a fundamental aspect of robotics. In this paper, we discuss
the kinematics of such processes and discuss the classification of kinematic
chains using ideas from algebra and group theory. Earlier work on the role of Lie
groups in mechanisms is contained in Herv~ [ 7], but the role of Lie algebras is
not considered by this author. More relevant (but less group theoretic) is the
extensive case-by-case analysis found in Pieper's thesis [ 9]. In fact, Pieper's
work suggests an interesting and rather general problem in Galois theory which is
directly related to manipulation. Also of interest is the well-known Baker-
Campbell-Hausdorff formula for the derivative of a product of exponentials since
such products are of fundamental importance in the study of kinematic programming.
This work was supported in part by the U. S. Army Research Office under Grant
No. DAAG29-79-C-0147, Air Force Grant No. AFOSR-81-7401, the Office of Naval
Research under JSEP Contract No. N00014-75-C-0648, and the National Science
Foundation under Grant No. ECS-81-21428.
121
We use the notation ]E 3 to denote ordinary cartesian 3-space with the standard
inner product (x,y) = ZxiY i. An affine transformation
y = Ax + b
The Lie group ]E(3) is neither simple nor solvable, but is the semidirect product
of the simple Lie group of orthogonal transformations and the abelian Lie group
consisting of all translations.
The Killing form defines a natural Riemannian metric on the orthogonal group,
there exists
such that expN = M. That is, the exponential map is onto ~ ( 3 ) . Since we can
obviously write
we obtain Euler's theorem stating that any rigid motions can be thought of as a
translation followed by a rotation about a line passing through a preassigned
fixed point. Chasles stated that any rigid motion can be achieved by rotation and
translation which commute. A rotation about the origin
and a translation
commute if, and only if, Ab=b. Thus, Chasles theorem says that we can express any
euclidean transformation as shift of origin followed by a commuting rotation and
translation; i.e.,
[:
with Ad=d and <c,d> = 0. (This last condition is necessary in order to make c and
d unique.) Since the range space and null space of a skew symmetric matrix are
orthogonal, the identity
implies that every motion of the form expl ~ ~I@ can be thought of as screw motion
2. KINEMATIC CHAINS
er %
~ : A Kinematic Chain
orthogonal vectors at the tip of each member of the chain, it is not too difficult
to see that the euclidean transformation, which describes the position and orien-
tation of the (i+l) st triad in terms of the i th, is
exp @i
~hus,
• the triad fixed at the free end is related to that at the base by the product
T(81" 2''''er)=Ml(exPOl[2 r OJ
where the M. is the element of the euclidean group which mapS the coordinate
i
system at the end where it joins the (i-l) st element to the coordinate system
where it joins the (i+l)St°
It is easy to see that P(expM)P -I = exp(PMp-l), and, thus, we can use the
HI@I H2@2 Hr 8r
01,02 .... %) = Me e e
This product of exponentials formula not only applies to chains of the form shown
in Figure i, but also applies to mechanisms containing prismatic joints (see
Figure 2) if we allow the product to include generators of the translation
elements, i.e., factors of the form
124
element of the Lie group IE(3). Once a choice for the coordinate systems at the
beginning and end of the chain are made and a definition of which angles correspond
to O. = 0 is selected, those matrices characterize and are characterized by the
l
chain.
In view of the fact that ]E (3) is an algebraic group, it is possible to re-
express matters in such a way as to eliminate transcendental functions. Thus, we
can algebraically parameterize the one parameter subgroup as
-i 0 0 - x 0 x2+y 2 = i
exp e = ;
0 0 0 1
0 0 0 0
and, in a similar way, describe the general one parameter subgroup (= screw motion)
in purely algebraic terms. A basic problem in robotics is that of solving the
equation in ~ (3)
T = eXpHl81 ... expH6O 6
for the unknowns ei,82,...86, An interesting question arises in this regard. How
does the degree of this set of equations depend on the fixed generators
HI,H2,...H 6. This problem is studied in the thesis of Pieper [9 ], Chapter 3. An
even more relevant question is that of determining how the Galois group of these
equations depend on the choice of HI,H2,...H 6. This latter circle of ideas seems
The equations of motion for the rigid bodies, which make up a robotic manipu-
lator, can he deduced from classical physics. The equations of motion for the
motors, which move the joints, must combine with these to get the overall
description. However, there is a purely kinematical problem which is both con-
ceptually and practically significant and which may be considered independently.
The expression T(81,e2,...er) of the previous section defines a mapping of
M r into ~(3). The user of the robot would like to specify a path in E(3),
whereas the motors of the robot drive the joint angles 81,82,...e r. This means
that the robot should provide computational equipment to invert the mapping
T:IRr + ~(3). If a path is specified in IE(3), then finding a path in IRr which
generates it can be thought of as finding a "program," i.e., a sequence of moves
for the joint angles.
The paths in ~(3), which are required in robotic manipulation, may be very
complex; however, it seems that it is quite useful to understand how to solve the
above kinematical programming problem for curves in ~(3) which are constructed
from segments of one parameter subgroups in~(3), i.e., segments of the form
Of course, straight line displacements, rotations, screw motions, etc., are all of
this folm. For such motions, the kinematical progran~ing problem is that of
solving
<I I>
exp
0
~(t) M = Mexp H l O l ( t ) exp H202(t ) . . . exp H r O r ( t )
for Ol,e2...0 r.
Since it is not enough to simply solve this for one value of ~(t), it is
natural to use implicit function theorem ideas to find solutions in the neighbor-
hood of a given solution and in that way generate the joint angle program which
corresponds to a given choice of 4('). The obvious way to do this is to ask that
be differentiable and to generate the 6's by solving the differential equation
-H 0 +H @
T(t) = T(t) (Hr@ r + e r rHr_l~r_l e r r ) .
Such formulas have been found to be quite useful in various aspects of applied
mathematics. In this case, they yield a differential equation for the O's.
ii
i i 2 ~ = G(e)
1 61
@2
e6
H -H
we need to simplify expressions such as e r rH ie r r The main tool here is
r-
the Baker-Campbell-Hausdorff formula
where [A,B] = AB = BA. As was emphasized by Wei and Norman [4], repeated use of
this formula allows one to find the matrix G(@).
If the matrices HI,H2,...H 6 are independent elements of the Lie algebra of
IE(3), then G(0) will be invertible for 0=0 and some neighborhood about 0=0: in
fact, the set of @ for which G(8) is not invertible will have measure zero.
However, there will, for topological reasons, always be points such that G(0) is
singular. Near these points, moderate values of ~ may call for very large values
of @, values which cannot be achieved. Thus, the singularities of this map are
quite significant.
Turning now to the case where r exceeds 6, we have the problem of solving the
above equation, ~ = G(@)0, with G(8) being rectangular. In view of the fact that
large values for 8 may be difficult to achieve, it is not surprising that there
have been experiments which use the Penrose inverse G(0) # to get a solution, thus
selecting the solution 0 of minimum length. Despite the attractiveness of this
approach, it can lead to problems. For example, typically robotic devices repeat
the same task time after time. That is to say it needs to repeatedly traverse a
127
does a closed path in ~ (3) generate a closed path in IRr? Geometrically speaking,
this is a question about the integrability of the distribution in IR r defined by
Range G(0) #. If this distribution is integrable, then the Penrose inverse approach
will map closed curves in ]E(3) into closed curves in IR r, otherwise it will not.
One can see from the literature [6] that the generalized inverse techniques need
not map closed curves into closed curves.
128
HI@ I H @
T(t) = Me e r r
how many parameters does it take to give an intrinsic characterization for the
chain? In view of the arbitrary choice of coordinates with which we describe T,
we see that M is not intrinsic and can be ignored in a parameter count. From the
fact that we can replace 8 i by ~iOi + ~i' it appears that an r-link chain should
REFERENCES
[2] Michael Brady, et al., Robot Motion: planning and Control. Cambridge,
Mass.: MIT Press, 1982.
[4] J. Wei and E. Norman, "On the Global Representation of the Solutions of
Linear Differential Equations as the Product of Exponentials."
Proceedinss of the America nMathematieal Society, 1964.
[6] C. A. Klein and C. -H. Huang, "Review of Pseudoinverse Control for Use with
Kinematieally Redundant Manipulators," IEEE Trans. on S~stems~ Man~ and
Cybernetics, Vol. SMC-13 (1983) 245-250,
[i0] R. W. Brockett, "Linear Feedback Systems and the Groups of Lie and Galois,"
J. of Linear Algebra and Its Applicati0n_s, Vol. 50 (1983) 45-60.