A method for capturing accuracy and pose repeatability of articulated industrial robots

Recently, industrial*robots (IRs) have been

more and more used to realize continuous operations

such as prototyping, premachining of cast parts as

well as end-machining of middle tolerance parts [1].

In addition, for repetitive tasks such as placing,

welding, and assembling, the repeatability of IRs

typically ranging from 0.03 to 0.1 mm and their

several millimeters accuracy are commonly used.

Thus, measurement approaches for accuracy and

repeatability have been used for enhancing actual

robot positioning accuracy. Lombard and Perrot [2]

have implemented an automatic method to measure

robot accuracy. The most widely applied approach is

to use theodolite systems for calibration

measurements [3]. Another high precision devices

like Coordinate Measuring Machines (CMMs) have

been widely used for industrial dimension

measurement [4]. Laser Tracking Systems (LTS) [5]

can combine the advantages of a large working space,

high accuracy and dynamic pose measurements.

However, they are high cost, and hence it is

prohibitive to calibrate and measure robot poses with

low costs. A simple approach to measure an error

along a direction by a dial gauge has been discussed

in [6]. However, this could only give accuracy for

one direction. Using three dial gauge fixture for

industrial robots has been investigated in [7,8].

Herein, we employ a general low cost method with a

simple measurement fixture using three dial gauges to

capture the robot poses for robot accuracy evaluation

and calibrations. The measurement results show the

efficiency of the method.

A method for capturing accuracy and pose repeatability of articulated industrial robots trang 1

Trang 1

A method for capturing accuracy and pose repeatability of articulated industrial robots trang 2

Trang 2

A method for capturing accuracy and pose repeatability of articulated industrial robots trang 3

Trang 3

A method for capturing accuracy and pose repeatability of articulated industrial robots trang 4

Trang 4

A method for capturing accuracy and pose repeatability of articulated industrial robots trang 5

Trang 5

pdf 5 trang baonam 5900
Bạn đang xem tài liệu "A method for capturing accuracy and pose repeatability of articulated industrial robots", để tải tài liệu gốc về máy hãy click vào nút Download ở trên

Tóm tắt nội dung tài liệu: A method for capturing accuracy and pose repeatability of articulated industrial robots

A method for capturing accuracy and pose repeatability of articulated industrial robots
Journal of Science & Technology 119 (2017) 032-036
32
A Method for Capturing Accuracy and Pose Repeatability of Articulated
Industrial Robots
Duong Minh Tuan*, Le Duc Do
Hanoi University of Science and Technology – No. 1, Dai Co Viet Str., Hai Ba Trung, Ha Noi, Viet Nam
Received: December 21, 2016; accepted: June 9, 2017
Abstract
This paper presents a low cost method for measuring accuracy and pose repeatability of industrial robots,
which can be used for robot home calibration, accuracy improvements, robot control compensation or
evaluating robot features. The method is proposed based on the kinematical relations of the robot joints and
the geometrical data from the robot controller with respect to several defined coordinate systems. The
experimental setup consists of three dial gauges, capturing position measurements of a KUKA KR6/2 robot
end-effector. The positions of the end-effector are employed to estimate robot pose accuracy and
repeatability. Moreover, experimental results demonstrate the efficiency of the method and can be used for
improving the robot accuracy as well as robot pose repeatability in industrial applications.
Keywords: Pose Repeatability, Accuracy, Industrial robot, KUKA KR 6/2
1. Introduction
Recently, industrial*robots (IRs) have been
more and more used to realize continuous operations
such as prototyping, premachining of cast parts as
well as end-machining of middle tolerance parts [1].
In addition, for repetitive tasks such as placing,
welding, and assembling, the repeatability of IRs
typically ranging from 0.03 to 0.1 mm and their
several millimeters accuracy are commonly used.
Thus, measurement approaches for accuracy and
repeatability have been used for enhancing actual
robot positioning accuracy. Lombard and Perrot [2]
have implemented an automatic method to measure
robot accuracy. The most widely applied approach is
to use theodolite systems for calibration
measurements [3]. Another high precision devices
like Coordinate Measuring Machines (CMMs) have
been widely used for industrial dimension
measurement [4]. Laser Tracking Systems (LTS) [5]
can combine the advantages of a large working space,
high accuracy and dynamic pose measurements.
However, they are high cost, and hence it is
prohibitive to calibrate and measure robot poses with
low costs. A simple approach to measure an error
along a direction by a dial gauge has been discussed
in [6]. However, this could only give accuracy for
one direction. Using three dial gauge fixture for
industrial robots has been investigated in [7,8].
Herein, we employ a general low cost method with a
simple measurement fixture using three dial gauges to
* Corresponding author: Tel: 0947 036 686
Email: tuan.duongminh@hust.edu.vn
capture the robot poses for robot accuracy evaluation
and calibrations. The measurement results show the
efficiency of the method.
2. Method
The method and the experimental setup
including a KUKA KR6/2 (6kg of payload) robot at
the laboratory of Machine-Tools and Tribology are
presented in this section. To derive the accuracy and
the repeatability from the experimental data, the
coordinate systems must be defined for the proposed
measurement method. All coordinate systems are
depicted in Fig. 1. The world frame so-called w is
fixed. The User frame can be defined at an arbitrary
location in the robot cell (Fig. 2) with a designed
point of a working table as the origin of the frame.
The Tool frame has the origin at the Tool Center
Point (TCP), see Fig.1.
2.1 Principle for Robot Pose Measurements
KUKA Robot language runing on VxWork - a
real time operating system (parallel with Windows),
controls the robot. This can provide the position and
the orientation of the end-effector (Tool frame) via 6
articulated joint angles. Thus, the robot pose can be
displayed on the screen of the KUKA Control Panel
(KCP). For example, when the robot moves to a
specified location described by pose k for which the
pose variables are defined. That means that the pose
variables are determined by three position
components ( , y and z )k k kx and three orientation
terms, Yaw ( ),kA Pitch ( )kB and Roll ( ).kC As
illustrated in Fig. 1, the robot changes pose 1 into
Journal of Science & Technology 119 (2017) 032-036
33
pose 2, it needs a transformation matrix called 1 2T
and these poses are expressed in the World
coordinates defined by 1
wT and 2 ,
wT respectively.
Similarly, with respect to the User frame, one can
derive two transformation matrices for pose 1 and
pose 2 written as 1
u F and 2
u F , respectively. The
controlled transformation matrix from the World
coordinate system to the Tool one describing pose k
is evaluated as
1 1 2 2 3 3 4 4 5 5 6
0 1
w c w c
w c w k k
k k k k k k k
R p
T T T T T T T
, (1)
where w ckT is the transformation matrix from the
w frame to Tool frame of pose k; 1i ikT
 presents the
transformation matrix from joint frame i to joint
frame i-1, (i=1,2,,6); and w ckR is the controlled
rotational matrix from the w frame to Tool frame of
pose k calculated as
cos sin 0 cos 0 sin
sin cos 0 0 1 0
0 0 1 sin 0 cos
1 0 0
 0 cos sin
0 sin cos
k k k k
w c
k k k
k k
k k
k k
C C B B
R C C
B B
A A
A A
(2)
with w ckp is the controlled position vector
expressed in the w system reads as  Tw ck k k kp x y z .
Moreover, we obtain the relation for controlled
transformation matrices of poses 1 and 2 with respect
to different frames as seen in Fig. 1
1
2 1 2
w c w c cT T T  11 12 1 2c w c cT T T  . (3)
Consequently, the controlled transformation
matrix from pose 1 to pose 2 can be determined as
follows
1 1
1 2 2
2 0 1
c c
c R pT
, (4)
where 1 2
cR and 1 2
cp are the rotation matrix and
the position vector from pose 1 to pose 2 which are
used to evaluate the pose measurement data,
respectively. On one hand, the transformation matrix
from pose 1 to pose 2 is also calculated by the KRL
software using joint sensor measurements (in each
robot joint). On the other hand, the matrix is specified
by the commands in the robot program on the KCP.
The real or measured transformation matrix from
pose 1 to pose 2 can be computed as
1
2 1 2
u m u m mF F T  and 11 2 1 2m u m u mT F F  , (5)
1 1
1 2 2
2 0 1
m m
m R pT
, (6)
with 1 2
mR and 1 2
mp are the rotation matrix and
the position vector from pose 1 to pose 2,
respectively.
The robot absolute pose accuracy or the
positioning and orientation accuracy are defined as a
difference between the measured transformation
matrix 1 2
mT and the controlled counterpart 1 2 .
cT
Obviously, these matrices are independent on the
World and the User frames.
2.2 Experimental Setup
Fig. 1. Coordinate system definition
Fig. 2. Experimental setup for robot’s pose
measurements of KUKA KR6/2.
Fig. 2 shows the experimental setup for robot
pose measurements with a fixture supporting three
dial gauges with a specified space in which a tooling
cube (A=50mm, made of aluminum) attached to the
robot end-effector can be easily placed. The tooling
Journal of Science & Technology 119 (2017) 032-036
34
P
cube is fixed on the end-effector at the origin of the
Tool frame and three orthonormal faces with respect
to x , y and z axes are well calibrated. The three
dial gauges have resolution of 0.05 mm and their
stroke is of 18 mm. When the three orthonormal faces
of the tooling cube touch the tips of the gauges, the
slide rods of the gauges are depressed in the x , y
and z directions. If the movement range of the cube
is within the stroke, the dial gauges can directly
indicate the change of the tooling cube position. The
setup is fixed on the table and referred to the
reference plate (User frame).
2.3 Positioning Accuracy
The Tool Center Point can be measured. We call
a reference point on the gauge fixture is P with which
the TCP at pose k can be calculated by
1 1
2 2
3 3
(0.5 )
(0.5 ) ,
(0.5 )
k x
k y
k z
x P A M D
y P A M D
z P A M D
(7)
where ,kx ky and kz are the coordinates of the
TCP k with respect to the User frame. ,xP yP and zP
are the coordinates of the point P on the gauge fixture
which can be determined from measurement
dimensions as shown in Fig. 3. 1 ,D 2D and 3D are
the maximum travel limits of gauges 1, 2 and 3,
respectively.
Fig. 3. Dimensions of the experimental setup.
The measurement procedure of the TCP can be
addressed as follows:
At first, the robot moves to a designed pose k.
The tooling cube is installed on designed positions
1 ,P position. As the fixture moves so that the cube
touches the tips of the dial gauges generating 1 ,P 2P
and 3P points, then fixes the fixture in that place. The
indications of the dial gauges are recorded. The next
step is to measure and record the coordinates of point
P in Fig. 3. At last, the measures
xP , yP and zP are
substituted into Eq. (7). Therefore, the actual position
coordinates; u mkp ( , ,k k kx y z ) of the robot end-effector
with respect to the User is achieved.
2.4 Orientation Accuracy
To determine the orientation of the robot end-
effector, the dial gauges can be placed so that they are
not orthogonal together i.e. their axes do not intersect
into a point. Consequently, three measuring points
1 1 1 1 ( , , )P x y z , 2 2 2 2 ( , , )P x y z and 3 3 3 3 ( , , )P x y z create
a plane on which the orientation of the robot end-
effector is defined. By investing this plane for each
sample one can obtain the orientation of the robot
tool frame.
Mathematically, the plane passing the three
points is constructed and the 1 1 1 1 (x , y , z )P lies in the
plane yields the plane equation as
1 1 1( ) ( ) ( ) 0a x x b y y c z z , (8)
where a, b and c are the direction numbers of the
plane, respectively. On the other hand, the 2P and 3P
lying in the plane yields
2 1 2 1 2 1
3 1 3 1 3 1
( ) ( ) ( ) 0
( ) ( ) ( ) 0
a x x b y y c z z
a x x b y y c z z
. (9)
With three variables and three equations (8) and
(9), the system of equations is solved to obtain the
solution as
 
 
3 1 2 1 2 1 3 1
2 1 3 1 3 1 2 1
( )( ) ( )( ) ,
 ( )( ) ( )( )
a y y z z y y z z
x x y y x x y y
 (10)
 
 
3 1 2 1 2 1 3 1
3 1 2 1 2 1 3 1
( )( ) ( )( ) ,
 ( )( ) ( )( )
b x x y y x x y y
x x z z x x z z
 (11)
 
 
3 1 2 1 2 1 3 1
2 1 3 1 3 1 2 1
( )( ) ( )( ) .
 ( )( ) ( )( )
c x x y y x x y y
x x y y x x y y
 (12)
Thereby, the normal vector of the measured
plane can be evaluated by its cosines
 cos / ; cos / ; cos /m m mz z za q b q c q   , (13)
where 2 2 2q a b c . The direction vector
projected on z axis is
cos cos cosm m mz z zz l m h   , (14)
where , , andl m h are unit direction vectors of
the User frame. Similarly, the direction vector of the
O
X
P2
P3
P1
Z Y
D2
M2
M3D3
M1
D1 P
Journal of Science & Technology 119 (2017) 032-036
35
x axis is cos cos cosm m mx x xx l m h   when the
x axis passing 1P and 2P
2 1
2 1
2 1
cos ( ) /
cos ( ) /
cos ( ) /
m
x
m
x
m
x
x x r
y y r
z z r


, (15)
where 2 2 22 1 2 1 2 1( ) ( ) ( )r x x y y z z .
Therewith, the direction of y axis is computed as
cos cos cosm m my y yy z x l m h   .
The rotation matrix of the Tool coordinate
system with respect to the User frame reads as
cos cos cos
cos cos cos
cos cos cos
m m m
x y z
u m m m m
k x y z
m m m
x x z
R
  
  
. (16)
Consequently, we combine the position
measurement results and derive the actual or
measured transformation matrix from the User frame
k given by
0 1
u m u m
u m k k
k
R p
F
. (17)
Substituting u mkF into Eq. (5) the measured
transformation matrix 1 2
mF from pose 1 to pose 2 is
explicitly obtained in which both the robot position
accuracy and orientation accuracy are evaluated.
Thus, we can clearly define the accuracy of the robot
formulated as
1 1 1
2 2 2
1 1 1
2 2 2
c m
c m
R R R
p p p
. (18)
If we reset all measurements of dial gauges of
the pose 1 to zero then the robot pose repeatability
can be derived properly. The pose 2 of the robot is
repeatedly measured with respect to the pose 1 as the
reference for repeatability study. Thus the 1 2
mp is the
positioning repeatability and the 1 2
mR describes the
orientation repeatability of the robot.
3. Results and Discussion
This section describes the measurements using
the proposed method on the KUKA robot.
Experimental data obtained for 1 2
mp shows the
efficiency of the method. The KR 6/2 robot has the
repeatability of 0.1 .mm 1 2mp was calculated by
invoking the Eq. (18) and shown in Table 1.
Table 1. Positioning repeatability (mm)
Direction x Axis y Axis z Axis
Max errors 0.125 0.165 0.115
Min errors -0.145 -0.115 -0.170
Mean -0.025 -0.036 0.045
STD 0.045 0.036 0.069
The mean and the standard of deviation (STD)
of experimental data were performed for 48 samples
or 48 times. Obviously, Fig. 4 describes that the
current robot position repeatability is mostly inside a
sphere (radius of 0.1 mm as the specified
repeatability of the robot by KUKA Company). Of
course there are some experimental measurements
outside the sphere, larger than 0.1 mm. However, the
measurements are inside the sphere with 95% of
confidence (as the Gauss distribution).
Fig. 4. Measurements of repeatability.
The orientation accuracy represented by the
rotational matrix in (16) can be derived from the
corresponding triangle. As shown in Fig. 5, the
triangles connecting three measurement points
1, 2 3( , , and )P P P describe the orientation errors from
which orientation repeatability 1 2
mR can be derived.
Fig. 5. Orientation repeatability described as triangles
( 1, 2 3, , andP P P ).
With 48 samples for the robot pose we
computed the orientating repeatability as
Journal of Science & Technology 119 (2017) 032-036
36
0.031 0.002 0.257
1 0.002 0.031 0.022
2
0.00001 0.00001 0.031
0.646 0.0008 0.258
0.0008 0.646 0.455
0.00001 0.00001 0.645
mR
. (19)
These above values in (19) are Means and STDs
of each entry of the rotational matrix from pose 1 to
pose 2. It is obvious that the changes of the
orientation of the robot end-effector and positioning
repeatability are acceptable if the robot can be used
for material manipulating. In terms of operations with
continuous paths such as part machining the changes
in the orientation might be large and can cause
significant errors on machined parts.
The experimental results easily obtained from
the measurement approach with very low cost dial
gauge fixture. This setup can be successfully used for
large working space of IRs in robot cells or in
industrial applications. The equipment is very flexible
and be placed at anywhere the robot can reach for
experiments. The calibration of the gauges and fixture
can be done with ease. Therewith the method is
helpful for robot calibration at work. In addition to
that, the robot accuracy can be correctly estimated
with low cost.
Moreover, the pose repeatability can be easily
obtained from the method. The method helps evaluate
the robot accuracy and repeatability after long time
use. More importantly, based on the evaluation the
robot accuracy can be enhanced in order to be used in
high accuracy process such as robot milling.
Therewith the robot errors must be compensated by
improving the robot control model [9]. In addition,
the stiffness of the robot should be taken into account
since it strongly influences on the positioning
accuracy, in particular, for different poses and
positions in the IRs volumes. The larger distance of
the end-effector is, the larger deflection by the robot
end-effector becomes (lower accuracy) [10].
However, compared with the accuracy the pose
repeatability is less influenced by target location.
Thus, the repeatability is an important robot
characteristic. Herein, the load was neglected due to
the light tooling cube. Factors affecting the
repeatability will be discussed in the future work.
4. Conclusion
The study presented the low cost measurement
method in detail, which can be used for any type of
industrial robot topologies. Both pose accuracy and
pose repeatability can be obtained from the method.
Interestingly, with very low cost experimental setup
we were able to demonstrate that this approach is
successfully realized on this equipment with the
KUKA KR6/2 robot. The experimental data were
processed to compute the position repeatability and
orientation repeatability comprehensively. Therefore,
studying robot accuracy by this setup is convenient
and flexible, particularly in large workshops.
Furthermore, with the measured accuracy and
repeatability solutions to improve the robots can be
found, e.g. improving robot control laws with error
compensation. Thus the robot accuracy and pose
repeatability can be enhanced for continuous
operations.
Acknowledgments
This research is funded by Hanoi University of
Science and Technology (HUST) under project
number T2016-PC-058.
References
[1] J. Bauer, M. Friedmann, T. Hemker, Analysis of
Industrial Robot Structure and Milling Process
Interaction for Path Manipulation, Process Mach.
Interact. (2013) 245–263.
[2] J. Lombard, J.C. Perrot, Automatic Measurement of
the Positioning Accuracy of Industrial Robots, Ann.
CIRP, 32 (1983) 297–299.
[3] D.E. Whitney, Industrial Robot Forward Calibration
Method and Results, J. Dyn. Syst. Meas. Control 108
(1986) 1–8.
[4] B.W. Mooring and S.S. Padavala, The effect of
kinematic model complexity on manipulator
accuracy, Proceedings, 1989 Int. Conf. Robot.
Autom. (1989) 593–598.
[5] S. Decker, H. Gander, M. Vincze, J.P. Prenninger,
Dynamic measurement of position and orientation of
robots, IEEE Trans. Instrum. Meas. 41 (1992) 897–
901.
[6] G.C. Smith, R.A. Smith, A non-contact method for
detecting on-line industrial robot position errors using
a microwave doppler radar motion detector, Int. J.
Adv. Manuf. Technol. 29 (2006) 605–615.
[7] D.D Le, Investigation of robot repeatability of a
KUKA KR6/2, Thesis, Hanoi University of Science
and Technology (2006).
[8] W. Xu, J.K. Mills, A New Approach to the Position
and Orientation Calibration of Robots, Measurement,
(1999).
[9] B. Liu, F. Zhang, X. Qu, A method for improving the
pose accuracy of a robot manipulator based on multi-
sensor combined measurement and data fusion,
Sensors (Switzerland) 15 (2015) 7933–7952.
[10] M.T. Duong, X.T. Nguyen, Calculation method for
deflections of robot manipulators in loading
conditions, J. Sci. Technol. 64 (2008) 51–56.

File đính kèm:

  • pdfa_method_for_capturing_accuracy_and_pose_repeatability_of_ar.pdf