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/6/1/59.refs.html
What is This?
Abstract 1. Introduction
A new, explicit, and complete formulation that describes the An industrial robot is an assembly of sequentially
geometric errors due to both origin translation and misalign- linked components capable of executing a variety of
ments of axes in the positioning of an open-loop robot ma-
industrially useful mechanical tasks under program
nipulator has been presented. The formulation does not use control. The most proximal component of the robot is
the usual Denavit-Hartenberg approach. The results clearly
generally a base firmly fixed to the ground. The most
display the role of each quantity involved and allow easy distal component (the end effector) is typically a grip-
physical interpretation of each error term. First, a general
per. Accurate positioning and orientation of this end
kinematic formulation for an ideal robot with an arbitrary
number of links is developed. The geometric errors in axes effector is vital to the usefulness of the robot. Although
locations and orientations are then shown to be skew coordi- the robot is usually manufactured and assembled with
nate transformations with origin translations and are incor- great care, numerous unavoidable sources of error
porated into the analysis using general tensor algebra. The introduce various degrees of inaccuracy in the posi- _
final forms of forward and backward transformations contain tioning and orientation of the end effector. Errors in
up to 9 (N + 2) error parameters for a robot with N physical axis alignments, axis locations, and scale alignments
links. This theoretical formulation is applied to a specific are some of the factors that may contribute to the
.-
six-degrees-of-freedom robot. It is observed that of the possi- inaccuracy in the robot’s final position. By their very
ble 72 errors in this robot, only 53 can independently contrib-
ute to the error at the end effector and are the only ones that
nature, these errors cannot be measured directly but
need to be inferred from a set of carefully made mea-
can be determined by measurements made at the end effec-
tor. It is shown how a correlation matrix analysis can be
surements. In this communication we develop a fairly
used to isolate these 53 parameters. In addition. it is shown general approach to error characterization and present
how, using a successive orthogonalization technique, one can a systematic procedure to calculate the magnitude of
eliminate from consideration error parameters (eight in the these errors. Once the error parameters are quantita-
present case) that are too small to be significant but contrib- tively identified, the software controlling the relative
ute to the ill-conditioning of the coefficient matrix. Applica- motions of the robot linkages can be appropriately
tion of the procedure to computer-simulated data shows that modified, and the robot can then be used to more ac-
the formulation and the numerical techniques developed here curately position and orient the end effector on demand.
combine to form a powerful method to calibrate a robot.
The kinematics of robotic motion can be studied
using a series of successive coordinate transformations
(Paul 198 1). In a typical robot arm, the axes of rota-
tion of successive links are perpendicular to each other.
The axes of translations, if any, are either parallel or
perpendicular to the axes of the preceding links. The
successive transformations are therefore easy to for-
mulate. When the axes of rotation or translation of
successive links are neither parallel nor mutually per-
59
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
~’ig..~. A sequence of nomi-
nal coordinate systems at-
tached to various links of a
robot.
addition, the formulation is easy to implement and to links. There are therefore a total of N + 1 joints; how-
verify by experimental evaluation. Among some other ever, motion of the arm can be articulated only
works addressing the question of error analysis in ro- through N of them. The amount of articulation of link
botics are those of Chen, Wang, and Yang (1984); Wu I.at joint i relative to link 1 1 is the value of the ith
-
(1984); and Mooring and Tang (1984). joint variable. The geometry of the robot can be de-
scribed by means of successive forward and backward
transformations among the N + 2 link coordinate
2. Coordinate Systems systems, which are functions of the joint variables.
2.1. INTRODUCTION
2.2. TRANSFORMATION BETWEEN TWO NOMINAL
Consider a robot arm consisting of N physical links COORDINATE SYSTEMS
connected in an open-loop configuration with a Carte-
sian coordinate system xk (k = 1, 2, 3), with origin at Let (i i I, ¡Î2’ i3) be an orthonormal triad of unit vec-
~A, af6xed to the ith link (Fig. 1). We designate the tors defining the (; x 1, ; x2 , ; x3 ) coordinate system and
; xk system as the ith nominal system and orient it so (i+I1 L a i+l I2 ~ i+lÎ3) their counterparts in the C+IX¡,
that one of the axes is either along the nominal axis of i+lX2, i+lX3) coordinate system. Let the two sets of
rotation (for a revolute joint) or the nominal axis of unit vectors be related as
translation (for a prismatic joint). We also assume in
the case of a revolute joint that the other two axes are
aligned nominally with the 0° and 90° angular marks.
In addition, we designate the end-effector coordinate
system by N+ 1 xk and identify it as the N + 1 link and
designate the world coordinate system as OXk and iden- In Eq. (1), we have used the familiar summation
tify it as the zero link. We thus have a total of N + 2 convention whereby summation over the full range of
60
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
a suffix subscript or a suffix superscript (but not a where 6*~~~ is the Kronecker delta. Equations (2) and
prefix subscript or superscript) is implied when the (10) also imply that
suffix is repeated once. This convention will be used
throughout.
From Eq. (1), it follows that
Equations (7) and (9) are standard Cartesian tensor
transformation formulas extended to incorporate an
origin shift.
Note that ’+; Tkm is the km element of the matrix of
direction cosines relating the orientations of the two
coordinate systems. 2.3. COMPOUND TRANSFORMATION FOR THREE
Referring to Fig. 1, we let P be a point with coordi- ADJACENT LINKS
nates xk (k 1, 2, 3) in the i Xk system and t+,xk
=
or equivalently,
61
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
Fig. 2. Geometry of a skew
coordinate system ~k. Ø3! is
the angle between the ~j axis
and the Cartesian x, axis.
where
and
i=ii
3. Geometry of a Skew Coordinate-System reciprocal with itself.We may, however, define an-
other triad el of contravariant base vectors reciprocal
The preceding treatment was based on the assumption to the triad ek through the relation
that the nominal Cartesian coordinate systems ;xk
used to define various links were perfect: that is, the
coordinate axes truly intersected at a point and were
mutually orthogonal. In reality this cannot be expected From Eq. (20), we see that e’ is perpendicular to both
to be the case and the true axes will in general be e2 and e3 . Similar relationships hold for e2 and C3.
shifted and skewed relative to their assumed positions. Note that ek are directed along the coordinate axes and
The study of such skewed coordinate systems is sim- ek are directed along normals to the coordinate planes.
plified by the use of general tensor algebra (Synge and Let
Schild 1949; Sokolnikoff 1964). To facilitate later
development of the coordinate system error analysis,
we first develop a few relations needed in the treatment
of skew and &dquo;slightly skew&dquo; coordinate systems.
Consider a Cartesian coordinate system xk (k 1, =
denote the transformation expressing the coordinates
2, 3) and a skew (nonorthogonal) coordinate system çk xk in terms of Çm. Let us assume that the determinant
(k 1, 2, 3), both with the same origin as shown in
=
~axk~a~m~ ~ 0, thus guaranteeing the existence of the
Fig. 2. Let ik = ik be a unit triad of Cartesian base inverse transformation
vectors along the xk axes and ek a unit triad of covar-
iant base vectors along the çk axes. Note that the latter
triad is in general not orthonormal and hence is not
62
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
From Eqs. (21 ) and (22) we have Fij also) are independent. Equivalently, Eq. (28)
states that any six of the angles okm may be chosen as
independent quantities and the remaining three ob-
tained in terms of them. We shall choose the ~km for
k # m as the six independent quantities.
Of particular interest in the present work is the case
of a slightly skew coordinate system. In this case, the
matrix Fkrn is very close to a unit matrix and the ele-
ments H Ian of the matrix defined as
point P’ an infinitesimally small distance away from lently, the angles akrn, defined as
P, then
If Eq. (21) is linear (with or without a constant Thus, ak, 0 for all k and m. Using Eqs. (27-31), we
=
term), Fkm is a constant matrix. This is the case for a can show that
skew Cartesian system. In addition, if the constant
term is absent, that is, the coordinate systems have the
same origin, the transformations embodied in Eqs.
where ~krn is the angle that the çk axis makes with the
x,,, axis (see Fig. 2). Equation (27) also states that the
elements of the kth column of the matrix Fmk are the
To the same degree of approximation as embodied in
Eqs. (32-35), we also find from Eq. (29) that
Cartesian components (the direction cosines) of the
vector ek. Since lekl 1, we have the three relations
=
63
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
Fig. 3. A shifted and tilted
axis, ç3.
tigate the errors caused by these geometric aberrations where (0, x 12, x,3 ) and (x2, , 0, x23 ) are points of in-
in terms of the true representation of the position of a tersection of the xi and axes with the X2X3 and
point. x I X3 planes, respectively; el and e2 are unit vectors
Consider the situation shown in Fig. 3 where the x33 along the new directions çl and (2 of the xl and x2
64
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
Fig. 4. Three shifted and
tilted axes.
Hkm is given by Eq. (32). The six terms Hk&dquo;~ and the
three terms Qk represent a total of nine possible errors
present in each coordinate system.
Equation (48) is the transformation equation be-
tween the actual skew coordinates Çm and the nominal
Cartesian coordinates xk, with the vector dk defining
an effective origin shift. Note that six components xij
of the three axis shifts appear in the final transforma-
tion only as the three sums given in Eqs. (49 - 51 ).
Equation (48) can be inverted to give
65
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
however, the resulting values are not the specified
values.
Consider the situation where a point with Cartesian
coordinates /1:k
is specified. If these coordinates are
used with base vectors ;ik, the desired physical point is
obtained. However, if the base vectors iek are used When Eq. (59) holds, Eq. (62) becomes, respectively,
with these coordinates, a point ¡ik ¡ek
is obtained in-
stead. From Eq. (26),
so we have
The products of Hkm and ask terms can be neglected in which can be used in Eq. (67) to give
comparison with the first-order terms.
The resulting coordinates ~+1 xk
in the i + 1 coordi-
nate system can now be computed as
66
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
This is the inverse transformation corresponding to which can be combined with Eq. (71 ) to give
Eq. (58).
Note that Eqs. (60), (61), (63), (64), (67), and (69)
are valid only when Eq. (59) holds.
In the following section we concentrate on com-
pounding transformations embodied in Eqs. (58) and
.. R
(69). Forms involving xk coordinates can be obtained
from the results by using an appropriate single trans-
formation in conjunction with the compound trans-
formations.
i+’.11 and t+i~m are given by Eqs. (65) and (66) and
way to incorporate error terms associated with the last We have used the equality
coordinate system in a compound transformation.
The counterpart of Eq. (61) for the i + 3 coordinate
system is
67
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
and the definitions
and
(80) thus represents four equations with different be the differences in the coordinates
lower and upper limits on the summations, depending lXp
of a point
upon whether or not the dependent and independent
with coordinates i,,,X,
obtained from Eq. (81 ) and the
coordinates ;xp obtained from the equation
variables are the specified (S) or the resulting (R) co-
ordinates in the i and i + n coordinate systems.
The inverse transformation corresponding to Eq.
(75) is
68
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
which is obtained by setting the Hp9 and ap terms to and need to be estimated experimentally. The experi-
zero on the right-hand side of Eq. (80). Equation (83) mentally obtained values for Hkp and Op can then be
is essentially the same as
are thus the errors in the
(19). The quantities Ep
E~q.
coordinates that would
used in Eq. (81 ) to compute the values for aof ¡lp
xp choice of a set of joint variables and ;+nxm.
accrue if the H pq and (7p terms were not taken into In all, there are a maximum of 6(N + 2) nonzero
account. Note that Ep depends linearly on the
77~ and ;Hpq components and 3(N + 2) nonzero pp compo-
(Jp terms. Using Eqs. (81 ) and (83) in Eq. (82) yields nents. To obtain estimates of these quantities, actual
measurements must be carried out on the robot in
question. A typical observation, for example, would
consist of accurately measuring the world coordinates
01 p of a point with known end-effector coordinates
N+, xP. Subtracting from oxp the corresponding oXp
values computed from Eq. (83), three values of oEp can
be obtained from each observation. Thus, in general a
minimum of 3(N + 2) observations would be required
After some algebraic manipulations, Eq. (84) can be to compute the 9{N + 2) error parameters. In practice,
rewritten as however, one would use a much larger number of
carefully chosen observations, from which a multiple
linear regression analysis would be used to obtain an
estimate of the 9(N + 2) error parameters and their
statistics.
where
The workspace of the robot can be covered either by
a systematic scanning of the space of joint variables or
N + 1. For this case, Eqs. (85 - 87) become, respectively, 8. Specialization of Theoretical Results
The errors o€~,, which are associated with a choice of articulation is a linear arm extension 3W, L3 (1600 =
N+l Xm coordinates and a set of joint variables, can be mm ~ L3 ~ 2900 mm) along the 3x, axis. A three-
calculated if the values of H~ and ap are known. In an degrees-of-freedom wrist is attached at the extremity
uncalibrated robot, however, Hkp and (Jp are unknown of the arm and has the following degrees of articula-
69
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
Fig. 5. A. Conflguration of
the six-degrees-of freedom
robot. B. Definitions and
orientations of the coordinate
systems.
70
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
where ., xm
are the coordinates of a point defined in
the end-effector coordinate system.
For a set of M/3 end-effector positions, Eqs. (91-93)
form a system of M equations relating the M measured
errors a~p with the 72 possible geometric errors: 24 ds
where
and 48 I~’s. See Eq. (48). The quantities T and w ap-
pearing in Eqs. (92) and (93) are given by
When all the errors are zero, Eq. (96) becomes where k and m take on their values as indicated for
Eq. (102). The right-hand sides of Eq. (104) are related
to the solution vector E by Eq. (101).
In general the number of measurements made will
be such that M > 9(N + 2) and the system of equa-
Using Eqs. (38) and (39) in Eq. (11) yields the fol- tions given by Eq. (100) is overdetermined, requiring a
lowing system of equations solution in the least-squares sense. Thus, from Eq. (100),
given by
71
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
9. Solution of Eqs. (105) and (106) matrix C in such a manner as to obtain another M by
54 matrix whose columns are orthogonal to each other
Calibration based on the measurements made at the (Draper and Smith 1981 ). This orthogonalization
end effector only cannot reveal all the individual errors process transforms those columns that are almost lin-
Ej. This means that the columns of C are not all lin- early dependent on some of the preceding columns
early independent. Although for the particular robot into columns whose elements are 106 to 108 times
being considered one could determine those columns smaller in magnitude than those of all the linearly in-
that are linearly dependent using physical reasoning dependent columns. This procedure results in a well-
and the structure of the matrices given in the Appen- conditioned matrix from which the remaining Ek can
dix, we have selected a more practical and straightfor- be determined. For the robot under consideration, the
ward mathematical approach: correlation matrix anal- following additional eight error terms were also re-
ysis of CTC (Draper and Smith 1981). moved from the analysis:
Following the correlation matrix procedure, if any Skew Coordinate Axes Rotation Errors
of the off diagonal elements in the upper triangular
portion of matrix r are exactly equal to unity, then the E32 ~ < ~45 ~ E46 ~ E47
corresponding columns can be deleted from the analy- Skew Coordirtate Axes Shear Errors
sis as they are linearly dependent on a previous col- Es9 ~ E6o ~ E7o 1i71
umn. Note that this correlation matrix has to be The removal of the above 26 error terms leaves 46
formed only once during a particular evaluation of a error terms remaining: 13 axes shifts, 15 coordinate
given robot. system rotations, and 18 coordinate axes shears.
When this correlation matrix analysis is performed For subsequent use we introduce a change in nota-
on the present robot configuration, it is found that we
tion to indicate the reduced error matrix E’, with ele-
can remove the following 18 error terms from Eq. (100):
ments F}. Each EJ is simply a sequential renumbering
of the remaining Ej. We now proceed with the numer-
Origin Shift Errors ical simulation of an experimental method that can be
Eb~ Es~ Elo, Ell, Ei2> ~i4~ E~6y E21, E22, Ez3a E24 used to determine the Ek.
Skew Coordinate Axes Rotation Errors
E3d ~ E34 ~ E38, E40 ~ E48 10. Computer Simulation of an Experimental
Skew Coordinate Axes Shear Errors Procedure to Determine E’
Ess ~i72
A stereotriangulation procedure (W. C. Haight, 1984,
Thus the number of error terms reduces to 54. To private communication) has been successfully used at
determine the correspondingjHkm, Eqs. ( 1 O 1 ) and the National Bureau of Standards to determine the
(104) have to be used. deviation of the true world coordinate location of a
Although this correlation matrix technique success- robot’s end point from its world location that was
fully removes those error terms that are identically computed assuming that the robot was error-free. The
coupled and can be explained on physical grounds (at procedure uses three manually operated, but computer
least after the fact), a second type of linear dependence read, commercially available theodolites with an on-
remains: numerical linear dependence. This type of line computer data reduction scheme to determine the
linear dependence could, for example, be the result of end points’ world coordinate locations. The theodo-
the individual elements of columns of C being very lites are focused on the tips of a star-like target shown
nearly equal. The determination and subsequent re- in Fig. 6 while the robot is immobilized. In the follow-
moval of these columns and the corresponding error ing computer simulation it is assumed that this mea-
terms is more difhcult. surement procedure is being used.
We have found that the easiest and yet the most First, in order to obtain a column matrix of physi-
effective method is to transform the reduced M by 54 cally reasonable values for E, a set of 46 random values
72
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
Fig. 6. One type of end
effector target used in pre-
vious NBS st.ereotriangula-
tion measurements on a
small robot.
11. Conclusion
73
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014
have not been incorporated in other formulations of Mooring, B. W., and Tang, G.-R. 1984. An improved
robot error analysis. method for identifying the kinematic parameters in a six
The transformation formulas developed here allow axis robot. In Computers in Engineering 1984, Vol. 1:
one to compute the world coordinates of any point
Advanced Automation 1984 and Beyond, ed. W. A.
with specified end-effector coordinates and vice versa. Gruver, pp. 79-84. New York: ASME.
These formulas also easily allow forward and back-
Paul, R. P. 1981. Robot manipulators: mathematics, pro-
gramming and control. Cambridge: MIT Press.
ward transformations from any one joint coordinate Sokolnikoff, I. S. 1964. Tensor analysis with application to
system to any other and can either include or exclude, geometry and mechanics of continua. 2nd ed. New York:
as desired, the error terms associated with either or
Wiley.
both of the initial and final coordinate systems. When and Schild, A. 1949. Tensor calculus. Toronto,
Synge, J. L.,
the geometric errors are not known, the formulation Canada: University of Toronto Press.
provides a direct and straightforward approach to Wu, Chi-Haur. 1984. A kinematic CAD tool for the design
estimate their magnitudes and associated statistics, and control of a robot manipulator. Int. J. Robotics Res.
using multiple linear regression analysis. 3(1):58-67.
The theory to characterize the geometric errors due
to axis shifts and axis misalignments was applied to a
Appendix: Elements of Transformation
specific six-degrees-of-freedom robot. Theoretically,
for such a robot, there can be up to 72 error parame- Matrices and Components of Origin Shift
ters. If calibration of the robot is based solely on mea- Vectors
surements made at the end effector, however, some of
the errors are coupled with other errors and cannot be
determined independently. Using a correlation matrix
analysis, it was possible to isolate the truly linearly
independent set of error parameters. Furthermore, be-
cause of the smallness of some of the remaining error
2:151-155.
Eng.
74
Downloaded from ijr.sagepub.com at Univ of Illinois at Chicago Library on December 8, 2014