Data processing: generic control systems or specific application – Specific application – apparatus or process – Robot control
Reexamination Certificate
2001-02-14
2002-02-05
Cuchlinski, Jr., William A. (Department: 3661)
Data processing: generic control systems or specific application
Specific application, apparatus or process
Robot control
C700S174000, C700S251000, C700S259000, C414S744400, C414S001000, C414S744400, C414S729000, C414S815000, C414S917000, C901S009000, C901S023000, C901S032000, C901S042000, C901S046000, C901S047000, C219S124340
Reexamination Certificate
active
06345213
ABSTRACT:
BACKGROUND OF THE INVENTION
1. Field of the Invention
The invention relates to a control method for an industrial robot, in the following a robot, for the reduction of the influence of temperature changes on the positioning and orientation accuracy of the robot hand, in the following termed the tool center point (TCP) of the robot.
2. Description of the Prior Art
In the following, positioning accuracy is understood to mean the property of the robot to position the TCP at a pre-determined spatial coordinate x, y, z.
Orientation accuracy is understood to be the property to orient the TCP at a respective pre-determined angle ∠x, ∠y, ∠z at the spatial coordinate x, y z.
As accuracy requirements increase and stable and rugged process procedures are required, high demands come to be made with respect to the positioning and orientation accuracy. Particularly when a robot is in permanent operation, a drift in positioning and orientation accuracy can be determined whose cause is thermal sources which produce a deformation in the kinematic chain of the robot.
For technical reasons, it is not possible to completely prevent the temperature influence on the kinematic chain, since the drive assemblies of the kinematic chain generate heat under load, which results in changes in length and angle of the same in dependence on time. Nor can these effects be fully excluded by a thermo-symmetrical design.
To reduce positioning and orientation errors which arise due to the effect of temperature, the attempt is known from the prior art to measure the current temperatures at pre-determined points of components at selected points of the kinematic chain of a robot and to use these temperature measurement values for the correction of the position of the TCP by means of a computer.
For instance, a device is described in DE 33 02 063 for the compensation of influencing variables in machine tools or measuring machines and in robots. It is proposed to measure practically all the influencing variables which occur, such as temperatures and loads, and then to superimpose correction values on them which had been previously determined for all these influencing variables in order to thus achieve a compensation of the positioning error caused by the influencing variables.
The basic inventive idea of DE 33 02 063 accordingly comprises determining each influencing variable using a measuring device suitable for this purpose, i.e. the influencing variable “temperature” is determined by means of a temperature measuring device, the influencing variable “deformation by loading” is determined using a force measuring device, etc.
The inventors of the present invention have found, specifically for the correction of positioning and orientation errors arising due to temperature influences, that the method proposed in DE 33 02 063 is extremely complex and often cannot be carried out in practice. It has been found that the instruction given in DE 33 02 063 to arrange temperature sensors at selected points of a machine (in this case a robot) does not lead to the desired result since no sufficient correlation can be made between the temperature measured at the robot and the positional shift of the TCP which actually occurs with respect to the desired value.
For this reason, this compensation philosophy was not pursued further by the inventors of the present method.
Further devices for temperature compensation are described in the following documents.
U.S. Pat. No. 4,668,157 discloses a robot with a device for temperature compensation. The calibration cycle is triggered when the temperature at pre-determined points of the arm elements of the robot reach a pre-determined value. In this method, the current temperature at a pre-determined point at the robot arm is also put into correlation with the positional shift of the TCP.
U.S. Pat. No. 5,400,638 discloses a device for the calibration of a robot where thermally invariable reference bodies are used. The thermally induced changes in arm length are determined using the least squares method, with changes in angle being neglected.
SUMMARY OF THE INVENTION
It is the object of the invention to further improve the positioning and orientation accuracy of a robot in order to eliminate the above-mentioned problems.
The basic idea of the invention comprises an exact measurement of the tool center point (TCP) being carried out, preferably in the whole working area of the robot, in a zeroth method step. Temperature changes in the working area and in the robot itself are largely avoided here. In this measurement, the robot moves very slowly so that little heat is generated by the driving assemblies and the temperature gradients are as low as possible. The measurement can be made, for example, using a high-precision laser distance and angle measurement system. The measurement is carried out such that a measuring point is moved to working area points and then the deviations of the positions and/or orientations of the measuring point are determined using the laser distance and angle measurement system, i.e. a nominal/actual comparison is made. The TCP can preferably serve as the measuring point. However, a different point on the kinematic chain can also be selected. The point must always be selected so that the positioning and orientation deviations of the kinematic chain with respect to the PCT can be determined with sufficient accuracy.
The positioning and orientation errors determined in this measurement are termed stationary errors. A stationary error model, which forms a first basis for the correction of the temperature-induced deviations, is developed by known mathematical methods from the measurement of a great number of spatial points in the working area.
In the first, i.e. the next, method step, the same spatial points are again moved to as in the zeroth method step, with in particular the movement speed being substantially increased, whereby heat is generated in the drives of the kinematic chain and said heat results in the translatory and/or rotary deviations already described of the measuring point from the nominal value. These deviations Au are also stored, with a thermal error model, which describes the respective current thermal state of the kinematic chain, being prepared using mathematical methods known to one skilled in the art.
The zeroth and first method steps are usually only carried out once or at fairly large intervals, in particular after repairs.
In the second method step, a first subset U
1
is determined from the set of spatial points measured. Only such spatial points are selected for this subset U
1
which have such a temperature drift behavior which is representative for the temperature drift behavior of all spatial points; i.e. the temperature drift behavior of a point from the subset U
1
is in each case in a predetermined proportion to the remaining spatial points. This predetermined proportion is determined in the next method step.
In the third method step, temperature-stable reference points RP
U1
are arranged at the spatial coordinates of the subset U
1
in the working area of the robot. A measuring device is fixedly arranged at the same position at the previously used measurement point and the positioning and orientation deviations of the measuring point are determinable with respect to the reference points RP
U1
using said measuring device. The measuring device is moved to the reference points RP
U1
between the working actions of the robot in accordance with a predetermined time sequence or predetermined criteria, with the current positional and orientation deviations being determined by means of a measurement of distance and angle from the respective reference point.
Temperature-stable bodies having measurement marks for the optical distance and/or angle measurement are used as reference points RP
U1
, for example. It is necessary to select those spatial points from the plurality of determined representative spatial points, which are suitable as reference points RP
U1
, at which the temperature-stable bodies do not impede the movement area of
Graeser Ralf-Gunter
Klingel Robert
Cuchlinski Jr. William A.
Institut fuer Werkzeugmaschinen und Betriebswissenschaften TU Mu
Marc McDieunel
Young Brian N.
LandOfFree
Control method for an industrial robot does not yet have a rating. At this time, there are no reviews or comments for this patent.
If you have personal experience with Control method for an industrial robot, we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Control method for an industrial robot will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-2982010