JPS61173878A - Individual-difference corresponding teach data correction system of robot - Google Patents
Individual-difference corresponding teach data correction system of robotInfo
- Publication number
- JPS61173878A JPS61173878A JP1422785A JP1422785A JPS61173878A JP S61173878 A JPS61173878 A JP S61173878A JP 1422785 A JP1422785 A JP 1422785A JP 1422785 A JP1422785 A JP 1422785A JP S61173878 A JPS61173878 A JP S61173878A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- data
- itv camera
- image
- teaching
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。(57) [Summary] This bulletin contains application data before electronic filing, so abstract data is not recorded.
Description
【発明の詳細な説明】
〔発明の利用分野〕
本発明はロボットシステムにおいてロボットかティーチ
データのプレイバックを行う際に、ロボット本体の移設
や個体差によるティーチポイントの変動を吸収すること
により、−良教示したデータの再利用、他のロボットへ
の移し換えを容易にする。[Detailed Description of the Invention] [Field of Application of the Invention] The present invention, when playing back robot teach data in a robot system, absorbs changes in the teach point due to relocation of the robot body or individual differences. Facilitates reuse of well-taught data and transfer to other robots.
従来、ロボットのティーチング/ブレイバックシステム
には次の様な問題点がある。Conventional robot teaching/breakback systems have the following problems.
(IJ ティーチングの難し嘔
(2) ワークの移動に対する非適合性(8ン ロ
ボットの個体差によるティーチデータの非互換性。ロボ
ットするいはワークの経時変化等によるティーチポイン
トの変動。(IJ Difficulties in teaching (2) Incompatibility with workpiece movement (8) Incompatibility of teaching data due to individual differences in robots. Fluctuations in the teaching point due to changes in the robot or workpiece over time.
ここで対象にするのは(3)である。The target here is (3).
従来、ロボットの個体差や経時変化等から生ずるロボッ
トの計算モデルと実世界のワールド座標とのすf′Lを
修正する方法について、精密機械49巻9号1)69〜
74におけるrscA凡人ロボット諸元のティーチング
による校正」において論じらnている。Conventionally, there has been a method for correcting f'L between the calculation model of the robot and the world coordinates of the real world, which arises from individual differences among robots and changes over time, etc., in Precision Machinery Vol. 49, No. 9, 1) 69-
It is discussed in ``Calibration by Teaching of Ordinary Robot Specifications'' in 74.
しかし、基準座標点の正確な位置決めの困難さ、ロボッ
トのライン停止による効率の低下については配慮さnて
いなかった。また、この方法は5CAILAロボツトに
ついて論じられておシ、機構の複雑な多関節型ロボット
については触れていない。However, no consideration was given to the difficulty of accurately positioning the reference coordinate point and the reduction in efficiency due to robot line stoppages. Furthermore, this method discusses the 5CAILA robot, but does not mention multi-jointed robots with complex mechanisms.
〔発明の目的〕
本発明の目的はロボットやワーク等の経時変動簀普によ
るティーチポイントのすnの修正、及びロボットの個体
差に起因する同一型ロボット間のティーチデータの非互
換性に対してこれらをコンピュータの利用により自動的
にティーチデータを修正、変換する手段を提供すること
にある。[Purpose of the Invention] The purpose of the present invention is to correct the teach point due to changes over time in robots, workpieces, etc., and to correct incompatibility of teach data between robots of the same type due to individual differences among robots. The object of the present invention is to provide a means for automatically modifying and converting teaching data using a computer.
前記目的を達成するため、本発明では通常のティーチデ
ータ以外にロボットとワークを含んだ重要箇所の画像デ
ータ及びITVの11f率、位置などの画像パラメータ
を記憶しておき、各ティーチ点ごとに記憶画像と現画像
か一致するよう、比較演算しこの結果よりロボットやI
TVt−動かして、ティーチ点を自動修正する。In order to achieve the above object, in the present invention, in addition to normal teaching data, image data of important locations including the robot and workpiece, and image parameters such as the ITV 11f ratio and position are stored for each teaching point. A comparison operation is performed so that the image and the current image match, and from this result, robots and
TVt-move and automatically correct the teach point.
以下、本発明を実施例により説明する。 The present invention will be explained below with reference to Examples.
第1図は、本発明によるロボットティーチングシステム
の一実施例のブロック構成図である。FIG. 1 is a block diagram of an embodiment of a robot teaching system according to the present invention.
通常のティーチングプレイバックシステムは、ロボット
2と、ロボット駆動系4、位置検出器50ボツト制御器
7と、ティーチデータの記憶器8から成る。本発明では
、これにITVカメラ1、ITVカメラ駆動系3、IT
■カメラ制御器6、画像比較演算器9を附加して、ティ
ーチングプレイバックシステムに個体差対bティーチデ
ータ修正機能を加えたシステムlOを構成する。A typical teaching playback system consists of a robot 2, a robot drive system 4, a position detector 50, a robot controller 7, and a storage 8 for teaching data. In the present invention, this includes an ITV camera 1, an ITV camera drive system 3, an IT
(2) A camera controller 6 and an image comparison calculator 9 are added to form a system 10 in which a teaching playback system is added with an individual difference vs. b teaching data correction function.
図中、101ti画像データ、画像パラメータ(ITV
カメラの位置や倍率など)、102はティーチデータ、
103t;[前記以外の制御信号やデータ(例えはCA
Dデータ)などの流f′Lを示す。In the figure, 101ti image data, image parameters (ITV
(camera position, magnification, etc.), 102 is teach data,
103t; [Control signals and data other than the above (for example, CA
D data).
第2図はロボットへのティーチング処理手順のフローチ
ャートである。ステップ21〜26は通常のティーチン
グプレイバックシステムである。FIG. 2 is a flowchart of the teaching procedure for the robot. Steps 21-26 are a normal teaching playback system.
ティーチングプレイバックシステムでは、ティーチング
ボックス等を使ってロボットを動かし22、ティーチ2
3を行う。ロボット2からのティーチデータ102とI
TVカメラlからの画像データ、画像パラメータ101
はそれぞれの制御器7.6を介して記憶器8へ記憶され
る24゜各ティーチ点についてこn’l繰返し一連のプ
レイバックデータとする。In the teaching playback system, the robot is moved using a teaching box etc. 22, and the teaching 2
Do step 3. Teach data 102 and I from robot 2
Image data from TV camera l, image parameters 101
This is repeated for each 24° teach point to form a series of playback data stored in the memory 8 via the respective controllers 7.6.
第3図は実際に本発明の方式にもとづく教示システムを
作動させるときのフローチャートである。FIG. 3 is a flowchart when actually operating the teaching system based on the method of the present invention.
41〜49はロボット制御器、50〜55は画像比較演
算器、56〜65はITVカメラ制御器の制御流れを示
す。41 to 49 are robot controllers, 50 to 55 are image comparison calculators, and 56 to 65 are ITV camera controllers.
ITVカメラ1を動かしティーチデータの修正を行う場
合(ステップ42,51.57)、まず基準画像を読み
出してITVカメラ位置の自己修正(ステップ58)を
行う。修正を行わない時は通常のプレイバックでロボッ
ト動作を行う(ステップ4B)。次にロボット、比較演
算器、ITVはそn−Hn最初のティーチポイントのテ
ィーチデータの読み出しくステップ43)、画像データ
の読み出しくステップ52)、画像パラメータの読み出
しくステップ59)をおこなう。ロボットはティーチデ
ータで与えられた点に移動しくステップ44)、ITV
カメラは読み出した情報からカメラの向き、倍率等を調
整する(ステップ60)。When moving the ITV camera 1 to correct the teaching data (steps 42, 51, and 57), first read the reference image and self-correct the ITV camera position (step 58). If no correction is to be made, the robot moves in normal playback (step 4B). Next, the robot, comparator, and ITV perform steps 43) to read the teach data of the first teach point, step 52) to read the image data, and step 59) to read the image parameters. The robot moves to the point given in the teach data (step 44), ITV
The camera adjusts its orientation, magnification, etc. based on the read information (step 60).
ITVカメラで撮影したくステップ61)画像デ−タ1
11は比較演算器に送られる。ここで画像を比較演算し
くステップ53)、ロボットの移動データ112、ある
いはITVの移動データ113を送る。基本的KtlI
TVは最初の基準位置設定の時以外は動か嘔ないが、微
調整で動かす必要かある場合はステップ63で行う。画
像が一致するまで比較演算、位置修正をくシ返し行う。Step 61) Image data 1 to take pictures with ITV camera
11 is sent to the comparison calculator. Here, in step 53), the robot movement data 112 or the ITV movement data 113 is sent to compare the images. Basic KtlI
The TV does not move except when the initial reference position is set, but if it is necessary to move it by fine adjustment, it is done in step 63. Comparison calculations and position corrections are repeated until the images match.
画像が一致丁nばティーチポイントの修正は終了する。If the images match, the teaching point modification ends.
この時のティーチポイントのティーチデータは新しい値
になっているのでこの更新値を改めて記憶器8に記憶し
直す。以上を各ティーチ点ごとに繰シ返す。Since the teaching data of the teaching point at this time is a new value, this updated value is stored in the memory device 8 again. Repeat the above for each teach point.
ロボットのハンド部の画像マツチングが重要である。い
まロボットハンド部の座標系Tを次の様n=ノーマルベ
クトル
0=オリエンテーシヨンベクトル
a=ニアプローチベクト
ル=ポジションベクトル
n、O,ah単位ベクトルでn=oxaの関係がある。Image matching of the robot hand is important. Now, the coordinate system T of the robot hand section is as follows: n = normal vector 0 = orientation vector a = near approach vector = position vector n, O, ah unit vectors and there is a relationship n = oxa.
例えば第1関節から順に流口、曲け、曲げ、振シ、ひね
りの5自由度多関節ロボットにおいて、各自由度に対す
る回転角度は次の様に求まる。途中式は略す。For example, in a five-degree-of-freedom multi-joint robot that has five degrees of freedom, starting from the first joint: opening, bending, bending, shaking, and twisting, the rotation angle for each degree of freedom is determined as follows. Intermediate formulas are omitted.
θ1 =tao−’ (p x/ p y ) (or
θl二〇t + 180°)ωSθ3 = (px”
+ py”−22” 73″) / 2 t2ts
(8)但し
px ’ =(AStllpz +sinθ1 pyp
1′=p藤、 t2 、 t3は第2.3アーム長(8
]式よりθ3が求まる。θ1 = tao-' (p x/ p y ) (or
θl20t + 180°)ωSθ3 = (px”
+ py"-22"73") / 2 t2ts
(8) However, px ' = (AStllpz + sinθ1 pyp
1'=p Fuji, t2, t3 are the 2.3rd arm length (8
] θ3 can be found from the formula.
02s4=tan−” (−(cosθla t +s
inθt ay)/ a−) (5)(5)式よ
り04が求まる
θ4=0234−02−03(6)
−sinσ6=ωSσ11扉θ2340x +sinθ
IC0502$4 o。02s4=tan-” (-(cosθla t +s
inθt ay)/a-) (5) 04 is found from equation (5) θ4=0234-02-03 (6) -sinσ6=ωSσ11 Door θ2340x +sinθ
IC0502$4 o.
士、1oθ2340m (7)ωSθ5ニー
sinθ1 o 、 +CO5θ10y
(8)θs =jan−’ (sznθ6 /co
sθm ) (9)いまハンド
部の画像比較演算より、ハンドのずnかx、y、z軸方
向にそれぞれΔX、Δy。shi, 1oθ2340m (7) ωSθ5 knee sinθ1 o, +CO5θ10y
(8) θs = jan-' (sznθ6 /co
sθm ) (9) Now, from the image comparison calculation of the hand part, ΔX and Δy in the x-, y-, and z-axis directions of the hand.
Δ2でめったとするとく回転は考えない)ハンドを持っ
て行くべき位置座標系は(1)式より、となる。このT
′から求まった角度上〇l′〜σS′とすれば、ハンド
を正しい位置へ移動さゼるべき量7Ill、に
Δθ1=θ鳥′−θI(n=1.2.・・・、5]
αυとなシ、この操作量をロボット制御器7に与え
九によい。(Rotation is rarely considered at Δ2) The position coordinate system where the hand should be taken is given by equation (1). This T
If the angle obtained from ' is 〇l' ~ σS', then the amount by which the hand should be moved to the correct position is 7Ill, and Δθ1 = θbird' - θI (n = 1.2..., 5]
This operation amount is given to the robot controller 7 as αυ.
画像か一致したときのアーム角度01〜θ6、あるいは
この時の絶対座標(xs y+Z)等を改めて記憶し直
丁ことにより常にティーチデータを更新する。こnによ
り本発明システムを常に動かさなくとも誤差が現nた時
に間けつ的に行うだけでよい。The arm angles 01 to θ6 when the images match, or the absolute coordinates (xs y + Z) at this time, etc., are stored again and the teaching data is constantly updated by direct alignment. As a result, the system of the present invention does not have to be constantly operated, but only needs to be operated intermittently when an error occurs.
以上の実施例のシステムによりロボットのティーチデー
タは自動的に修正さn、また、同一機種ロボット、さら
には、ハンド部だけなど一部分に着目することにより異
種ロボットにもティーチデータの相互交換か可能となる
。With the system of the above embodiment, the robot's teaching data is automatically corrected, and it is also possible to mutually exchange teaching data with robots of the same model, and even with robots of different types by focusing on a part such as the hand part. Become.
本発明によnば、ティーチデータだけでなくITVカメ
ラよりの画像データ、カメラ倍率、向きなどの画像パラ
メータを各ティーチ点ごとに記憶しておき、この記憶画
像と現画像との画像比較演算ヲ行って、ロボットの位置
補正を行う事かできる。According to the present invention, not only teach data but also image data from an ITV camera, image parameters such as camera magnification and orientation are stored for each teach point, and an image comparison operation between the stored image and the current image is performed. You can go there and correct the robot's position.
従来、ロボットやワークの変動、ロボット個体差等によ
りティーチ点の修正がひんはんに必要であシ、また同−
塁ロボット間でもティーチデータに互換性が無く、人間
の手による修正という非効率な手段を取っていたがこf
′Lを解決できる。Conventionally, it has often been necessary to correct the teach point due to variations in robots and workpieces, individual differences between robots, etc.
Even among base robots, the teaching data was not compatible, and the inefficient method of manually correcting it was taken.
'L can be solved.
基準ワークを用いたティーチングによるロボットモデル
の諸元変更法は対象ガスカラロボットであり、より複雑
なロボットへの適用はさnていない。1だロボットのラ
イン停止による作業効率の低下がある。The method for changing the specifications of a robot model by teaching using a reference work is applicable to Gascara robots, and is not applicable to more complex robots. 1) There is a decrease in work efficiency due to the robot line stopping.
本発明を用いnばオンラインで処理が自動的に行なえて
ティーチデータを多くのロボットで共用できる効果があ
る。By using the present invention, processing can be automatically performed online and teaching data can be shared by many robots.
第1図はロボットの個体差対応ティーチデータ修正シス
テムのブロック構成図、第2図は、ティーチング/プレ
イバックにおけるデーこの記憶までの処理手順のフロー
チャート、第3図は、プレイバック時におけるティーチ
データ修正処理のフ竿 1 口
第2 口
IFigure 1 is a block diagram of a teaching data correction system that accommodates individual differences in robots, Figure 2 is a flowchart of the processing procedure up to data storage during teaching/playback, and Figure 3 is teaching data correction during playback. Processing rod 1 mouth 2 mouth I
Claims (1)
装置と、工業用テレビカメラ(以下 ITVカメラと略す)と、回転及び平行移動の可能なI
TVカメラ駆動系と、ITVカメラ、駆動系を制御する
制御器より成るITVカメラ制御装置と、データを記憶
するための記憶器と、画像の比較演算器とより構成され
るロボットシステムにおいて、ロボットのテイーチング
を行う際にテイーチデータ以外に画像データ、この時の
ITVカメラの制御条件を含む画像パラメータを同時に
記憶器に記憶しておき、同一ロボットあるいは同型の他
のロボットでプレイバックを行う時、この画像データと
ITVカメラよりの現画像データを比較演算し、演算結
果に基つきロボットの制御装置に位置修正命令を与えて
ロボットの位置を正しくすることを特徴とするロボット
の個体差対応テイーチテータ修正方式。 2、同型の他のロボットを使う場合、あるいはITVカ
メラを移動する場合のために、ロボットやワークからの
ITVカメラの位置を正すための基準画像を予め撮影し
記憶しておき、同型の他のロボットを使う場合に基準画
像と現画像を比較演算してITVカメラの位置を自己修
正することを特徴とする第1項のロボットの個体差対応
テイーチデータ修正方式。[Claims] 1. A robot control device consisting of a robot and a robot controller, an industrial television camera (hereinafter abbreviated as ITV camera), and an ITV camera capable of rotation and translation.
In a robot system consisting of a TV camera drive system, an ITV camera control device consisting of a controller for controlling the ITV camera and the drive system, a memory for storing data, and an image comparison calculator, the robot's When performing teaching, in addition to the teaching data, image data and image parameters including the ITV camera control conditions at this time are stored in the memory at the same time, and when playback is performed with the same robot or another robot of the same type, this image A teaching data correction method corresponding to individual differences in robots, characterized in that data is compared and calculated with current image data from an ITV camera, and based on the calculation results, a position correction command is given to a control device of the robot to correct the position of the robot. 2. When using other robots of the same type or when moving the ITV camera, take and store a reference image in advance to correct the position of the ITV camera from the robot or workpiece, and use it for other robots of the same type. The teach data correction method corresponding to individual differences in robots according to item 1, characterized in that when the robot is used, the position of the ITV camera is self-corrected by comparing and calculating a reference image and a current image.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP1422785A JPS61173878A (en) | 1985-01-30 | 1985-01-30 | Individual-difference corresponding teach data correction system of robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP1422785A JPS61173878A (en) | 1985-01-30 | 1985-01-30 | Individual-difference corresponding teach data correction system of robot |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS61173878A true JPS61173878A (en) | 1986-08-05 |
Family
ID=11855179
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP1422785A Pending JPS61173878A (en) | 1985-01-30 | 1985-01-30 | Individual-difference corresponding teach data correction system of robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS61173878A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6358505A (en) * | 1986-08-29 | 1988-03-14 | Fanuc Ltd | Robot controller |
JPH0193805A (en) * | 1987-10-05 | 1989-04-12 | Hitachi Ltd | Method for generating teaching data of robot |
WO1990000109A1 (en) * | 1988-07-01 | 1990-01-11 | Fanuc Ltd | Nominal data automatic setting method of visual sensor system |
WO1997009154A1 (en) * | 1995-09-06 | 1997-03-13 | Fanuc Ltd | Apparatus and method for correcting a travelling route for a robot |
JP2020012669A (en) * | 2018-07-13 | 2020-01-23 | ファナック株式会社 | Object inspection device, object inspection system, and method for adjusting inspection position |
-
1985
- 1985-01-30 JP JP1422785A patent/JPS61173878A/en active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6358505A (en) * | 1986-08-29 | 1988-03-14 | Fanuc Ltd | Robot controller |
JPH0193805A (en) * | 1987-10-05 | 1989-04-12 | Hitachi Ltd | Method for generating teaching data of robot |
WO1990000109A1 (en) * | 1988-07-01 | 1990-01-11 | Fanuc Ltd | Nominal data automatic setting method of visual sensor system |
WO1997009154A1 (en) * | 1995-09-06 | 1997-03-13 | Fanuc Ltd | Apparatus and method for correcting a travelling route for a robot |
US6414711B2 (en) | 1995-09-06 | 2002-07-02 | Fanuc Ltd. | Apparatus for correcting movement path of a robot and a method therefor |
JP2020012669A (en) * | 2018-07-13 | 2020-01-23 | ファナック株式会社 | Object inspection device, object inspection system, and method for adjusting inspection position |
US11082621B2 (en) | 2018-07-13 | 2021-08-03 | Fanuc Corporation | Object inspection device, object inspection system and method for adjusting inspection position |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109571546B (en) | Robot tool center point correction system and method thereof | |
US4725965A (en) | Method for calibrating a SCARA robot | |
KR890005032B1 (en) | Operation teaching method and apparatus for industrial robot | |
CN113001535B (en) | Automatic correction system and method for robot workpiece coordinate system | |
US5590034A (en) | Method for controlling the movement of an industrial robot at and near singularities | |
US4899095A (en) | Robot control system | |
CN1024955C (en) | Device and method for correction of robot inaccuracy | |
Baeten et al. | Hybrid vision/force control at corners in planar robotic-contour following | |
Hager | Calibration-free visual control using projective invariance | |
JPS59153207A (en) | Control device of robot | |
US5157315A (en) | Method of controlling robot movements | |
CN112318498B (en) | Industrial robot calibration method considering parameter coupling | |
Cowan et al. | Planar image based visual servoing as a navigation problem | |
CN111687838B (en) | Online compensation method, system and storage medium for track following error of manipulator | |
JP4289619B2 (en) | Tool position correction method for articulated robots | |
JPS61173878A (en) | Individual-difference corresponding teach data correction system of robot | |
JP2020171989A (en) | Robot teaching system | |
JPS5815801B2 (en) | Trajectory control method for industrial robots | |
JPS599708A (en) | Operation error compensating method of robot system | |
JP5324397B2 (en) | Information processing method, apparatus and program | |
JP7384653B2 (en) | Control device for robot equipment that controls the position of the robot | |
Milenkovic | Optimal path crossing the orientation exclusion zone of a robot with offset wrist | |
JPS6095605A (en) | Teaching data correcting method of robot | |
JPS59173805A (en) | Industrial robot having instruction data converting function | |
JPS618236A (en) | Moving body control unit |