JPS59142617A - ロボツトの制御装置 - Google Patents
ロボツトの制御装置Info
- Publication number
- JPS59142617A JPS59142617A JP1580083A JP1580083A JPS59142617A JP S59142617 A JPS59142617 A JP S59142617A JP 1580083 A JP1580083 A JP 1580083A JP 1580083 A JP1580083 A JP 1580083A JP S59142617 A JPS59142617 A JP S59142617A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- position information
- sensor
- point
- coordinates
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/42—Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
本発明は、位置検出センサ’kA備するロボットの制御
装置に係り、特に上記センサの示す座標系とロボットの
示す座標系との補間に関するものである。
装置に係り、特に上記センサの示す座標系とロボットの
示す座標系との補間に関するものである。
最近、産朶界における自動化設備の一環としての産業用
ロボットの普及には目覚しいものがある。
ロボットの普及には目覚しいものがある。
このようなロボットは、その作業を正確に行なわせるた
め、各移動目的地を示す位置データを予め教示され、そ
の教示順序に従って動作する。また、命令言語全理解す
るロボットは、その命令言語の順序に従って動作するの
が一般的である。このようなロボットはこれらの動作の
他、さらにロボット機能の汎用性およびその動作の自由
雇ヲより一層高めるために、ロボットの制御装置に動作
の目的地を検出する位置検出センサ(以下「センサ」と
いう。)を新たに接続しfcものが提案されている。こ
れによるとこのセンサによって予め目的地全検出し、そ
の目的地を予め教示された位置データに従って比較的自
由にロボットヲ勤咋させることができるものである。
め、各移動目的地を示す位置データを予め教示され、そ
の教示順序に従って動作する。また、命令言語全理解す
るロボットは、その命令言語の順序に従って動作するの
が一般的である。このようなロボットはこれらの動作の
他、さらにロボット機能の汎用性およびその動作の自由
雇ヲより一層高めるために、ロボットの制御装置に動作
の目的地を検出する位置検出センサ(以下「センサ」と
いう。)を新たに接続しfcものが提案されている。こ
れによるとこのセンサによって予め目的地全検出し、そ
の目的地を予め教示された位置データに従って比較的自
由にロボットヲ勤咋させることができるものである。
しかしながら、このようなロボットの制御装置では、ロ
ボットの制御装置のもつ位置を示す座標系と、センサの
もつその座標系とは座標系が相異するため、センサの検
出した位置座標が、そのままロボット制御装置の教示す
る位置煽標と一致しないことは明らかである。すなわち
空間的には同一地点を検出しても、ロボットの制御装置
の座標系の示す位置データとセンサの座標系の示す位置
データとは相異することとなる。
ボットの制御装置のもつ位置を示す座標系と、センサの
もつその座標系とは座標系が相異するため、センサの検
出した位置座標が、そのままロボット制御装置の教示す
る位置煽標と一致しないことは明らかである。すなわち
空間的には同一地点を検出しても、ロボットの制御装置
の座標系の示す位置データとセンサの座標系の示す位置
データとは相異することとなる。
そこで、これらの各座標系の関係全図示すると第1図の
ようになる。同図において0R−XRYRViロボット
の座標系(ロボット制御装置が取扱う座標系)を、0.
5−XsY8はセンサの座標系(センサが検出する座標
値を示す座標系)を示すものであり、空間の任意の地点
へを上記各座標系上に示すと、それぞれ(”R4yR)
+(z8s 11B) (!: fi ’)、コnうK
i’を次式の関係が成立する。
ようになる。同図において0R−XRYRViロボット
の座標系(ロボット制御装置が取扱う座標系)を、0.
5−XsY8はセンサの座標系(センサが検出する座標
値を示す座標系)を示すものであり、空間の任意の地点
へを上記各座標系上に示すと、それぞれ(”R4yR)
+(z8s 11B) (!: fi ’)、コnうK
i’を次式の関係が成立する。
ここで(XFs YF)および α、はそnぞれロボッ
トの座標系をセンサの座標系に変換するときの平行移動
値および同転移動値を示すものである。そしてこれらの
各数値が両座標系間の補間データとなるものである。
トの座標系をセンサの座標系に変換するときの平行移動
値および同転移動値を示すものである。そしてこれらの
各数値が両座標系間の補間データとなるものである。
然して、上記(1)式から明らかなように、高精度の位
置データをロボット制御装置に教示するためKは、セン
サによる位置の検出精度はもとより、ロボットの座標系
とセンサの座標系との補間データも当然正確であること
が要求される。ところが、従来の同種の教示方法として
は、 (イ)ロボット及びセンサを各々個別に据付け、その後
物理的に補間データを測定装Mvcよって測定して教示
する方法 (ロ)ロボットの座標系とセンサの座標系とを完全に一
致させるようにロボットとセンサを正確に据付ける方法 等が行なわnている。しかしこれらの方法はいずれも、
物理的に存在しないそnぞnの座標系間のデータを検出
するという極めて困難な作業を必要とし、さらに据付は
状態が変わる度ごとに、この困難な測定作業を行わなけ
ればならず、また補間データをその都度教示する必要が
あった。
置データをロボット制御装置に教示するためKは、セン
サによる位置の検出精度はもとより、ロボットの座標系
とセンサの座標系との補間データも当然正確であること
が要求される。ところが、従来の同種の教示方法として
は、 (イ)ロボット及びセンサを各々個別に据付け、その後
物理的に補間データを測定装Mvcよって測定して教示
する方法 (ロ)ロボットの座標系とセンサの座標系とを完全に一
致させるようにロボットとセンサを正確に据付ける方法 等が行なわnている。しかしこれらの方法はいずれも、
物理的に存在しないそnぞnの座標系間のデータを検出
するという極めて困難な作業を必要とし、さらに据付は
状態が変わる度ごとに、この困難な測定作業を行わなけ
ればならず、また補間データをその都度教示する必要が
あった。
本発明は叙上の欠点を解消すべくなされたもので、ロボ
ットの位置情報を記憶する記憶部と、この位fit情報
に基づき動作位置を演算する演算部と、位置情報を教示
する教示都と、この教示に基づき位置指令を発する出力
部とを備えると共に、対象物の位置情報を検出する位置
検出センサに接続され、これと位置情報の授受を行なう
センサインターフェースs’e備え、この位置検出セン
サの検出 5− する位置情報をこnとは別の座標系のロボットの位置情
報として処理できるよう予めこれらの位童情報間の補間
データを上記演算部で処理することを特命とするロボッ
トの制御装置を提供するものである。
ットの位置情報を記憶する記憶部と、この位fit情報
に基づき動作位置を演算する演算部と、位置情報を教示
する教示都と、この教示に基づき位置指令を発する出力
部とを備えると共に、対象物の位置情報を検出する位置
検出センサに接続され、これと位置情報の授受を行なう
センサインターフェースs’e備え、この位置検出セン
サの検出 5− する位置情報をこnとは別の座標系のロボットの位置情
報として処理できるよう予めこれらの位童情報間の補間
データを上記演算部で処理することを特命とするロボッ
トの制御装置を提供するものである。
次に第2図、第3図に示す実施例に基づき本発明全説明
すると、第2図は本実施例に係るロボット(1)とこの
ロボット(1)の動作を制御するロボット制御装置(2
)と、ロボット(1)の動作位置をカメラ(3a)で検
出するセンサ(8)とからなる構成図を示したものであ
る。そして上記制御装置(2)は位置データに基づきロ
ボット(1)の動作位置を演算するマイク′ロコンピュ
ータ等を内蔵する制御演算!(以下「制御演算部」とい
う。)(4)と、この演算のためのセンサ(8)の位置
データを上記センサ(8)から授受するセンサインター
フェース地(以下「インターフェース部」という。)
(5)と、ロボットの現在位置情報全記憶するロボット
位置記憶部(以下「記憶部」といつ。)(6)と、ロボ
ットを駆動させるためのサーボアンプ等を内蔵する位置
指令出力部(以6− 下「出力部」という。)(γ)と、ロボット(1)の動
作を教示するスイッチ類で構成さ扛る教示部(以下「教
示部」という。)(8)と全備え、ロボット(1)の@
咋を正確にコントロールするものである。さらに上記教
示部(8)は、ロボット(1)の位置情報の1記録追加
」指令を発する追加指令スイッチ(四と、上記位置情報
の「記録補正」指令を発する補正指令スイッチ(F@と
、上記位置情報の「記録抹消」指令を発する抹消指令ス
イッチ(88Iと、上記位置情報の「記録終了」指令を
発する終了指令スイッチe1+と、ロボット(γ)を手
動操作する「JOG」指令を発するJOG指令スイッチ
(5)と、ロボット(1)とセンサ(8)の両座標系の
補間作業を開始させる補間開始スイッチ(86)とを備
えている。
すると、第2図は本実施例に係るロボット(1)とこの
ロボット(1)の動作を制御するロボット制御装置(2
)と、ロボット(1)の動作位置をカメラ(3a)で検
出するセンサ(8)とからなる構成図を示したものであ
る。そして上記制御装置(2)は位置データに基づきロ
ボット(1)の動作位置を演算するマイク′ロコンピュ
ータ等を内蔵する制御演算!(以下「制御演算部」とい
う。)(4)と、この演算のためのセンサ(8)の位置
データを上記センサ(8)から授受するセンサインター
フェース地(以下「インターフェース部」という。)
(5)と、ロボットの現在位置情報全記憶するロボット
位置記憶部(以下「記憶部」といつ。)(6)と、ロボ
ットを駆動させるためのサーボアンプ等を内蔵する位置
指令出力部(以6− 下「出力部」という。)(γ)と、ロボット(1)の動
作を教示するスイッチ類で構成さ扛る教示部(以下「教
示部」という。)(8)と全備え、ロボット(1)の@
咋を正確にコントロールするものである。さらに上記教
示部(8)は、ロボット(1)の位置情報の1記録追加
」指令を発する追加指令スイッチ(四と、上記位置情報
の「記録補正」指令を発する補正指令スイッチ(F@と
、上記位置情報の「記録抹消」指令を発する抹消指令ス
イッチ(88Iと、上記位置情報の「記録終了」指令を
発する終了指令スイッチe1+と、ロボット(γ)を手
動操作する「JOG」指令を発するJOG指令スイッチ
(5)と、ロボット(1)とセンサ(8)の両座標系の
補間作業を開始させる補間開始スイッチ(86)とを備
えている。
一方、第3図は、空間における任意の2点体)。
(B) ’!r 、上記ロボットの座標系(OR−xR
YR)とセンサの座標系(oB−xsy、)で表示した
ものである。すなわち上記の2点(A) I (B)
wロボットの座標系で表示するとそれぞれ座標(xRA
、YRA)、(xRB、YRB)となり、センサの座標
系で表示すると上記2点(AI I (B)は(YsA
、YIIIA)、(x8BIYsB)トナル。
YR)とセンサの座標系(oB−xsy、)で表示した
ものである。すなわち上記の2点(A) I (B)
wロボットの座標系で表示するとそれぞれ座標(xRA
、YRA)、(xRB、YRB)となり、センサの座標
系で表示すると上記2点(AI I (B)は(YsA
、YIIIA)、(x8BIYsB)トナル。
次に上記2点図、(B)を基準として、上記ロボット(
1)、ロボット制御装置(2)およびセンサ(8)によ
って補間データである平行移動値(XFI Yy)およ
び回転移動値(αF)全演算する動作についてi兄明す
る。
1)、ロボット制御装置(2)およびセンサ(8)によ
って補間データである平行移動値(XFI Yy)およ
び回転移動値(αF)全演算する動作についてi兄明す
る。
まず上記ロボット(1)、制御装置(2〕および(8)
全動作可能な状態にしておき、その後、上記教示部(8
)の補間開始スイッチ((至)を押して補間開始指令を
発し、この信号を上記演算部(4)に入力し、演算を待
機させる。次に追加指令スイッチ(明を押すことにより
、演算部(4)にはインターフェース部(5)を介して
センサ(81vcよって検出された点Aの位置データと
なる座標(X8AI YIIIA)が入力ざnる。ざら
に教示部(8)のJOGスイッチ(851上押して、J
oG指令全演算部(4)に入力する・と、前記出力部(
γ)を介してロボット本体(1)の手先を手動操作によ
って第6図の点Aに合わす。このようにロボット本体(
1)の手先を点Aに合わせた後、上記教示部(8)の補
正指令スイッチ((至)を押し制御演算部(4)にロボ
ットの位置を記憶する記憶ill (6) VCよって
点Aの座標(XRA、YRA)ヲ取り込ませる。続いて
教示部(8)の抹消指令スイッチ印)ヲ押すことにより
、制御演算部(4)にインターフェース部(5)′t−
介してセンサ(8)によって第3図の点Bの座標(X
s B * Ys E )を新たに取り込fせ、上記操
作同様にJOG指令スイッチ倒ヲ押し、このJoG指令
を制御演算部(4)に入力し、出力部(γ)全弁してロ
ボット本体(1)の手先を、第6図の点Bに合わせる。
全動作可能な状態にしておき、その後、上記教示部(8
)の補間開始スイッチ((至)を押して補間開始指令を
発し、この信号を上記演算部(4)に入力し、演算を待
機させる。次に追加指令スイッチ(明を押すことにより
、演算部(4)にはインターフェース部(5)を介して
センサ(81vcよって検出された点Aの位置データと
なる座標(X8AI YIIIA)が入力ざnる。ざら
に教示部(8)のJOGスイッチ(851上押して、J
oG指令全演算部(4)に入力する・と、前記出力部(
γ)を介してロボット本体(1)の手先を手動操作によ
って第6図の点Aに合わす。このようにロボット本体(
1)の手先を点Aに合わせた後、上記教示部(8)の補
正指令スイッチ((至)を押し制御演算部(4)にロボ
ットの位置を記憶する記憶ill (6) VCよって
点Aの座標(XRA、YRA)ヲ取り込ませる。続いて
教示部(8)の抹消指令スイッチ印)ヲ押すことにより
、制御演算部(4)にインターフェース部(5)′t−
介してセンサ(8)によって第3図の点Bの座標(X
s B * Ys E )を新たに取り込fせ、上記操
作同様にJOG指令スイッチ倒ヲ押し、このJoG指令
を制御演算部(4)に入力し、出力部(γ)全弁してロ
ボット本体(1)の手先を、第6図の点Bに合わせる。
このような位置合わせ操作の終了後、教示部(8)の終
了指令スイッチ(四を押して演算部(4)に上記記憶部
(6)によってロボットの現在位置である点Bの座標(
xRBIYRB)を取り込ませると、この演算部(4)
は、取り込み終了と同時に4個の座標(xRA、YRA
)。
了指令スイッチ(四を押して演算部(4)に上記記憶部
(6)によってロボットの現在位置である点Bの座標(
xRBIYRB)を取り込ませると、この演算部(4)
は、取り込み終了と同時に4個の座標(xRA、YRA
)。
(YsA、YsA)および(XRB、YRB)、(X8
B、X8B)と前記方程式(1)とから補間データとな
る平行移動値(xl。
B、X8B)と前記方程式(1)とから補間データとな
る平行移動値(xl。
y、)回転移動値(αりとを算出することとなる。
以上述べた手順により異なった座標系を有するロボット
本体(1)とセンサ(8)との補間データを教示するこ
とかできる。
本体(1)とセンサ(8)との補間データを教示するこ
とかできる。
なお、上記実施例では、教示部(8)の兼用スイッチを
「記録追加」、「記録補正」、「記録抹消」。
「記録追加」、「記録補正」、「記録抹消」。
9−
「記録終了」としているが、特にこ7’l[限定さnる
ものではなく、また位置情報を取り込む手順についても
、その手順に前後があってもよいことは言うまでもない
。また、上記実施例では2次元の座標系についてのみ説
明したが、3次元以上のものであっても同効が奏せらn
ることは明白である。
ものではなく、また位置情報を取り込む手順についても
、その手順に前後があってもよいことは言うまでもない
。また、上記実施例では2次元の座標系についてのみ説
明したが、3次元以上のものであっても同効が奏せらn
ることは明白である。
さらに、ロボットを動作させる制御プログラムおよび制
御データを作成し、入力される制御入力装置(図示せず
)を有するロボット制御装置では、この入力装置がキー
スイッチ等で構成されていると、上述した補間指令部■
)とこの入力装置と1−一体とし、これらの補間指令部
(団)のスイッチと入力装置のスイッチと全兼用させる
ことかできる利点が得られる。
御データを作成し、入力される制御入力装置(図示せず
)を有するロボット制御装置では、この入力装置がキー
スイッチ等で構成されていると、上述した補間指令部■
)とこの入力装置と1−一体とし、これらの補間指令部
(団)のスイッチと入力装置のスイッチと全兼用させる
ことかできる利点が得られる。
以上、本発明によnば、位置検出センサの有する座標系
と、ロボット本体の有する座標系とが相違するものであ
っても、同一空間の2点の位置がそnぞれの座標系で特
定されさえすれば、両座様系間の補間データは自動的に
演算さn1機能性に富んだ、正確な動作をするロボット
を得ることが10− できる。
と、ロボット本体の有する座標系とが相違するものであ
っても、同一空間の2点の位置がそnぞれの座標系で特
定されさえすれば、両座様系間の補間データは自動的に
演算さn1機能性に富んだ、正確な動作をするロボット
を得ることが10− できる。
第1図はロボット本体と位置検出センサのそ五ぞれの座
標系の相関関係を示す座標、第2図は本願発明の一実施
例を示すロボットの構成図、第6図は空間の2点を示す
第1図と同様の座標である。 (11: 0ボット本体(2):ロボットの制御装置(
8):位置検出センサ (4):制御演算部(5):セ
ンサインターフェース部 (6):記憶部 (γ):位置指令出力部代理
人 葛 野 信 − 第 1 図 −11− 1に3 図 ■
標系の相関関係を示す座標、第2図は本願発明の一実施
例を示すロボットの構成図、第6図は空間の2点を示す
第1図と同様の座標である。 (11: 0ボット本体(2):ロボットの制御装置(
8):位置検出センサ (4):制御演算部(5):セ
ンサインターフェース部 (6):記憶部 (γ):位置指令出力部代理
人 葛 野 信 − 第 1 図 −11− 1に3 図 ■
Claims (1)
- 【特許請求の範囲】 (1)ロボットの位置情報を記憶する記憶部と、この位
置情報に基づき動作位置を演算する演算部と、位置情報
を教示する教示部と、この教示に基づき位置指令を発す
る出力部とを備えると共に、対象物の位置情報を検出す
る位置検出センサに接続さ九、こ几と位置情報の授受を
行なうセンサインターフェース部ヲ備え、この位置検出
センサの検出する位置情報をこnとは別の座標系のロボ
ットの位置情報として処理できるよう予めこnらの位置
情報間の補間データを上記演算部で処理することを特徴
とするロボットの制御装置。 (2)上記演算部は、空間の異なる2点の位置について
、上記位置検出センサおよびロボットのそnぞれ固有の
位置情報を取り込み、こnらの谷位置情報から上記補間
データを演算処理することを特徴とする特許請求の範囲
第1項記載のロボットの制御装置。 (8)上記演算部は、各位置情報を逐次取り込み補間指
令の発信に基いて演算処理を行なうことを特徴とする特
許請求の範囲第1項および第2項記載のいず几かのロボ
ットの制御装置。 (4)上記教示部より補間指令を発信する構成とし、こ
の教示部に教示と補間指令の両機能上兼用させたこと全
特徴とする特許請求の範囲第1項記載のロボットの制御
装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP1580083A JPS59142617A (ja) | 1983-02-02 | 1983-02-02 | ロボツトの制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP1580083A JPS59142617A (ja) | 1983-02-02 | 1983-02-02 | ロボツトの制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS59142617A true JPS59142617A (ja) | 1984-08-15 |
Family
ID=11898911
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP1580083A Pending JPS59142617A (ja) | 1983-02-02 | 1983-02-02 | ロボツトの制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS59142617A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1992015838A1 (en) * | 1991-03-07 | 1992-09-17 | Fanuc Ltd | Detection position correction system |
CN109866069A (zh) * | 2019-01-15 | 2019-06-11 | 浙江工业大学 | 一种桁架机械手矩形料仓放料孔自动定位的计算方法 |
-
1983
- 1983-02-02 JP JP1580083A patent/JPS59142617A/ja active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1992015838A1 (en) * | 1991-03-07 | 1992-09-17 | Fanuc Ltd | Detection position correction system |
US5319443A (en) * | 1991-03-07 | 1994-06-07 | Fanuc Ltd | Detected position correcting method |
CN109866069A (zh) * | 2019-01-15 | 2019-06-11 | 浙江工业大学 | 一种桁架机械手矩形料仓放料孔自动定位的计算方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR890005032B1 (ko) | 공업용 로보트의 동작교시방법 및 장치 | |
JP4737668B2 (ja) | 3次元計測方法および3次元計測システム | |
US4448342A (en) | Method and device for tracer correction in a welding robot | |
KR950000814B1 (ko) | 로보트의 동작지시 방법 및 제어장치 | |
JP6466661B2 (ja) | ロボットの教示点変換方法、装置、及びロボットセル | |
EP0511396B1 (en) | Method for setting coordinate system of robot | |
JPH0784631A (ja) | ロボットの教示プログラムの補正方法 | |
CN112203811B (zh) | 机器人***及机器人控制方法 | |
JP2001050741A (ja) | ロボットのキャリブレーション方法及び装置 | |
JPH03213251A (ja) | ワーク位置検知装置 | |
JPH07266272A (ja) | マニピュレータ用追従方法及び装置 | |
CN105479431A (zh) | 惯性导航式机器人示教设备 | |
JPH01234140A (ja) | 工具の自重による影響を除去する装置 | |
JPS59142617A (ja) | ロボツトの制御装置 | |
CN116728397A (zh) | 机器人***、机器人控制方法和计算机可读存储介质 | |
JPH05345291A (ja) | ロボットの動作範囲制限方式 | |
JP3007440B2 (ja) | ロボットのオフライン教示装置 | |
JPH01106107A (ja) | 手先視覚を持つロボットの制御方法とその装置 | |
JP2001051713A (ja) | ロボットの作業教示方法及び装置 | |
JPS60195613A (ja) | 検証機能付ロボツト教示装置 | |
JPH0829152A (ja) | 座標測定機の測定処理方法及びその装置 | |
JPH0731536B2 (ja) | 教示デ−タ補正ロボツト | |
JPH0561648B2 (ja) | ||
JP2001018182A (ja) | ロボット機構較正演算方法及びシステム | |
JP3078884B2 (ja) | 倣い制御装置 |