JPS62177602A - ロボツトの作業開始点への位置決め制御方法 - Google Patents
ロボツトの作業開始点への位置決め制御方法Info
- Publication number
- JPS62177602A JPS62177602A JP1798886A JP1798886A JPS62177602A JP S62177602 A JPS62177602 A JP S62177602A JP 1798886 A JP1798886 A JP 1798886A JP 1798886 A JP1798886 A JP 1798886A JP S62177602 A JPS62177602 A JP S62177602A
- Authority
- JP
- Japan
- Prior art keywords
- coordinate system
- work
- tip
- robot
- work tool
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims description 21
- 238000006243 chemical reaction Methods 0.000 claims abstract description 23
- 238000005286 illumination Methods 0.000 claims description 13
- 230000006870 function Effects 0.000 claims description 10
- 230000000007 visual effect Effects 0.000 claims description 10
- 210000000707 wrist Anatomy 0.000 claims description 4
- 230000004044 response Effects 0.000 claims 1
- 238000003466 welding Methods 0.000 description 26
- 238000010586 diagram Methods 0.000 description 15
- 238000004364 calculation method Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000004026 adhesive bonding Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005316 response function Methods 0.000 description 1
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は、補間機能と視覚センサおよび視覚センサに対
する応答機能を有するロボットの作業開始点への位置決
め方法に関する。
する応答機能を有するロボットの作業開始点への位置決
め方法に関する。
ティーチングプレイバック形ロボットの前提は、アーム
の先端に取り付けられた作業工具の先端位置と作業個所
が必ずティーチング時のとおりに設定されていることで
ある。従って、作業工具先端の位置ずれ、作業線の位置
ずれをいかに補間するかが、ティーチングプレイバック
形ロボットの大きな課題であり、種々のセンサにより研
究され、一部実用化されているものもある。
の先端に取り付けられた作業工具の先端位置と作業個所
が必ずティーチング時のとおりに設定されていることで
ある。従って、作業工具先端の位置ずれ、作業線の位置
ずれをいかに補間するかが、ティーチングプレイバック
形ロボットの大きな課題であり、種々のセンサにより研
究され、一部実用化されているものもある。
ロボット用センサとして応用されているセンサには、機
械式、磁気式、アークセンサ式、光学式等が研究されて
いる。これらセンサの欠点については、特願昭80−1
17711に述べられている。さらにこれらセンサは実
作業とは違った作業開始点検出のだめの余分な検出動作
をしなければならないため、作業開始点への高速位置決
め制御の点で問題があった。センサ座標系での作業線、
作業工具の陰の先端は第1および第2の軌跡修正信号に
より軌跡修正されると位置が変化する。また、作業工具
先端の位置も変化する可能性がある。特願昭eO−11
7711では、第1および第2の軌跡修正信号により軌
跡修正される毎に、もしくは間欠的に作業工具先端位置
、作業工具の陰の先端位置、作業線を画像処理し、認識
することにより、作業工具先端位置、作業工具の陰の先
端位置、作業線が一致するように制御されている。従っ
て1画像処理の回数性の時間、画像処理の結果出力され
た修正信号から実際にロボットの複数軸を動作させるに
必要な時間だけロスすることになる。
械式、磁気式、アークセンサ式、光学式等が研究されて
いる。これらセンサの欠点については、特願昭80−1
17711に述べられている。さらにこれらセンサは実
作業とは違った作業開始点検出のだめの余分な検出動作
をしなければならないため、作業開始点への高速位置決
め制御の点で問題があった。センサ座標系での作業線、
作業工具の陰の先端は第1および第2の軌跡修正信号に
より軌跡修正されると位置が変化する。また、作業工具
先端の位置も変化する可能性がある。特願昭eO−11
7711では、第1および第2の軌跡修正信号により軌
跡修正される毎に、もしくは間欠的に作業工具先端位置
、作業工具の陰の先端位置、作業線を画像処理し、認識
することにより、作業工具先端位置、作業工具の陰の先
端位置、作業線が一致するように制御されている。従っ
て1画像処理の回数性の時間、画像処理の結果出力され
た修正信号から実際にロボットの複数軸を動作させるに
必要な時間だけロスすることになる。
本発明の目的は、ロボット手首に装着された作業工具を
作業対象物の作業開始点に正しく、しかも高速に位置決
めするロボットの作業開始点への位置決め制御方法を提
供することである。
作業対象物の作業開始点に正しく、しかも高速に位置決
めするロボットの作業開始点への位置決め制御方法を提
供することである。
未発jJFlは、アームの先端に作業工具を設け、その
手首部に照明源と視覚センサを設けた補間機能を有する
ティーチングプレイバック制御のロボットで、前記視覚
センサからの位置修正信号に応答してロボットを構成す
る複数の駆動軸を制御して、前記作業工具の先端位置を
高速に作業開始点へ位置決めする制御方法において、次
のステップからなる。
手首部に照明源と視覚センサを設けた補間機能を有する
ティーチングプレイバック制御のロボットで、前記視覚
センサからの位置修正信号に応答してロボットを構成す
る複数の駆動軸を制御して、前記作業工具の先端位置を
高速に作業開始点へ位置決めする制御方法において、次
のステップからなる。
まず、ティーチング時にロボット座標系とセンサ座標系
との変換式を求めるためのキャリブレーション動作を行
なう。この動作は、作業線の教示と同様に同一作業線教
示に対し、−回のみの動作である。このキャリブレーシ
ョン動作については次のステップ(1)〜(4)からな
る。
との変換式を求めるためのキャリブレーション動作を行
なう。この動作は、作業線の教示と同様に同一作業線教
示に対し、−回のみの動作である。このキャリブレーシ
ョン動作については次のステップ(1)〜(4)からな
る。
(1)照明源により、平板上に作業工具の陰を生成する
。
。
(2)ロボット座標系での作業工具先端位置およびびセ
ンサ座標系での作業工具先端位置と作業工具の陰の先端
位置を記憶し、作業工具先端と作業工具の陰の先端が一
致するまで作業工具を移動させ、一致した時の作業工具
先端のロボット座標系における位置を記憶し、作業線の
方向を第3の修正方向、作業線と直交する上下方向を第
1の修正方向、第1および第3の修正方向と直交する方
向を第2の修正方向とすると第1の修正方向に対するセ
ンサ座標系とロボット座標系との変換式を求めメモリへ
格納する。
ンサ座標系での作業工具先端位置と作業工具の陰の先端
位置を記憶し、作業工具先端と作業工具の陰の先端が一
致するまで作業工具を移動させ、一致した時の作業工具
先端のロボット座標系における位置を記憶し、作業線の
方向を第3の修正方向、作業線と直交する上下方向を第
1の修正方向、第1および第3の修正方向と直交する方
向を第2の修正方向とすると第1の修正方向に対するセ
ンサ座標系とロボット座標系との変換式を求めメモリへ
格納する。
(3)ロポ・ント座標系およびセンサ座標系における作
業工具先端位置、センサ座標系における作業工具先端と
作業工具の陰の先端との距離をメモリへ格納しておき、
作業工具の先端が作業工具の陰の先端と一致するまで作
業工具を移動させ。
業工具先端位置、センサ座標系における作業工具先端と
作業工具の陰の先端との距離をメモリへ格納しておき、
作業工具の先端が作業工具の陰の先端と一致するまで作
業工具を移動させ。
一致した時の作業開始点のロボット座標系およびセンサ
座標系における位置と前記メモリへ格納しておいた作業
工具先端位置、作業工具先端と作業工具の陰の先端との
距離から第2および第3の修正方向への修正量に対する
ロボット座標系とセンサ座標系との変換式を求めメモリ
へ格納する。
座標系における位置と前記メモリへ格納しておいた作業
工具先端位置、作業工具先端と作業工具の陰の先端との
距離から第2および第3の修正方向への修正量に対する
ロボット座標系とセンサ座標系との変換式を求めメモリ
へ格納する。
(4)ロボット座標系において、教示された作業線に平
行な2点間距離とその時のセンサ座標系における2点間
距離により、第3の修正方向へのロボット座標系とセン
サ座標系との変換式を求めメモリへ格納しておく。
行な2点間距離とその時のセンサ座標系における2点間
距離により、第3の修正方向へのロボット座標系とセン
サ座標系との変換式を求めメモリへ格納しておく。
次のステップ(5)、(6)はロボットのプレイバック
モード時の処理である。
モード時の処理である。
(5)照明源により、前記作業工具の陰を生成する。
(6)作業工具先端、作業工具の陰の先端および作業開
始点を画像認識し、ステップ(2)、(3)で求めた変
換式からロボット座標系での各修正方向に対する修正量
を演算し、工具先端を作業開始点へ移動させる。
始点を画像認識し、ステップ(2)、(3)で求めた変
換式からロボット座標系での各修正方向に対する修正量
を演算し、工具先端を作業開始点へ移動させる。
本発明はさらに、前記ステップ(5)の画像処理時、作
業開始点が見つからなかった場合、次のステップ (5
)〜(8)を含む。
業開始点が見つからなかった場合、次のステップ (5
)〜(8)を含む。
(5)照明源により、前記作業工具の陰を生成する。
(6)作業対象物の作業線と前記作業工具と作業工具の
陰を前記視覚センサによって画像認識する。
陰を前記視覚センサによって画像認識する。
げ)教示された第3の修正方向に作業開始点が画像認識
されるまで移動させる。
されるまで移動させる。
(8)前記作業開始点を検出すると、ステップ(2)〜
(4)で求めておいた変換式からロボット座標系での各
修正方向に対する修正量を演算し、工具先端を作業開始
点へ移動させる。
(4)で求めておいた変換式からロボット座標系での各
修正方向に対する修正量を演算し、工具先端を作業開始
点へ移動させる。
このように、教示時第1、第2および第3の修正方向へ
一定距離だけ作業工具先端を動作させた時のセンサ座標
系での作業工具先端、作業工具の陰の先端、作業開始点
の移動距離および変位ベクトルを算出しておくことによ
り、プレイバック時の画像処理回数が大幅に減少する0
作業工具の先端、作業工具の陰の先端、作業開始点が認
識されると、各修正方向に対するロボット座標系とセン
サ座標系との比および変位ベクトルから各修正方向への
修正量を演算し、修正量がセンサからロボット制御装置
へ転送され、公知の補間機能、たとえば特願昭58−3
8872によりただちに作業開始点へ作業工具先端を移
動させることができる。センサ座標系内に作業工具先端
、作業工具の陰の先端、作業開始点が存在する場合は1
回の画像処理ですむことになる。
一定距離だけ作業工具先端を動作させた時のセンサ座標
系での作業工具先端、作業工具の陰の先端、作業開始点
の移動距離および変位ベクトルを算出しておくことによ
り、プレイバック時の画像処理回数が大幅に減少する0
作業工具の先端、作業工具の陰の先端、作業開始点が認
識されると、各修正方向に対するロボット座標系とセン
サ座標系との比および変位ベクトルから各修正方向への
修正量を演算し、修正量がセンサからロボット制御装置
へ転送され、公知の補間機能、たとえば特願昭58−3
8872によりただちに作業開始点へ作業工具先端を移
動させることができる。センサ座標系内に作業工具先端
、作業工具の陰の先端、作業開始点が存在する場合は1
回の画像処理ですむことになる。
本発明の実施例について図面を参照して説明する。
以下、作業工具として溶接トーチを例に挙げ詳細説明を
行なうが、溶接トーチの代わりにのり付はガン、パリと
り工具、ネジ締め工具、把みハンド等も使用可能である
ため、本発明は溶接用に止まらないことをここで強調し
ておく。
行なうが、溶接トーチの代わりにのり付はガン、パリと
り工具、ネジ締め工具、把みハンド等も使用可能である
ため、本発明は溶接用に止まらないことをここで強調し
ておく。
第1図は、ワークずれにより溶接開始点がずれる様相を
重ね継手ワークの例で示した図である。
重ね継手ワークの例で示した図である。
lは教示時のワーク位置、2は実際のワーク位置、3は
教示時の溶接開始点、4は教示時の溶接線、3°は実際
の溶接開始点、4゛は実際の溶接線である。7.7’は
それぞれ教示時、実際の溶接方向を示す。
教示時の溶接開始点、4は教示時の溶接線、3°は実際
の溶接開始点、4゛は実際の溶接線である。7.7’は
それぞれ教示時、実際の溶接方向を示す。
第2図は、教示時のワイヤ電極先端を教示時の溶接開始
点へ移動させた時の図であり、重ね継手ワークを例にと
って説明する。
点へ移動させた時の図であり、重ね継手ワークを例にと
って説明する。
3’、 4’、 ?’、 8°はそれぞれ、ワークの実
際の溶接開始点、溶接線、溶接線方向、溶接終了点を示
す、 14は2次元カメラ、15は映像信号比カケープ
ル、18はカメラコントローラ、2oはモニターテレビ
、21はイメージプロセッサである。16は周囲の光量
に影響されることなく常に一定の光量を得るだめの照明
源であり、ワイヤ電極11の陰17を生成するためのも
のである。従って、本発明の意図するところは、照明源
16で得た、ワイヤ電極11、ワイヤ電極11の陰17
および溶接開始点を2次元カメラ14でとらえ、画像認
識することにより、位置ずれを有するワークに対して、
正確にしかも高速な作業開始点への位置決めを実現する
ことである。
際の溶接開始点、溶接線、溶接線方向、溶接終了点を示
す、 14は2次元カメラ、15は映像信号比カケープ
ル、18はカメラコントローラ、2oはモニターテレビ
、21はイメージプロセッサである。16は周囲の光量
に影響されることなく常に一定の光量を得るだめの照明
源であり、ワイヤ電極11の陰17を生成するためのも
のである。従って、本発明の意図するところは、照明源
16で得た、ワイヤ電極11、ワイヤ電極11の陰17
および溶接開始点を2次元カメラ14でとらえ、画像認
識することにより、位置ずれを有するワークに対して、
正確にしかも高速な作業開始点への位置決めを実現する
ことである。
第3図は、教示時において、溶接線の垂直断面に対して
図のように第1の修正方向を゛上下”方向、第2の修正
方向を“左右″方向、第3の修正方向を“°前後′°方
向と定義した時の説明図である。第3の修正方向は、作
業動作方向を前方向、作業線動作方向と逆方向を後方向
と定義している。゛ 第4図は、第1の修正方向(上下方向)、第2の修正方
向(左右方向)、第3の修正方向(前後方向)へワイヤ
先端を移動させた時のモニタ2o上でのワイヤ、ワイヤ
の陰、作業開始点の様子を表わしたものである。同図(
b)、 (f)、 U)は同一画像である。同図(c)
は右方向へ位置修正した時、同図(d)は左方向へ位置
修正した時、同図(g)は゛°上上方方向位置修正した
時、同図(h)は゛下°′方向へ位置修正し、ワイヤ先
端が下板の面に接触した状態を示す。すなわち、ワイヤ
先端とワイヤの陰の先端が一致することに留意されたい
。さらに、同図(k)は゛°後°゛方向へ位置修正した
時、同図(+)は゛前パ方向へ位置修正した時の様子を
表わしたものである。同図(m) 、 (n)は作業開
始点へワイヤ電極先端を位置決めした時の様子を示した
ものである。
図のように第1の修正方向を゛上下”方向、第2の修正
方向を“左右″方向、第3の修正方向を“°前後′°方
向と定義した時の説明図である。第3の修正方向は、作
業動作方向を前方向、作業線動作方向と逆方向を後方向
と定義している。゛ 第4図は、第1の修正方向(上下方向)、第2の修正方
向(左右方向)、第3の修正方向(前後方向)へワイヤ
先端を移動させた時のモニタ2o上でのワイヤ、ワイヤ
の陰、作業開始点の様子を表わしたものである。同図(
b)、 (f)、 U)は同一画像である。同図(c)
は右方向へ位置修正した時、同図(d)は左方向へ位置
修正した時、同図(g)は゛°上上方方向位置修正した
時、同図(h)は゛下°′方向へ位置修正し、ワイヤ先
端が下板の面に接触した状態を示す。すなわち、ワイヤ
先端とワイヤの陰の先端が一致することに留意されたい
。さらに、同図(k)は゛°後°゛方向へ位置修正した
時、同図(+)は゛前パ方向へ位置修正した時の様子を
表わしたものである。同図(m) 、 (n)は作業開
始点へワイヤ電極先端を位置決めした時の様子を示した
ものである。
本発明は、第4図(m) 、 (n)のように、ワイヤ
電極先端を作業開始点へ高速に位置決めする制御法であ
り、その方法について以下に述べる。
電極先端を作業開始点へ高速に位置決めする制御法であ
り、その方法について以下に述べる。
第5図および第6図は教示時にロボット座標系とセンサ
座標系での変換式を求めておくための作業を示す図であ
り、この変換式を用いることにより、画像認識された、
ワイヤ電極先端、ワイヤ電極の陰の先端および作業開始
点からロボット座標系へ変換し、補間機能(例えば直線
補間)によりワイヤ電極先端をただちに作業開始点へ動
作させることになる。
座標系での変換式を求めておくための作業を示す図であ
り、この変換式を用いることにより、画像認識された、
ワイヤ電極先端、ワイヤ電極の陰の先端および作業開始
点からロボット座標系へ変換し、補間機能(例えば直線
補間)によりワイヤ電極先端をただちに作業開始点へ動
作させることになる。
第5図は、上下方向に対するロボット座標系とセンサ座
標系とのキャリブレーション法について説明したもので
ある。平板1の任意の点P2 (同図(a))で照明
源1Bによりワイヤ電極11の陰17およびモニタ上の
10を生成する。この時のセンサ座標系におけるワイヤ
先端とワイヤ#17の先端との距glI45=9.4s
(ロボット座標系での°゛上下修正方向に対する2点間
圧#)を測定する。また、ワイヤ電極先端のロボット座
標系での位置を記憶しておく。次に同図(C)のように
ワイヤ先端が平板1に接触するまで“下″方向へ移動さ
せ、ロボット座標系でのワイヤ先端と平板1上までの距
離−2・3=父23を測定し、 を°゛上上下方方向対する変換係数としてメモリへ格納
しておく。
標系とのキャリブレーション法について説明したもので
ある。平板1の任意の点P2 (同図(a))で照明
源1Bによりワイヤ電極11の陰17およびモニタ上の
10を生成する。この時のセンサ座標系におけるワイヤ
先端とワイヤ#17の先端との距glI45=9.4s
(ロボット座標系での°゛上下修正方向に対する2点間
圧#)を測定する。また、ワイヤ電極先端のロボット座
標系での位置を記憶しておく。次に同図(C)のように
ワイヤ先端が平板1に接触するまで“下″方向へ移動さ
せ、ロボット座標系でのワイヤ先端と平板1上までの距
離−2・3=父23を測定し、 を°゛上上下方方向対する変換係数としてメモリへ格納
しておく。
第6図(a)はロボット座標系において教示された溶接
線7゛に対して平板上の任意点P3および溶接線7゛に
平行な任意点P4との距gI文、4および同図(b)で
は同図(a)の点P3および点P4でのセンサ座標系で
の溶接線7°上の特定点p6+P7の移動距離16.7
からKs = lsa/ 文6−tを求めメモリへ格納
することによりロボット座標系とセンサ座標系との前後
修正方向に対す変換式(変換係数)となる。
線7゛に対して平板上の任意点P3および溶接線7゛に
平行な任意点P4との距gI文、4および同図(b)で
は同図(a)の点P3および点P4でのセンサ座標系で
の溶接線7°上の特定点p6+P7の移動距離16.7
からKs = lsa/ 文6−tを求めメモリへ格納
することによりロボット座標系とセンサ座標系との前後
修正方向に対す変換式(変換係数)となる。
第7図は、ワイヤ電極先端とワイヤ電極の陰の先端を一
致させた時の作業開始点P6のセンサ座標系上での移動
量およびベクトル方向を算出するべくキャリブレーショ
ン法および第2、第3の修正方向への修正量算出につい
て示している。同図(a)は教示された作業開始点P1
とワイヤ電極先端P2を示しており、同図(b)はそ
の時のセンサ座標系での様子である。同図(a)の各点
p、 、p2+P3が同図(b)の各点p6.p、、
+PSに対応する。
致させた時の作業開始点P6のセンサ座標系上での移動
量およびベクトル方向を算出するべくキャリブレーショ
ン法および第2、第3の修正方向への修正量算出につい
て示している。同図(a)は教示された作業開始点P1
とワイヤ電極先端P2を示しており、同図(b)はそ
の時のセンサ座標系での様子である。同図(a)の各点
p、 、p2+P3が同図(b)の各点p6.p、、
+PSに対応する。
まず、教示された作業開始点PLのセンサ座標系での点
P6の位置および、ワイヤ電極先端P5とワイヤ電極の
陰の先端すの距離見5ジを測定し記憶しておく。さらに
、同図(C)のように、ワイヤ電極先端P2をワイヤ電
極の陰の先端P3と一致させた時の作業開始点PLのセ
ンサ座標系での移動の様子を同図(d)に示す。同図(
d)の点P7はワイヤ電極先端とワイヤ電極の陰の先端
を一致させた点であり、点P8はその時の溶接開始点P
6の移動点であり、点PIGは点P7から溶接線15へ
垂直におろした線との交点である。
P6の位置および、ワイヤ電極先端P5とワイヤ電極の
陰の先端すの距離見5ジを測定し記憶しておく。さらに
、同図(C)のように、ワイヤ電極先端P2をワイヤ電
極の陰の先端P3と一致させた時の作業開始点PLのセ
ンサ座標系での移動の様子を同図(d)に示す。同図(
d)の点P7はワイヤ電極先端とワイヤ電極の陰の先端
を一致させた点であり、点P8はその時の溶接開始点P
6の移動点であり、点PIGは点P7から溶接線15へ
垂直におろした線との交点である。
溶接開始点P6の移動点P8から8・8のペクト点P7
と点P8との距離!17B、点P7と点PI(+とと点
P16との距蓬愛17からに4=立17/交7Bをそれ
ぞれ算出し、メモリへ格納しておく0以上がテイニチン
グ時に求める値である。同図(e)は、実際のプレイバ
ック動作時のセンサ座標系におけるワイヤ電極、ワイヤ
電極の陰、作業線の様子を表わしたものである。ワイヤ
電極先端P20とワイヤ電極の陰の先端P21および作
業開始点P22の各座標を画像認識し、ワイヤ電極先端
P2゜とワイヤ電極の陰の先端P21との距離fL2を
演算しメモリへ格納しておく、同図(Dは同図(e)の
ワイヤ電極先端P20とワイヤ電極の陰の先端P21と
の距離立2と前記メモリへ格納していたに2および方向
余弦C1、m)からワイヤ電極先端P20とワイヤ電極
の陰の先端P21が一致した時、すなわち、文2だけ第
1の修正方向(上下方向)へ移動した時の作業開始点P
22の移動点PLOを求め、第2の修正方向(左右方向
)への移動量見、2および第3の修正方向(前後方向)
への移動、731 fL+3を求めることを示した図で
ある。同図(e)で画像認識された作業開始点P22の
座標値を点P22(X221y22)とすると、点Pr
o (X to + ”l to)はX 10 =x2
7+(K2 ・fL2)・’l + Y1o= ’
122+(K2 ・文、)mmにより求まる。さらに
第2、第3の修正方向らそれぞれに3 ・文よ□、に4
φ文、1で求まる。求められた第1、第2、第3の修
正方向への修正量をロボット制御装置へ発生することに
より、ロボットの基本3軸を駆動制御し、ワイヤ電極先
端を作業開始点へ位置決めすることになる。
と点P8との距離!17B、点P7と点PI(+とと点
P16との距蓬愛17からに4=立17/交7Bをそれ
ぞれ算出し、メモリへ格納しておく0以上がテイニチン
グ時に求める値である。同図(e)は、実際のプレイバ
ック動作時のセンサ座標系におけるワイヤ電極、ワイヤ
電極の陰、作業線の様子を表わしたものである。ワイヤ
電極先端P20とワイヤ電極の陰の先端P21および作
業開始点P22の各座標を画像認識し、ワイヤ電極先端
P2゜とワイヤ電極の陰の先端P21との距離fL2を
演算しメモリへ格納しておく、同図(Dは同図(e)の
ワイヤ電極先端P20とワイヤ電極の陰の先端P21と
の距離立2と前記メモリへ格納していたに2および方向
余弦C1、m)からワイヤ電極先端P20とワイヤ電極
の陰の先端P21が一致した時、すなわち、文2だけ第
1の修正方向(上下方向)へ移動した時の作業開始点P
22の移動点PLOを求め、第2の修正方向(左右方向
)への移動量見、2および第3の修正方向(前後方向)
への移動、731 fL+3を求めることを示した図で
ある。同図(e)で画像認識された作業開始点P22の
座標値を点P22(X221y22)とすると、点Pr
o (X to + ”l to)はX 10 =x2
7+(K2 ・fL2)・’l + Y1o= ’
122+(K2 ・文、)mmにより求まる。さらに
第2、第3の修正方向らそれぞれに3 ・文よ□、に4
φ文、1で求まる。求められた第1、第2、第3の修
正方向への修正量をロボット制御装置へ発生することに
より、ロボットの基本3軸を駆動制御し、ワイヤ電極先
端を作業開始点へ位置決めすることになる。
前記の例は、作業開始点が画像処理によりただちに認識
できた場合であり、ワークの大きな位置ずれにより、作
業線のみ画像上に現われ、作業開始点が視野内からはみ
出した場合の処理手順について第8図により説明する。
できた場合であり、ワークの大きな位置ずれにより、作
業線のみ画像上に現われ、作業開始点が視野内からはみ
出した場合の処理手順について第8図により説明する。
同図(a)のPLは作業線、 P2は作業線上の途中の
点である。画像認識された点P2、およびワイヤ先端位
置から、教示された作業線動作方向と逆方向へ、すなわ
ち後修正方向へワイヤ先端Psを通り、認識された作業
線1に平行で、画像処理する有効債域(通常、ウィンド
ウと称する)の辺6との交点P3を算出し、前後方向に
対するキャリブレーション法によって演算されたに3か
らセンサ座標系での距離文3.をロボット座標系での距
離に変換された量だけ位ご修正を行なう。同図(b)は
、この同図(a)の動作を繰り返して、作業開始点が画
像認識された時の様子である。同図(b)では、作業開
始点、ワイヤ電極先端位置、ワイヤ電極の陰の先端位置
が画像認識されるため、係数に、、 K2、およびベク
トルV 、68から位置修正すべき、各修正方向に対す
る修正量を算出することができる。
点である。画像認識された点P2、およびワイヤ先端位
置から、教示された作業線動作方向と逆方向へ、すなわ
ち後修正方向へワイヤ先端Psを通り、認識された作業
線1に平行で、画像処理する有効債域(通常、ウィンド
ウと称する)の辺6との交点P3を算出し、前後方向に
対するキャリブレーション法によって演算されたに3か
らセンサ座標系での距離文3.をロボット座標系での距
離に変換された量だけ位ご修正を行なう。同図(b)は
、この同図(a)の動作を繰り返して、作業開始点が画
像認識された時の様子である。同図(b)では、作業開
始点、ワイヤ電極先端位置、ワイヤ電極の陰の先端位置
が画像認識されるため、係数に、、 K2、およびベク
トルV 、68から位置修正すべき、各修正方向に対す
る修正量を算出することができる。
第9図は、本発明を実現すべく、センサ付きロボットの
制御ブロック図である。°゛上下パ、°“左右″方向お
よび゛′前後°′方向への位置修正量がイメージプロセ
ッサで演算され、演算された移動量は、位置修正指令5
0として発生される。ロボット制御装置51はこの指令
50を受はロボット基本3軸を駆動制御する。ここで、
52.53.54.55.513は各軸の位置サーボ回
路であり、公知の駆動方式である。811.621.6
31.641.851は偏差カウンタ、812.822
.θ32.842.652はD/A変換器、013、8
2ミ、 11133. e43.853はサーボアンプ
、614゜824、834.844.854はサーボモ
ータ、 815.825゜835、845.855は速
度フィードバック信号発生器、818.82El、 8
36.646. E15Bは位置検出発生器、そして、
57.58.59.60.131は各軸位置指令パルス
である。ここで、ロボット制御装置51は、公知の直線
補間機能 特願昭513−38872 r関節形産業用
ロボットの制御装置」に記述されている機能を有し、し
かも特願昭58−1581327 r溶接ロボットの制
御方式」に記述されている予め決められた第1および第
2の修正方向、すなわち゛上下′”、“左右゛の修正方
向へのロボット基本3軸による移動機能、さらに゛前後
パの修正方向へのロボット基本3軸による移動機能を有
している装置である。ここで、多少のコメントをしてお
く必要がある。各修正方向に対するロボット座標系での
距離とセンサ座標系での距離の比は必ずしも直線性はな
い。これは、ワイヤとワイヤ陰の画像を取り込むべきカ
メラの位置に大きく起因するためである。しかしながら
、実際のワークのずれは最大でも10mm程度であり、
また、第2図のカメラ軸駆動源19によってカメラを任
意の位置に設定できることにより、直線性を向上させる
ことができるため、実用上問題はない。
制御ブロック図である。°゛上下パ、°“左右″方向お
よび゛′前後°′方向への位置修正量がイメージプロセ
ッサで演算され、演算された移動量は、位置修正指令5
0として発生される。ロボット制御装置51はこの指令
50を受はロボット基本3軸を駆動制御する。ここで、
52.53.54.55.513は各軸の位置サーボ回
路であり、公知の駆動方式である。811.621.6
31.641.851は偏差カウンタ、812.822
.θ32.842.652はD/A変換器、013、8
2ミ、 11133. e43.853はサーボアンプ
、614゜824、834.844.854はサーボモ
ータ、 815.825゜835、845.855は速
度フィードバック信号発生器、818.82El、 8
36.646. E15Bは位置検出発生器、そして、
57.58.59.60.131は各軸位置指令パルス
である。ここで、ロボット制御装置51は、公知の直線
補間機能 特願昭513−38872 r関節形産業用
ロボットの制御装置」に記述されている機能を有し、し
かも特願昭58−1581327 r溶接ロボットの制
御方式」に記述されている予め決められた第1および第
2の修正方向、すなわち゛上下′”、“左右゛の修正方
向へのロボット基本3軸による移動機能、さらに゛前後
パの修正方向へのロボット基本3軸による移動機能を有
している装置である。ここで、多少のコメントをしてお
く必要がある。各修正方向に対するロボット座標系での
距離とセンサ座標系での距離の比は必ずしも直線性はな
い。これは、ワイヤとワイヤ陰の画像を取り込むべきカ
メラの位置に大きく起因するためである。しかしながら
、実際のワークのずれは最大でも10mm程度であり、
また、第2図のカメラ軸駆動源19によってカメラを任
意の位置に設定できることにより、直線性を向上させる
ことができるため、実用上問題はない。
以上説明したように本発明は、ワークの0位置および作
業工具の取付は位置が厳密でない場合でも、教示作業と
同時に、各修正方向に対するロボット座標系とセンサ座
標系との変換式をあらかじめ求めておくことにより1作
業開始点への高速な位置決めが実現でき、作業の能率化
が一増進められる。
業工具の取付は位置が厳密でない場合でも、教示作業と
同時に、各修正方向に対するロボット座標系とセンサ座
標系との変換式をあらかじめ求めておくことにより1作
業開始点への高速な位置決めが実現でき、作業の能率化
が一増進められる。
第1図は重ね継手ワークで位置ずれを有している様子を
示す図、第2図は視覚センサ付ロボットの教示された溶
接開始点における様子を示す図、第3図は作業方向の垂
直断面に対する゛上下°′、゛左右パの位置修正方向お
よび°゛前後°°位首修正方向を示す図、第4図は“左
右゛、“上下°°、”前後゛ヘワイヤ先端を移動させた
時のワイヤ、ワイヤ陰、作業線および作業開始点の動き
を示す図、第5図は゛上下″修正方向に対するロボット
座標系と、センサ座標系間の変換式を示す図、第6図は
ワイヤ先端とワイヤ陰の先端を一致させた時の作業開始
点のセンサ座標系での移動位置を推定するだめの演算式
を求める説明図、第7図は“前後′°修正方向に対する
ロボット座標系とセンサ座標系間の変換式を求める説明
図、第8図は作業開始点が認識できない場合のロボット
動作方法を示す図、第9図は水力式を実現するにあたり
構成されたセンサ付ロボットの制御ブロック図である。 1・・・教示時のワーク位置。 2・・・実際のワーク位置、 3・・・教示時の溶接開始点。 4・・・教示時の溶接線、 3″・・・実際の溶接開始点、 4′・・・実際の溶接線、 8・・・ワイヤ線、 9・・・作業線、 11・・・ワイヤ電極。 第1図 2゜ 第2図 (C) (d) 第5図 (21) (b) (
(1)(e) (f) 第7図
示す図、第2図は視覚センサ付ロボットの教示された溶
接開始点における様子を示す図、第3図は作業方向の垂
直断面に対する゛上下°′、゛左右パの位置修正方向お
よび°゛前後°°位首修正方向を示す図、第4図は“左
右゛、“上下°°、”前後゛ヘワイヤ先端を移動させた
時のワイヤ、ワイヤ陰、作業線および作業開始点の動き
を示す図、第5図は゛上下″修正方向に対するロボット
座標系と、センサ座標系間の変換式を示す図、第6図は
ワイヤ先端とワイヤ陰の先端を一致させた時の作業開始
点のセンサ座標系での移動位置を推定するだめの演算式
を求める説明図、第7図は“前後′°修正方向に対する
ロボット座標系とセンサ座標系間の変換式を求める説明
図、第8図は作業開始点が認識できない場合のロボット
動作方法を示す図、第9図は水力式を実現するにあたり
構成されたセンサ付ロボットの制御ブロック図である。 1・・・教示時のワーク位置。 2・・・実際のワーク位置、 3・・・教示時の溶接開始点。 4・・・教示時の溶接線、 3″・・・実際の溶接開始点、 4′・・・実際の溶接線、 8・・・ワイヤ線、 9・・・作業線、 11・・・ワイヤ電極。 第1図 2゜ 第2図 (C) (d) 第5図 (21) (b) (
(1)(e) (f) 第7図
Claims (1)
- 【特許請求の範囲】 1、アームの先端に作業工具を設け、その手首部に照明
源と視覚センサを設けた補間機能を有するティーチング
プレイバック制御のロボットで、前記視覚センサからの
位置修正信号に応答してロボットを構成する複数の駆動
軸を制御して前記作業工具の位置を調整する方法におい
て、次のステップからなるロボットの作業開始点への位
置決め制御方法。 (1)照明源により平板上に作業工具の陰を生成する。 (2)ロボット座標系での作業工具先端位置およびセン
サ座標系での作業工具先端位置と作業工具の陰の先端位
置を記憶し、作業工具先端と作業工具の陰の先端が一致
するまで作業工具を移動させ、一致した時の作業工具先
端のロボット座標系における位置を記憶し、作業線の方
向を第3の修正方向、作業線と直交する上下方向を第1
の修正方向、第1および第3の修正方向と直交する方向
を第2の修正方向とすると第1の修正方向に対するセン
サ座標系とロボット座標系との変換式を求めメモリへ格
納する。 (3)ロボット座標系およびセンサ座標系における作業
開始点位置、センサ座標系における作業工具先端と作業
工具の陰の先端との距離をメモリへ格納しておき、作業
工具の先端が作業工具の陰の先端と一致するまで作業工
具を移動させ、一致した時の作業開始点のロボット座標
系およびセンサ座標系における位置と前記メモリへ格納
しておいた作業開始点位 置、作業工具先端と作業工具の陰の先端との距離から第
2および第3の修正方向への修正量に対するロボット座
標系とセンサ座標系との変換式を求めメモリへ格納する
。 (4)ロボット座標系において、教示された作業線に平
行な2点間距離とその時のセンサ座標系における2点間
距離により、第3の修正方向へのロボット座標系とセン
サ座標系との変換式を求めメモリへ格納しておく。 (5)照明源により、前記作業工具の陰を生成する。 (6)作業工具先端、作業工具の陰の先端および作業開
始点を画像認識し、ステップ(2)、(3)で求めた変
換式からロボット座標系での各修正方向に対する修正量
を演算し、工具先端を作業開始点へ移動させる。 2、アームの先端に作業工具を設け、その手首部に照明
源と視覚センサを設けた補間機能を有するティーチング
プレイバック制御のロボットで、前記視覚センサからの
位置修正信号に応答してロボットを構成する複数の駆動
軸を制御して前記作業工具の位置を調整する方法におい
て、次のステップからなるロボットの作業開始点への位
置決め制御方法。 (1)照明源により、平板上に作業工具の陰を生成する
。 (2)ロボット座標系での作業工具先端位置およびセン
サ座標系での作業工具先端位置と作業工具の陰の先端位
置を記憶し、作業工具先端と作業工具の陰の先端が一致
するまで作業工具を移動させ、一致した時の作業工具先
端のロボット座標系における位置を記憶し、作業線の方
向を第3の修正方向、作業線と直交する上下方向を第1
の修正方向、第1および第3の修正方向と直交する方向
を第2の修正方向とすると第1の修正方向に対するセン
サ座標系とロボット座標系との変換式を求めメモリへ格
納する。 (3)ロボット座標系およびセンサ座標系における作業
開始点位置、センサ座標系における作業工具先端と作業
工具の陰の先端との距離をメモリへ格納しておき、作業
工具の先端が作業工具の陰の先端と一致するまで作業工
具を移動させ、一致した時の作業開始点のロボット座標
系およびセンサ座標系における位置と前記メモリへ格納
しておいた作業開始点位 置、作業工具先端と作業工具の陰の先端との距離から第
2および第3の修正方向への修正量に対するロボット座
標系とセンサ座標系との変換式を求めメモリへ格納する
。 (4)ロボット座標系において、教示された作業線に平
行な2点間距離とその時のセンサ座標系における2点間
距離により、第3の修正方向へのロボット座標系とセン
サ座標系との変換式を求めメモリへ格納しておく。 (5)照明源により、前記作業工具の陰を生成する。 (6)作業対象物の作業線と前記作業工具と作業工具の
陰を前記視覚センサによって画像認識する。 (7)教示された第3の修正方向に作業開始点が画像認
識されるまで移動させる。 (8)前記作業開始点を検出すると、ステップ(2)〜
(4)で求めておいた変換式からロボット座標系での各
修正方向に対する修正量を演算し、工具先端を作業開始
点へ移動させる。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP1798886A JPH0766288B2 (ja) | 1986-01-31 | 1986-01-31 | ロボツトの作業開始点への位置決め制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP1798886A JPH0766288B2 (ja) | 1986-01-31 | 1986-01-31 | ロボツトの作業開始点への位置決め制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS62177602A true JPS62177602A (ja) | 1987-08-04 |
JPH0766288B2 JPH0766288B2 (ja) | 1995-07-19 |
Family
ID=11959102
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP1798886A Expired - Lifetime JPH0766288B2 (ja) | 1986-01-31 | 1986-01-31 | ロボツトの作業開始点への位置決め制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0766288B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005131761A (ja) * | 2003-10-31 | 2005-05-26 | Fanuc Ltd | 産業用ロボット |
-
1986
- 1986-01-31 JP JP1798886A patent/JPH0766288B2/ja not_active Expired - Lifetime
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005131761A (ja) * | 2003-10-31 | 2005-05-26 | Fanuc Ltd | 産業用ロボット |
Also Published As
Publication number | Publication date |
---|---|
JPH0766288B2 (ja) | 1995-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US4761596A (en) | Method of detecting and controlling work start point of robot | |
US4969108A (en) | Vision seam tracking method and apparatus for a manipulator | |
US10618164B2 (en) | Robot system having learning control function and learning control method | |
Baeten et al. | Hybrid vision/force control at corners in planar robotic-contour following | |
US20110029131A1 (en) | Apparatus and method for measuring tool center point position of robot | |
JPS6388612A (ja) | 予見追跡制御型ロボツト | |
US5495090A (en) | Welding robot | |
CN108453733B (zh) | 具有反馈控制功能的机器人、运动控制***、方法和介质 | |
JP2728399B2 (ja) | ロボツトの制御方法 | |
JP2008207262A (ja) | マニピュレータシステム | |
JPH07266272A (ja) | マニピュレータ用追従方法及び装置 | |
JP2011083883A (ja) | ロボット装置 | |
JPS63162180A (ja) | ロボツトの教示方法 | |
JPS62177602A (ja) | ロボツトの作業開始点への位置決め制御方法 | |
JPH0693209B2 (ja) | ロボツトの円弧補間姿勢制御装置 | |
JP2011062763A (ja) | ロボット制御装置 | |
JPH0727408B2 (ja) | 固定3次元視覚併用ロボットハンドリング装置 | |
JP3021202B2 (ja) | ロボットの位置姿勢の誘導方法 | |
JP2654206B2 (ja) | タッチアップ方法 | |
JPH07314359A (ja) | マニピュレータ用追従装置およびその制御方法 | |
JP3089027B2 (ja) | ロボット倣い制御装置 | |
JPH01180401A (ja) | 視覚センサ付ロボットの物体認識位置の補正方法 | |
JP2778285B2 (ja) | 倣いセンサロボットシステム | |
JP2914719B2 (ja) | 工業用ロボット | |
JP2022162340A (ja) | ピッキング装置 |