Electricity: motive power systems – Positional servo systems – Program- or pattern-controlled systems
Patent
1995-01-12
1995-11-14
Ip, Paul
Electricity: motive power systems
Positional servo systems
Program- or pattern-controlled systems
318571, 318572, 318573, 36447429, 36447430, G05B 1900
Patent
active
054670039
DESCRIPTION:
BRIEF SUMMARY
TECHNICAL FIELD
The present invention relates to a control method and a control unit for an industrial robot which detects an operation line position by using a sensor and corrects a taught path by using an output signal from the sensor to perform real-time tracking of the operation line.
BACKGROUND ART
Conventionally, in performing various operations such as welding, painting, cleaning, energy beam radiation and machining using an industrial robot, a position of operation line is detected by a sensor supported on a robot hand and a path taught through on-line or off-line is corrected based on a signal from the sensor, to control the robot so that the actual tool path conforms with the ideal path. The work lines include a characteristic line capable of being identified by a sensor such as a weld line formed on a workpiece (for example, a boundary line formed by the difference in height between two workpieces to be welded) formed on a workpiece and a contour line of workpiece. The aforementioned sensor may be of a type such that the operation line position is detected by deflecting laser beam.
As a typical example of the application of such control method, the real-time tracking of weld line is known. The conventional procedure of real-time tracking control includes the following steps: first, the sensed data representing the weld line is acquired by the sensor, the acquired sensed data is converted to coordinate data on the coordinate system set on the robot, and the data converted into coordinate data is stored in memory means. When the tool tip point almost has approached the sensing position of a sensor, the coordinate data is read, and it is compared with the position data (interpolation point position data) of corresponding taught path segment to calculate an amount of correction .DELTA..
In the state in which the tool tip point has reached a position close to the subsequent taught point, the sensing region of the sensor has already advanced beyond the taught point, and has entered a region in which the weld line corresponding to the next taught path segment is present. At this point, to execute the above calculation processing by reading the data stored in the memory means, the time available for reading position data of the next taught point and for the subsequent interpolating calculation processing (calculation processing to determine the data of the next taught path segment) is not ample enough.
That is, when the tool tip point approaches the weld line corresponding to the next taught path segment, in order to determine the amount of position correction .DELTA., it is necessary to calculate many interpolation point position data of the next taught path segment and to perform, in advance, processing for providing correspondence to the data read from the memory means. Therefore, the total processing load including the calculation of position correction amount .DELTA. following the above processing and the calculation processing of target position based on the position correction .DELTA. becomes very high, so that it is difficult to issue the target position command timely before the tool tip point reaches the next taught point in order to control the robot so that the tool tip point is surely ready for tracking.
The above-described problem of the prior art is not limited to the welding work in which the weld line is tracked, but is commonly encountered when work is done in a fashion that a robot is moved while correcting the target position with respect to the taught path by using the result of sensing within the region in the tool travel direction.
DISCLOSURE OF THE INVENTION
An object of the present invention is to achieve accurate tool path correction by effectively using sensed data obtained by a sensor in a region beyond a taught path segment to which the current position of tool tip point belongs. In other words, the present invention is intended to achieve accurate tool position correction even in a region near each taught point for a robot with a sensor which is used, for example, wh
REFERENCES:
patent: 4575791 (1986-03-01), Schwefel
patent: 4689756 (1987-08-01), Koyama et al.
patent: 4700314 (1987-10-01), Kinoshita
patent: 4755927 (1988-07-01), Kishi et al.
patent: 4833381 (1989-05-01), Taft et al.
patent: 4949271 (1990-08-01), Seki et al.
patent: 4961150 (1990-10-01), Seki et al.
patent: 5072088 (1991-12-01), Watanabe
patent: 5204599 (1993-04-01), Hohn
patent: 5210697 (1993-05-01), Kawanabe
patent: 5383131 (1995-01-01), Itamoto et al.
Kobayashi Eiichi
Kosaka Tetsuya
Fanuc Ltd.
Ip Paul
LandOfFree
Control method and control apparatus for a robot with sensor 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 and control apparatus for a robot with sensor, we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Control method and control apparatus for a robot with sensor will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-1223385