Professional Documents
Culture Documents
OF ROBOTS
Figure 1
The joint variable j will be given as :
qj = U
j j
e +U
jrj n
where : u.=O for j rotational, uj=1 for j ri = k=i+((OMk-*Pi)x mk.0ao).0ai.g
translational, EChd Uj = ( 1-U ) . 1
We define also : x denotes the vector product.
q.=a-f3.+a.r.
3 3 3 3 3
It is to be noted that frame 0 can be
defined such that zo is along z1, and XQ is along
x1 when 1'0, so al=0, d -0 q 0, while frame
n can be 2efined such tha$-qL=d=[l].
1033
2- Since the parameter dj represents a
This torques modify the correspondent translation along xa-1. The column
geometric parameters such as : corresponding t o dj in th&Jacobian matrix Will
be given as :
ai = ai + K,i.Ti
"j-I
pi = pi + Kpi.Ci (3)
Jdj= I o
ei = ei si.ri
4-
~ OT~.~T~...~-~T,
O T = 5- Since the parameter p . represents a rotation
around the yj axis, we gdt :
Assuming the errors of first order,
location errors of the robot tool frame dues to
the errors in the geometric parameters can be
approximated as : I "j-1 I
All the vectors appearing in equations ( 5 ,...,9)
must be referred to the measuring fixed frame.
So we need to calculate the vectors s a , n . ,
referred to the fixed frame? Th Ae
where : %t$j '?an be obtained from the matrices %'.
o=O, ... n). The vector L. will be obtained ad
- D is the (3x1) translational differential pn-Ob. . These matrickSn can be calculated
vector ofnthe tool frame. symbol$cally or numerically. The numerical
- 6 is the (3x1) rotational differential calculation is general and preferred for the off
vector or the tool frame. line identification especially if B cannot be
- B defines the errors in the robot considered as first order and iterative
parameters. calculation is investigated to identify it. The
- J, is the extended jacobian matrix. symbolic calculation will be more efficient,
from the computation cost point of view, for
4.2 - DEFINITION OF THE JACOBIAN the correction problem.
MATRIX
Only the equations corresponding to the
4.2.1. GEOMETRIC PARAMETERS. The position error D,, on sufficient number of
calculation of the columns of extended jacobian points, are used in the identification process.
matrix can be calculated directly as follows [8] The solution of the corresponding system of
equation, represented by the first three
equations of relation (4), is obtained by a
1- Since the parameter a . represents a rotation classical least squares method.
around the x. 1 axis (of3unit vector s--1). The
column corr&ponding to a j in the jacobian 4.2.2. GEOMETRIC AND NON GEOMETRIC
matrix will be given as : PARAMETERSDue to the equation (2,3) using
the equations (5,..,9), the columns
corresponding to the non geometric parameters
are given by :
1034
and the columns corresponding to the steady state errors, friction and the dynamic
geometric parameters become : effects on the robot links.
5.2 PRECISION OF THE GEOMETRIC
Jej= Jej(1 + Sj-Jrj) CONTROL SYSTEM
When the robot is under a geometric
Jaj= J , j ( l + Kaj J T j ) control, the positionning software must
transform the analytic orders (positions and
Jpj' Jpj(1 + Kpj-JCj) orientations) into joint orders. Even if the
geometric parameters of the robot are well
known, roundoff errors and errors due to the
Where Jrj - 6ri encoder resolutions may occur. So these errors
68j constitute a new cause of the robot
positionning uncertainty. The value of this
JTj = uncertainty is obtained using a simulation
6aj program.
Jcj = 5.3 LIMIT OF ABSOLUTE ACCURACY
68j The sum of the tool location errors
defined in 5.1 and 5.2 is used to express the
limit of absolute accuracy of the robot.
4.2.3. IDENTIFIABLE PARAMETERSK a
column of the jacobian matrix is a linear This limit includes the real behaviour of
combination of some other columns, the the robot (with friction, dynamic...) and the
corresponding error parameter can not be influence of geometric uncertainties wich can
identified. In this case, this parameter error is not be defined in the identification model of
forced to zero and his identification is carried the calibration.
out through the errors on the other
parameters. The combinations are obtained on This limit constitutes the purpose to
a case by case study. attain during the calibration process.
From section 2, when z . - ~and z. are 6 - EXPERIMENTATION AND RESULTS
parallel, the additional parameder p . muht be
introduced. In this case, we remard that the Experimental results are carried out on a
errors on r. will not be calculated because it is TH8-ACMA robot, wich is a six degree of
in the samb direction of ri-l. So the maximum freedom robot of cylindrical type (figure 2).
nomber of geometric errors is 4 and the
maximum number of non geometric errors of 6.1 INSTRUMENTATION
each frame is 3. The instrumentation is based on the use
of two theodolites and a cylindrical tool fixed
As a conclusion the definition of the on the robot terminal link. The coordinates of
geometric and non geometric parameters of an the robot point tool is determined with an
n link robot will need a maximum number of accuracy about &0,02mm/m. The point tool is
7.n independent parameters. materialized by a 2 mm diameter sphere. The
dimensions of this tool are measured with
precision.
5 - THE LIMIT OF ABSOLUTE ACCURACY
6.2 MEASUREMENTS
To perform an analytical programming, The measurements are expressed in the
the robot needs to use two types of elements : robot fixed frame to satisfy the definition of
the identification model (4). The location of the
- the positionning control system of robot fixed frame with respect to the
the joints, theodolites frame is obtained by using a lot of
- the geometric control system wich specific procedures [9]. In the case of the TH8
contain the robot model. robot, this location is defined as follow :
The limit of the robot accuracy depends - axis Z is the perpendicular on the
on the limits of these two elements. circular plane h t a i n e d by rotating joint 1.
- axis YO is obtained by identifying the
5.1 PRECISION OF THE POSITIONNING translation of joint 3.
CONTROL SYSTEM - the origin of the frame is the center of
This Drecision is defined bv the the circle during the rotation of joint 1 (other
repeatability-of the robot wich charactehze the robot joints on their position of geometric
behaviour of the robot mecanics under control. initialisation).
Measured using the I.S.O. TC 184/SC2
specifications, the repeatability includes The measurement points are divided in
1035
the complete volume of work of the robot. A
total of 48 configurations are obtained from Two identifications are carried out.
significant displacements of the robot. For each Including only the geometrical parameters, the
of them, the values of the joint encoders and first calibration permit to obtain an accuracy
the corresponding coordinates of the tool point about 0,69 mm with a standard deviation about
are recorded. The measured absolute accuracy 0,34 mm. The second calibration includes the
before calibration is 2,82 mm in average with a geometric and non geometric parameters. The
standard deviation about 0,88 mm. obtained accuracy is about 0,58 with a
standard deviation about 0,21 mm. The values
6.3 LIMIT OF ABSOLUTE ACCURACY of the correspondent parameters errors are in
The repeatability of the tested robot is the following tables :
about 0,3mm. Identification of geometrical parameters:
The resolution of the encoders is about frame P a d e r
0,l mm and 0,12 mm for the translation joints
and between 1.10-2 and 2.10-3 degrees for the 1 0 0 0 0,015 0
revolute joints. Dimensional parameters are I I I I I I I
1 E E I I E E E E frame P a d e r
2 I I E E I E I I 1 0 0 0 0,014 0
0,076 3 I 827
and
frame
Ke Ka Ks
1 0 0 0
2 0 0 0,021
3 0 0,076 0
6
0,'006
0
0
1036
by calibrating the geometrical parameters is
near to the limit of the absolute accuracy of
;the robot. The accuracy is improved by the
complete" calibration wich permit to obtain a
result comparable to the limit of absolute
precision of the robot. All these identified
values ma be used in an compensation
algorithm [& to correct the robot.
7.CONCLUSION
This paper presents a general calibration
procedure wich take into account geometric
and non geometric parameters of robots. The
limit of absolute accuracy is defined as the
limit to attain by the identification.
Experimental results are applied on a six
degree of freedom robot including revolute and
prismatic joints. The improvements permit to
obtain an accuracy value comparable to the
limit of the robot.
REFERENCES
[ I ] W.KHALIL, J.F KLEINFINGER, "A new geometric
notation for open and closed boop robots", Proc. IEEE
Robotics and Automation Conf., San Francisco, 1986,
pp.1174-1180.
1037