JPH0259285A - ロボットの動作教示方法および制御装置 - Google Patents
ロボットの動作教示方法および制御装置Info
- Publication number
- JPH0259285A JPH0259285A JP63210304A JP21030488A JPH0259285A JP H0259285 A JPH0259285 A JP H0259285A JP 63210304 A JP63210304 A JP 63210304A JP 21030488 A JP21030488 A JP 21030488A JP H0259285 A JPH0259285 A JP H0259285A
- Authority
- JP
- Japan
- Prior art keywords
- reference point
- robot
- current
- tip
- positions
- 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 38
- 230000036544 posture Effects 0.000 claims 3
- 230000008569 process Effects 0.000 description 12
- 238000010586 diagram Methods 0.000 description 10
- 239000013598 vector Substances 0.000 description 6
- 238000004891 communication Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- OVSKIKFHRZPJSS-UHFFFAOYSA-N 2,4-D Chemical compound OC(=O)COC1=CC=C(Cl)C=C1Cl OVSKIKFHRZPJSS-UHFFFAOYSA-N 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000003795 chemical substances by application Substances 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- 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
- G05B19/425—Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
-
- 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/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
- G05B19/41815—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell
- G05B19/4182—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell manipulators and conveyor only
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39124—Grasp common rigid object, no movement end effectors relative to object
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39138—Calculate path of robots from path of point on gripped object
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
産業上の利用分野
本発明は、産業用ロボットの動作教示方法および制御装
置に関する。特に、複数台のロボットマニピュレータで
1つのワークを把持して移動する動作のように複数のロ
ボットマニピュレータが互いの相対位置を保って動作す
る作業の教示を容易なものにする教示方法と制御装置に
関する。
置に関する。特に、複数台のロボットマニピュレータで
1つのワークを把持して移動する動作のように複数のロ
ボットマニピュレータが互いの相対位置を保って動作す
る作業の教示を容易なものにする教示方法と制御装置に
関する。
従来の技術
複数のロボットマニピュレータが1つのワークを把持し
て移動するというような複数ロボットの協同作業では、
複数のロボットマニピュレータが互いの相対位置を正確
に保って動作する必要がある。従来、このような動作を
教示する方法として次のようなものがあった。
て移動するというような複数ロボットの協同作業では、
複数のロボットマニピュレータが互いの相対位置を正確
に保って動作する必要がある。従来、このような動作を
教示する方法として次のようなものがあった。
第1の方法は、オフライン教示であり、ロボットの動作
位置を計算機上のデータとして数値入力し設定教示する
ものである。
位置を計算機上のデータとして数値入力し設定教示する
ものである。
第2の方法は、ティーチングボックス等を用いて実際の
作業での動作位置にロボットをマニュアル動作させ、そ
の時のロボットの位置姿勢を検出し記憶することによシ
、ロボットの動作位置を教示するものである。この方法
では、複数のロボットそれぞれについて、先端のハンド
ル姿勢も含めた相対位置を正確に保った位置姿勢をマニ
ュアル動作で教示することは非常に難しい。そこで、協
同作業のはじめの位置のみ複数ロボットの位置教示を行
い、その後の協同作業の教示位置は複数ロボットのうち
のいずれか1つのロボットの動作位置を教示し、運転動
作時には前記位置教示されたロボットの動作経路に対し
てはじめの複数ロボットの教示位置間の相対位置を保つ
ように複数ロボットに動作させるといった方法がとられ
ることもあった。この方法の一例を第2図に示す。この
例では、第1のロボットマニピュレータの動作位置姿勢
P1.P2.P3.P4と、Plに対応する第2のロボ
ットマニピュレータの動作位置姿勢Q1を教示し、Pl
とQlの相対位置とP2. P3゜P4から第2のロ
ボットマニピュレータの動作位置姿勢Q2.Qs、Q4
を計算により決定し、各マニピュレータの動作経路を補
間している。
作業での動作位置にロボットをマニュアル動作させ、そ
の時のロボットの位置姿勢を検出し記憶することによシ
、ロボットの動作位置を教示するものである。この方法
では、複数のロボットそれぞれについて、先端のハンド
ル姿勢も含めた相対位置を正確に保った位置姿勢をマニ
ュアル動作で教示することは非常に難しい。そこで、協
同作業のはじめの位置のみ複数ロボットの位置教示を行
い、その後の協同作業の教示位置は複数ロボットのうち
のいずれか1つのロボットの動作位置を教示し、運転動
作時には前記位置教示されたロボットの動作経路に対し
てはじめの複数ロボットの教示位置間の相対位置を保つ
ように複数ロボットに動作させるといった方法がとられ
ることもあった。この方法の一例を第2図に示す。この
例では、第1のロボットマニピュレータの動作位置姿勢
P1.P2.P3.P4と、Plに対応する第2のロボ
ットマニピュレータの動作位置姿勢Q1を教示し、Pl
とQlの相対位置とP2. P3゜P4から第2のロ
ボットマニピュレータの動作位置姿勢Q2.Qs、Q4
を計算により決定し、各マニピュレータの動作経路を補
間している。
発明が解決しようとする課題
上記第1の方法では、計算機上のデータとじて数値入力
して設定するため、実際のワークに対するロボットの動
作位置の教示精度が必ずしも良くない場合がある。
して設定するため、実際のワークに対するロボットの動
作位置の教示精度が必ずしも良くない場合がある。
上記第2の方法では、実際の動作位置にロボットをマニ
ュアル動作させて位置を検出記憶するだめ、教示精度は
良いが、全ての動作位置をロボットマニピュレータの動
作位置で教示するため、ワークを把持して動作する場合
には把持位置を正確に教示することになり、ワークの移
動経路を主体にした教示ができない。特に、ワークに関
するセンサの位置検出値からワークの移動位置・姿勢に
動作補正を行うような場合、ロボットマニピュレータの
列で動作経路を教示すると、動作補正後の動作目標位置
はすべてロボットマニピュレータの把持位置に変換計算
する形でプログラムしなければならず、プログラミング
が面倒になるという問題がある。
ュアル動作させて位置を検出記憶するだめ、教示精度は
良いが、全ての動作位置をロボットマニピュレータの動
作位置で教示するため、ワークを把持して動作する場合
には把持位置を正確に教示することになり、ワークの移
動経路を主体にした教示ができない。特に、ワークに関
するセンサの位置検出値からワークの移動位置・姿勢に
動作補正を行うような場合、ロボットマニピュレータの
列で動作経路を教示すると、動作補正後の動作目標位置
はすべてロボットマニピュレータの把持位置に変換計算
する形でプログラムしなければならず、プログラミング
が面倒になるという問題がある。
また、教示の際に把持姿勢を精細に教えることは難しい
が、大きなワークを2台のロボノトマニュレータで把持
して移動する動作の教示を1台のロボットマニピュレー
タの把持位置で教示すると、例えば第17図のように教
示時の把持姿勢のわずかな違いがワークの他端では大き
な変位となり、これが他端を把持するロボットマニピュ
レータの動作にとって問題となることがある。
が、大きなワークを2台のロボノトマニュレータで把持
して移動する動作の教示を1台のロボットマニピュレー
タの把持位置で教示すると、例えば第17図のように教
示時の把持姿勢のわずかな違いがワークの他端では大き
な変位となり、これが他端を把持するロボットマニピュ
レータの動作にとって問題となることがある。
本発明の目的は、実際のワークの移動位置をもとにしな
がら、複数ロボットマニピュレータの動作教示を精度よ
くかつ容易に行うことができ、ワーク位置姿勢に関する
センサフィードバックの対応も容易なワーク主体の教示
方法とそのだめのロボットマニピュレータの制御装置を
提供することである。
がら、複数ロボットマニピュレータの動作教示を精度よ
くかつ容易に行うことができ、ワーク位置姿勢に関する
センサフィードバックの対応も容易なワーク主体の教示
方法とそのだめのロボットマニピュレータの制御装置を
提供することである。
課題を解決するだめの手段
上記課題を解決するために、本発明の第1の発明(7)
ロボットの動作教示方法では、ロボットヲマニュアル動
作させてロボット先端位置を記憶させることにより、移
動経路上の代表的な位置と姿勢を表わす参照点と運転動
作時のロボット先端の動作位置の前記参照点からの相対
位置とを教示し、参照点の列で運転動作時のロボット先
端の動作位置経路を指定するという方法をとっている。
ロボットの動作教示方法では、ロボットヲマニュアル動
作させてロボット先端位置を記憶させることにより、移
動経路上の代表的な位置と姿勢を表わす参照点と運転動
作時のロボット先端の動作位置の前記参照点からの相対
位置とを教示し、参照点の列で運転動作時のロボット先
端の動作位置経路を指定するという方法をとっている。
1つのワークを複数のロボットで把持し移動する場合に
は、ワーク上の特定の点を参照点としてロボットに記憶
させ、前記参照点と各ロボットの把持位置の相対位置を
教示し、ワークの移動を、参照点の列で指定することに
なる。
は、ワーク上の特定の点を参照点としてロボットに記憶
させ、前記参照点と各ロボットの把持位置の相対位置を
教示し、ワークの移動を、参照点の列で指定することに
なる。
また、本発明の第2の発明のロボットの制御装置では、
ロボットをマニュアル動作させる手段と、ロボット先端
の現在位置又は現在位置姿勢を検出して記憶する手段と
、記憶された複数の位置から参照点を算出し記憶する手
段と、参照点の1つからのロボット先端の位置姿勢の相
対位置を算出し記憶する手段と、記憶された参照点と相
対位置を指定されてこれらをもとにロボットの動作目標
位置を算出しロボットに動作させる手段と、現在の参照
点と次の参照点を指定されて、現在の参照点とロボット
先端の相対位置を保ちながら、現在の参照点と次の参照
点の間を補間して参照点を移動するようにロボットを動
作させる手段を有している。
ロボットをマニュアル動作させる手段と、ロボット先端
の現在位置又は現在位置姿勢を検出して記憶する手段と
、記憶された複数の位置から参照点を算出し記憶する手
段と、参照点の1つからのロボット先端の位置姿勢の相
対位置を算出し記憶する手段と、記憶された参照点と相
対位置を指定されてこれらをもとにロボットの動作目標
位置を算出しロボットに動作させる手段と、現在の参照
点と次の参照点を指定されて、現在の参照点とロボット
先端の相対位置を保ちながら、現在の参照点と次の参照
点の間を補間して参照点を移動するようにロボットを動
作させる手段を有している。
また、本発明の第3の発明のロボットの制御装置では、
ロボットをマニュアル動作させる手段と、ロボット先端
の現在位置または現在位置姿勢を検出して記憶する手段
と、記憶された位置又は位置姿勢を参照点とし、参照点
の1つからのロボット先端の位置姿勢の相対位置を算出
し記憶する手段と、記憶された参照点と相対位置を指定
されてこれらをもと岐ロボットの動作目標位置を算出し
ロボットに動作させる手段と、現在の参照点と次の参照
点を指定されて、現在の参照点とロボット先端の相対位
置を保ちながら、現在の参照点と次の参照点の間を補間
して参照点を移動するようにロボットを動作させる手段
を有している。
ロボットをマニュアル動作させる手段と、ロボット先端
の現在位置または現在位置姿勢を検出して記憶する手段
と、記憶された位置又は位置姿勢を参照点とし、参照点
の1つからのロボット先端の位置姿勢の相対位置を算出
し記憶する手段と、記憶された参照点と相対位置を指定
されてこれらをもと岐ロボットの動作目標位置を算出し
ロボットに動作させる手段と、現在の参照点と次の参照
点を指定されて、現在の参照点とロボット先端の相対位
置を保ちながら、現在の参照点と次の参照点の間を補間
して参照点を移動するようにロボットを動作させる手段
を有している。
作 用
本発明の第1の発明のロボットの動作教示方法では、マ
ニュアル動作させてロボット先端位置を記憶することに
よシ参照点を教示しているため、ワークを移動させる場
合には、ワークの実際の位置をロボットのもつ精度で教
示することができ、運転動作時のロボット先端の参照点
からの相対位置を教示して、動作位置経路の指定は参照
点の列で行うという方法をとっているため、ワークを把
持して移動する動作の教示では、ワークの移動経路と把
持位置の教示を分離でき、センサフィードバック等によ
りワークと把持位置の関係が変わる場合にも動作制御の
対応が容易となる。
ニュアル動作させてロボット先端位置を記憶することに
よシ参照点を教示しているため、ワークを移動させる場
合には、ワークの実際の位置をロボットのもつ精度で教
示することができ、運転動作時のロボット先端の参照点
からの相対位置を教示して、動作位置経路の指定は参照
点の列で行うという方法をとっているため、ワークを把
持して移動する動作の教示では、ワークの移動経路と把
持位置の教示を分離でき、センサフィードバック等によ
りワークと把持位置の関係が変わる場合にも動作制御の
対応が容易となる。
本発明の第2の発明のロボットの制御装置では、ロボッ
トをマニュアル動作させる手段と、ロボットの現在位置
姿勢を記憶する手段により、ワークの実際の移動位置に
基づく点位置と把持位置を記憶することができ、記憶さ
れた複数の位置から参照点を算出し記憶する手段により
、複数の前記ワークの移動位置に基づく点位置から、ワ
ークの移動経路の代表位置が算出でき、参照点の1つか
らのロボット先端の位置姿勢の相対位置を算出し記憶す
る手段により、ワークの把持位置とワークの移動経路の
代表位置との相対位置を算出することができ、参照点と
相対位置を指定されてロボットの動作目標位置としてロ
ボットに動作させる手段によシ、ワークの把持点までロ
ボットを動作させることかでき、現在の参照点と次の参
照点を指定されて現在の参照点とロボット先端の相対位
置を保ち々から現在の参照点と次の参照点の間を補間し
て参照点を移動するようにロボットを動作させる手段に
より、ワークの移動経路を参照点の移動として教示して
ロボットに動作させることができる。
トをマニュアル動作させる手段と、ロボットの現在位置
姿勢を記憶する手段により、ワークの実際の移動位置に
基づく点位置と把持位置を記憶することができ、記憶さ
れた複数の位置から参照点を算出し記憶する手段により
、複数の前記ワークの移動位置に基づく点位置から、ワ
ークの移動経路の代表位置が算出でき、参照点の1つか
らのロボット先端の位置姿勢の相対位置を算出し記憶す
る手段により、ワークの把持位置とワークの移動経路の
代表位置との相対位置を算出することができ、参照点と
相対位置を指定されてロボットの動作目標位置としてロ
ボットに動作させる手段によシ、ワークの把持点までロ
ボットを動作させることかでき、現在の参照点と次の参
照点を指定されて現在の参照点とロボット先端の相対位
置を保ち々から現在の参照点と次の参照点の間を補間し
て参照点を移動するようにロボットを動作させる手段に
より、ワークの移動経路を参照点の移動として教示して
ロボットに動作させることができる。
本発明の第3の発明のロボットの制御装置では、記憶さ
れた位置・姿勢をそのまま参照点としていること以外は
、第2の発明のロボットの制御装置と同様の作用をする
。
れた位置・姿勢をそのまま参照点としていること以外は
、第2の発明のロボットの制御装置と同様の作用をする
。
実施例
以下、実施例を用いて本発明のロボットの動作教示方法
および制御装置について説明する。
および制御装置について説明する。
本実施例におけるロボットは第3図に示す軸構成を有す
るロボットマニピュレータであり、第4図のように前記
ロボットマニピュレータ2台が制御装置に接続され、制
御装置からの制御によ仄動作する。各ロボットマニピュ
レータは第3図の軸構成で示すとおり6個の関節をモー
タで駆動され、可動範囲内で先端のハンド位置pと姿勢
(n、 o。
るロボットマニピュレータであり、第4図のように前記
ロボットマニピュレータ2台が制御装置に接続され、制
御装置からの制御によ仄動作する。各ロボットマニピュ
レータは第3図の軸構成で示すとおり6個の関節をモー
タで駆動され、可動範囲内で先端のハンド位置pと姿勢
(n、 o。
a)を任意にとることが可能である。ただし、pは本実
施例のシステムで固定した座標系(O,X。
施例のシステムで固定した座標系(O,X。
Y、Z)におけるハンド位置ベクトルであり、(n、o
、a)は前記座標系における直交する単位ベクトルであ
る。
、a)は前記座標系における直交する単位ベクトルであ
る。
制御装置は、前記各モータに取シ付けられたエンコーダ
によシモータの現在位置すなわち関節角度を検出し、前
記各モータを駆動しフィードバック制御することにより
、各ロボットマニピュレータの動作を制御する。
によシモータの現在位置すなわち関節角度を検出し、前
記各モータを駆動しフィードバック制御することにより
、各ロボットマニピュレータの動作を制御する。
第5図に制御装置の構成を示す。中央制御ユニット10
は、第6図に示すようにマイクロコンピュータ16とメ
モリ17とl1018から構成され、マイクロコンピュ
ータ16はメモリ1了に格納されたプログラムによシ動
作する。l10zaKは、通信線19.20にてコンソ
ール端末8とティーチングボックス7が接続され、本シ
ステムの操作者がコンソール端末8から入力する信号に
従って中央制御ユニット10のマイクロコンピュータ1
6は適尚なプログラムを実行し、ロボットマニピュレー
タの制御を行う。演算ユニット11゜12はそれぞれ対
応するロボットマニピュレータの制御演算を行うもので
あり、第7図に示すようニマイクロコンピュータ22と
メモリ23とバス9を介して中央制御ユニット10から
読み書き可能な2ボー)RAM21から構成されている
。サーボ制御ユニツ)13,14には、現在位置を検出
するだめのエンコーダの取り付けられたモータ15(1
)〜15@が接続され、第8図に示すように前記モータ
15(1)〜16(イ)を制御するためのPWM回路を
含む工1024とマイクロコンピュータ26とメモリ2
6とパス9を介して演算ユニット11゜12から読み書
き可能な2ボ一トRAM27から構成されている。
は、第6図に示すようにマイクロコンピュータ16とメ
モリ17とl1018から構成され、マイクロコンピュ
ータ16はメモリ1了に格納されたプログラムによシ動
作する。l10zaKは、通信線19.20にてコンソ
ール端末8とティーチングボックス7が接続され、本シ
ステムの操作者がコンソール端末8から入力する信号に
従って中央制御ユニット10のマイクロコンピュータ1
6は適尚なプログラムを実行し、ロボットマニピュレー
タの制御を行う。演算ユニット11゜12はそれぞれ対
応するロボットマニピュレータの制御演算を行うもので
あり、第7図に示すようニマイクロコンピュータ22と
メモリ23とバス9を介して中央制御ユニット10から
読み書き可能な2ボー)RAM21から構成されている
。サーボ制御ユニツ)13,14には、現在位置を検出
するだめのエンコーダの取り付けられたモータ15(1
)〜15@が接続され、第8図に示すように前記モータ
15(1)〜16(イ)を制御するためのPWM回路を
含む工1024とマイクロコンピュータ26とメモリ2
6とパス9を介して演算ユニット11゜12から読み書
き可能な2ボ一トRAM27から構成されている。
ロボットマニピュレータの動作を行わせる場合には、中
央制御ユニット1oかも演算ユニット11゜12の2ボ
一トRAM21に動作のコマンドとロボットマニピュレ
ータの先端のハンド位置姿勢の目標位置座標(J 、J
、ai、pi )(i=1.2)を書き込むことによ
り、中央制御ユニット10は演算ユニツ)11,12に
ロボットマニピュレータの動作指令を行う。演算ユニッ
)11,12は、中央制御ユニット1oからの動作指令
に応じて、ハンド位置姿勢の目標位置姿勢の目標位置姿
勢(n工+ oi * lLi * pi )からいわ
ゆる逆変換の演算を行いロボットマニピュレータの各関
節角度を算出し、求められた関節角度に対応するモータ
の回転角度を目標値として、サーボ制御ユニット13゜
14の2ポ一トRAM27に動作のコマンドと各モータ
の目標値を書き込むことによりサーボ制御ユニソ113
,14に動作指令を行う。サーボ制御ユニッ)13,1
4は、演算ユニッl−fl 、j2からの動作指令に応
じて、各モータ15(1)〜16θ■に取り付けられた
エンコーダから得られるモータの現在位置と演算ユニノ
)11.12から2ポトRAM27に書き込まれた目標
値にしたがって、モータ1es(1)〜(2)の動作を
制御する。以上のようにして、中央制御ユニッ)10か
らの動作指令により、ロボットマニピュレータのハンド
位置姿勢を所望の位置に動作させることができる。
央制御ユニット1oかも演算ユニット11゜12の2ボ
一トRAM21に動作のコマンドとロボットマニピュレ
ータの先端のハンド位置姿勢の目標位置座標(J 、J
、ai、pi )(i=1.2)を書き込むことによ
り、中央制御ユニット10は演算ユニツ)11,12に
ロボットマニピュレータの動作指令を行う。演算ユニッ
)11,12は、中央制御ユニット1oからの動作指令
に応じて、ハンド位置姿勢の目標位置姿勢の目標位置姿
勢(n工+ oi * lLi * pi )からいわ
ゆる逆変換の演算を行いロボットマニピュレータの各関
節角度を算出し、求められた関節角度に対応するモータ
の回転角度を目標値として、サーボ制御ユニット13゜
14の2ポ一トRAM27に動作のコマンドと各モータ
の目標値を書き込むことによりサーボ制御ユニソ113
,14に動作指令を行う。サーボ制御ユニッ)13,1
4は、演算ユニッl−fl 、j2からの動作指令に応
じて、各モータ15(1)〜16θ■に取り付けられた
エンコーダから得られるモータの現在位置と演算ユニノ
)11.12から2ポトRAM27に書き込まれた目標
値にしたがって、モータ1es(1)〜(2)の動作を
制御する。以上のようにして、中央制御ユニッ)10か
らの動作指令により、ロボットマニピュレータのハンド
位置姿勢を所望の位置に動作させることができる。
次に、本実施例の制御装置において、第2および第3の
発明の制御装置を構成する各手段について説明する。
発明の制御装置を構成する各手段について説明する。
ロボットをマニュアル動作させる手段は、ティーチング
ボックス7と中央制御ユニット10のマイクロコンピュ
ータ16のプログラムによシ実現される。ティーチング
ボックス了はマイクロコンピュータを内蔵し、操作者か
ら制御装置への入力手段として、複数個のキーと通信機
能を有している。すなわち、操作者がキーを押している
間、ティーチングポソクヌ7内のマイクロコンピュータ
は通信によシ制御装置の中央制御ユニット10に対して
押されたキーに対応するコードを送信する。
ボックス7と中央制御ユニット10のマイクロコンピュ
ータ16のプログラムによシ実現される。ティーチング
ボックス了はマイクロコンピュータを内蔵し、操作者か
ら制御装置への入力手段として、複数個のキーと通信機
能を有している。すなわち、操作者がキーを押している
間、ティーチングポソクヌ7内のマイクロコンピュータ
は通信によシ制御装置の中央制御ユニット10に対して
押されたキーに対応するコードを送信する。
中央制御ユニット1Qは、プログラムにより、ティーチ
ングボックス7から送られたコードに従ってロボットマ
ニピュレータに動作指令を行う。このプログラムは、コ
ンソール端末8からの入力により起動され、ティーチン
グボックス7の終了キー人力によシ終了する。第9図に
処理のフローを示す。
ングボックス7から送られたコードに従ってロボットマ
ニピュレータに動作指令を行う。このプログラムは、コ
ンソール端末8からの入力により起動され、ティーチン
グボックス7の終了キー人力によシ終了する。第9図に
処理のフローを示す。
ロボット先端の現在位置を検出し記憶する手段は、次の
ように実現されている。中央制御ユニ。
ように実現されている。中央制御ユニ。
ト1oから演算ユニット11,12へ2ボ一トRAM2
1を介して現在位置検出の指令が送られ、演算ユニット
11.12はこれに応じてサーボ制御ユニッ)13.1
4に現在位置検出の指令を送る。ザーボ制御ユニッ)1
3,14は各モータ15(1)〜(イ)に取り付けられ
たエンコーダのカウンタを読み出し、演算ユニツ)11
,12への応答として各モータ160)〜@の回転角度
を2ポ一トRAM27に書き込む。演算ユニット11,
12は2ポー)RAM27から各モータの回転角を読み
出して、各関節の回転角度を求め、さらにいわゆる正変
換を行い、各関節角度からロボットマニピュレータの先
端位置姿勢(ni+’i+ ar p)を算出し、中央
制御ユニット10への応答として2ポー)RAM21に
先端位置姿勢データを書き込む。
1を介して現在位置検出の指令が送られ、演算ユニット
11.12はこれに応じてサーボ制御ユニッ)13.1
4に現在位置検出の指令を送る。ザーボ制御ユニッ)1
3,14は各モータ15(1)〜(イ)に取り付けられ
たエンコーダのカウンタを読み出し、演算ユニツ)11
,12への応答として各モータ160)〜@の回転角度
を2ポ一トRAM27に書き込む。演算ユニット11,
12は2ポー)RAM27から各モータの回転角を読み
出して、各関節の回転角度を求め、さらにいわゆる正変
換を行い、各関節角度からロボットマニピュレータの先
端位置姿勢(ni+’i+ ar p)を算出し、中央
制御ユニット10への応答として2ポー)RAM21に
先端位置姿勢データを書き込む。
中央制御ユニット10は、2ポー)RAM21から先端
位置姿勢データを読み出し、中央制御二ニット10内の
メモリ17に、先端位置姿勢データに対応する名前とと
もに格納する。名称は、コンソール端末8から操作者が
入力したものを中央制御ユニット1oが読み込む。現在
位置を検出し記憶する手段は、第9図の現在位置記憶処
理として、ティーチングボックス7の操作により起動さ
れる。
位置姿勢データを読み出し、中央制御二ニット10内の
メモリ17に、先端位置姿勢データに対応する名前とと
もに格納する。名称は、コンソール端末8から操作者が
入力したものを中央制御ユニット1oが読み込む。現在
位置を検出し記憶する手段は、第9図の現在位置記憶処
理として、ティーチングボックス7の操作により起動さ
れる。
先端位置姿勢のデータは、姿勢を表す3つの直交する単
位ベクトル(n、o、a)と位置を表すベク) /l/
pから構成されるが、参照点のデータも全く同じ構成
となっている。しだがって第3の発明の制御装置のよう
に現在位置を検出し記憶する手段で記憶された先端位置
姿勢データをそのまま参照点として用いることが可能で
ある。
位ベクトル(n、o、a)と位置を表すベク) /l/
pから構成されるが、参照点のデータも全く同じ構成
となっている。しだがって第3の発明の制御装置のよう
に現在位置を検出し記憶する手段で記憶された先端位置
姿勢データをそのまま参照点として用いることが可能で
ある。
次に、記憶された複数の位置から参照点を算出し記憶す
る手段について説明する。前記手段は本実施例では、中
央制御ユニット1Qのプログラムとして実現されており
、3つの位置から参照点を算出するものと、2つの位置
から参照点を算出するものの2種類があり、いずれもコ
ンソール端末8からの入力により起動される。
る手段について説明する。前記手段は本実施例では、中
央制御ユニット1Qのプログラムとして実現されており
、3つの位置から参照点を算出するものと、2つの位置
から参照点を算出するものの2種類があり、いずれもコ
ンソール端末8からの入力により起動される。
3つの位置から参照点を算出し記憶する処理のフローチ
ャートを第10図に示す。参照点S=(ng + ’
g + ’ B + P B )の算出は次のような計
算によシ行う。
ャートを第10図に示す。参照点S=(ng + ’
g + ’ B + P B )の算出は次のような計
算によシ行う。
p、=p1
n =(p −p )/lp2−plg
21 ”1”P3−pI W2=W1−(Wl・n8)ns o8=w2/1w2i a =n X。
21 ”1”P3−pI W2=W1−(Wl・n8)ns o8=w2/1w2i a =n X。
8 B s
ここでは、第11図に示すようにpsはpl と同じ
であり、n8は、plからp2へ向かう単位ベク) /
L/、08は、p2とpl を結ぶ直線にp3から降し
た垂線の方向の単位ペク)/し、a9 は、n8と0
.の外積となっている。
であり、n8は、plからp2へ向かう単位ベク) /
L/、08は、p2とpl を結ぶ直線にp3から降し
た垂線の方向の単位ペク)/し、a9 は、n8と0
.の外積となっている。
2つの位置から参照点を算出し記憶する処理のフローチ
ャートを第12図に示す。参照点S=(” B r O
B + aB + pg )の算出は次のような計算に
より行う。
ャートを第12図に示す。参照点S=(” B r O
B + aB + pg )の算出は次のような計算に
より行う。
ag=(o、o、1)
pg=p1
w =p −p
w2=w、 −(w、°a s ) a sng=W2
/IW2 o =a Xn SS ここでは、第13図に示すように、pg はplと同じ
であり、asは、ワールド座標系のZ方向単位ペクト/
Vであり、n8 は、pBからa8方向に伸ばした直線
にp2から降した垂線の方向の単位ベク) 1&であり
、08 はa8 とn5 の外積である。
/IW2 o =a Xn SS ここでは、第13図に示すように、pg はplと同じ
であり、asは、ワールド座標系のZ方向単位ペクト/
Vであり、n8 は、pBからa8方向に伸ばした直線
にp2から降した垂線の方向の単位ベク) 1&であり
、08 はa8 とn5 の外積である。
参・照点の1つからのロボットの先端の位置姿勢の相対
位置を算出し記憶する手段は、次の計算を行い結果をメ
モリ17に格納する中央制御ユニット10のプログラム
により実現されている。第14図に処理のフローチャー
トを示す。
位置を算出し記憶する手段は、次の計算を行い結果をメ
モリ17に格納する中央制御ユニット10のプログラム
により実現されている。第14図に処理のフローチャー
トを示す。
とすると相対位置(” l’ la 1p )は、
rrr として計算される。
rrr として計算される。
記憶された参照点と相対位置を指定されてこれらをもと
にロボットの動作目標位置を算出しロボットに動作させ
る手段は、中央制御ユニッ)10のプログラムで実現さ
れている。第16図に処理(D 70− f ヤードを
示す。参照点S= (n、 、o、 、a8. p、)
と相対位置R= (nr、o、 、a、 、pr)とか
ら、動作目標の先端位置姿勢(”+’+ayP)は、ト
を示す。先端位置姿勢T = (nt、 Ot、 al
、 pt)の現在の参照点SO”(”801’110
1’1ilO1p[IO)に対する相対位置R=(n
r r o r + a r t p r )は、次の
ように算出する。
にロボットの動作目標位置を算出しロボットに動作させ
る手段は、中央制御ユニッ)10のプログラムで実現さ
れている。第16図に処理(D 70− f ヤードを
示す。参照点S= (n、 、o、 、a8. p、)
と相対位置R= (nr、o、 、a、 、pr)とか
ら、動作目標の先端位置姿勢(”+’+ayP)は、ト
を示す。先端位置姿勢T = (nt、 Ot、 al
、 pt)の現在の参照点SO”(”801’110
1’1ilO1p[IO)に対する相対位置R=(n
r r o r + a r t p r )は、次の
ように算出する。
また、補間点S(’)= (”gitOgir”sip
’9ai)と相対位置R= (n、 、or、ar、p
、 )から第1番目の先端位置姿勢の動作目標”(i)
”(”tilOti+”ti+pti)は次のように算
出する。
’9ai)と相対位置R= (n、 、or、ar、p
、 )から第1番目の先端位置姿勢の動作目標”(i)
”(”tilOti+”ti+pti)は次のように算
出する。
として計算される。
現在の参照点と次の参照点を指定されて、現在の参照点
とロボット先端の相対位置を保ちながら、現在の参照点
と次の参照点の間を補間して参照点を移動するようにロ
ボットを動作させる手段は、中央制御ユニット10のプ
ログラムにより実現されている。第16図(−)、 (
b)に処理のフローチャー上記各手段において、2つの
ロボットマニピュレータについて機能させる場合には、
対応する各演算ユニツ)11.12に指令を順次送シ、
フローチャートにおける各種演算処理も2台のロボット
マニピュレータそれぞれに対応して実行する。
とロボット先端の相対位置を保ちながら、現在の参照点
と次の参照点の間を補間して参照点を移動するようにロ
ボットを動作させる手段は、中央制御ユニット10のプ
ログラムにより実現されている。第16図(−)、 (
b)に処理のフローチャー上記各手段において、2つの
ロボットマニピュレータについて機能させる場合には、
対応する各演算ユニツ)11.12に指令を順次送シ、
フローチャートにおける各種演算処理も2台のロボット
マニピュレータそれぞれに対応して実行する。
次に、本発明の第1の発明の教示方法の実施例として、
上記制御装置を用いて、2台のロボットマニピュレータ
で1つのワークを移動する動作の教示方法について説明
する。
上記制御装置を用いて、2台のロボットマニピュレータ
で1つのワークを移動する動作の教示方法について説明
する。
第1図に示すように、直方体のワーク3を、第1の位置
から第2の位置へ、さらに第3の位置へ2台のロボット
マニピュレータ1,2で移動する動作を次のように教示
する。
から第2の位置へ、さらに第3の位置へ2台のロボット
マニピュレータ1,2で移動する動作を次のように教示
する。
まず、ワーク3を第1の位置に置き、ティーチングボッ
クス了の動作キーの操作によりロボットマニピュレータ
1または2の先端をワーク3上の点P1に動作させ、現
在位置記憶キーの操作によりPlの位置を記憶させる。
クス了の動作キーの操作によりロボットマニピュレータ
1または2の先端をワーク3上の点P1に動作させ、現
在位置記憶キーの操作によりPlの位置を記憶させる。
さらに同様にワーク3上の他の2点P2.P3にロボッ
トマニピュレータ1捷たは2の先端を移動させ記憶させ
る。そしてワーク3の把持位置P4.P5を記憶させる
。
トマニピュレータ1捷たは2の先端を移動させ記憶させ
る。そしてワーク3の把持位置P4.P5を記憶させる
。
ここでP4.P5はそれぞれ第1の位置にワーク3を置
いた時の第1のロボットマニピュレータ1および第2の
ロボットマニピュレータ2の把持位置である。
いた時の第1のロボットマニピュレータ1および第2の
ロボットマニピュレータ2の把持位置である。
次にワークを第2の位置に置き、Pl、P2゜P3に対
応するワーク上の3点Ps、P−r、Psにティーチン
グボックス7の操作によりロボットマニピュレータ1ま
だは2の先端を移動させ記憶させ、さらにワーク3を第
3の位置に置き、Pl。
応するワーク上の3点Ps、P−r、Psにティーチン
グボックス7の操作によりロボットマニピュレータ1ま
だは2の先端を移動させ記憶させ、さらにワーク3を第
3の位置に置き、Pl。
P2.P3に対応するワーク3上の3点P9゜Plo、
Pllにティーチングボックスγの操作によりロボット
マニピュレータ1または2の先端を移動させ記憶させる
。
Pllにティーチングボックスγの操作によりロボット
マニピュレータ1または2の先端を移動させ記憶させる
。
3つの位置から参照点を算出し記憶する手段を用いて、
前記P1.P2.P3から参照点S1を算出し記憶させ
、前記Pa、P7.P8から参照を82を算出し記憶さ
せ、前記P9.P10.P11から参照点S3を算出し
記憶させる。ここで31゜S2.S3はそれぞれ第1の
位置、第2の位置。
前記P1.P2.P3から参照点S1を算出し記憶させ
、前記Pa、P7.P8から参照を82を算出し記憶さ
せ、前記P9.P10.P11から参照点S3を算出し
記憶させる。ここで31゜S2.S3はそれぞれ第1の
位置、第2の位置。
第3の位置に置かれたワークの位置姿勢を代表する参照
点となっている。
点となっている。
前記S1とP4とから、第1のロボットマニピュレータ
1の把持位置の、参照点に対する相対位置r1を算出し
記憶させ、前記S1とP5とから、第2のロボットマニ
ピュレータ2の把持位置の、参照点に対する相対位置r
2を算出し記憶させる。
1の把持位置の、参照点に対する相対位置r1を算出し
記憶させ、前記S1とP5とから、第2のロボットマニ
ピュレータ2の把持位置の、参照点に対する相対位置r
2を算出し記憶させる。
上記参照点および相対位置の算出と記憶は、コンソール
端末8の操作により、制御装置の中央制御ユニット10
のプログラムを起動することで実行される。
端末8の操作により、制御装置の中央制御ユニット10
のプログラムを起動することで実行される。
動作の実行は、参照点S1と相対位置r1を指定して第
1のロボットマニピュレータ1に把持位置まで動作させ
、参照点S1と相対位置r2を指定して第2のロボット
マニピュレータ2に把持位置まで動作させる。そして、
現在の参照点と次の参照点を指定されて、現在の参照点
と各ロボット先端の相対位置を保ちながら、現在の参照
点と次の参照点の間を補間して参照点を移動するように
各ロボットを動作させる手段を用いて、現在の参照点に
81を指定し次の参照点に82を指定する動作と、現在
の参照点に82を指定し次の参照点に83を指定する動
作をロボットマニピュレータ1および2に行わせること
により、ワークを第1の位置から第2の位置を経て第3
の位置に移動することができる。
1のロボットマニピュレータ1に把持位置まで動作させ
、参照点S1と相対位置r2を指定して第2のロボット
マニピュレータ2に把持位置まで動作させる。そして、
現在の参照点と次の参照点を指定されて、現在の参照点
と各ロボット先端の相対位置を保ちながら、現在の参照
点と次の参照点の間を補間して参照点を移動するように
各ロボットを動作させる手段を用いて、現在の参照点に
81を指定し次の参照点に82を指定する動作と、現在
の参照点に82を指定し次の参照点に83を指定する動
作をロボットマニピュレータ1および2に行わせること
により、ワークを第1の位置から第2の位置を経て第3
の位置に移動することができる。
発明の効果
本発明のロボットの動作教示方法および制御装置では、
実際のワーク位置をロボットマニピュレータの動作位置
から教示するだめ、オフライン教示で起こりがちである
数値入力データと実作業環境の違いによる動作位置精度
上の欠点がなくなる。
実際のワーク位置をロボットマニピュレータの動作位置
から教示するだめ、オフライン教示で起こりがちである
数値入力データと実作業環境の違いによる動作位置精度
上の欠点がなくなる。
lc、ロボットマニピュレータの動作位置を、ワークの
代表位置姿勢である参照点と、各ロボットマニピュレー
タの把持位置の参照点に対する相対位置に分けて教示す
るようにしているため、ワークの移動位置の変更がある
場合には、変更となる参照点のみを再教示すればよく、
また把持位置の変更がある場合には、相対位置のみを再
教示すればよい。また、ワークの移動経路を参照点で指
定するため、複数台のロボットマニピュレータの相対位
置を保ちながら動作教示を行う必要がない。
代表位置姿勢である参照点と、各ロボットマニピュレー
タの把持位置の参照点に対する相対位置に分けて教示す
るようにしているため、ワークの移動位置の変更がある
場合には、変更となる参照点のみを再教示すればよく、
また把持位置の変更がある場合には、相対位置のみを再
教示すればよい。また、ワークの移動経路を参照点で指
定するため、複数台のロボットマニピュレータの相対位
置を保ちながら動作教示を行う必要がない。
また、本発明の方法は、ロボットマニピュレータの台数
が変わっても容易に対応が可能である。また、本発明の
第2の発明では、参照点の教示を複数の教示位置から算
出するようにしているため、教示の際のロボットマニピ
ュータの先端姿勢については気にする必要がない。
が変わっても容易に対応が可能である。また、本発明の
第2の発明では、参照点の教示を複数の教示位置から算
出するようにしているため、教示の際のロボットマニピ
ュータの先端姿勢については気にする必要がない。
以上のように本発明のロボットの動作教示方法と制御装
置では、ワーク本体の考え方で教示できるようになり、
特に複数台のロボットマニピュレータの動作教示では、
精度よく容易な教示が可能となる。
置では、ワーク本体の考え方で教示できるようになり、
特に複数台のロボットマニピュレータの動作教示では、
精度よく容易な教示が可能となる。
第1図は本発明の教示方法の一例の説明図、第2図は従
来の教示方法の一例の説明図、第3図は本発明の一実施
例におけるロボットマニピュレータの軸構成の説明図、
第4図は本実゛施例におけるシ7テム構成の説明図、第
6図は制御装置のハードウェア構成図、第6図は中央制
御ユニットの構成図、第7図は演算ユニットの構成図、
第8図はサーボ制御ユニットの構成図、第9図はティー
チングボックスの処理に関する処理のフローチャト、第
10図は3つの位置から参照点を算出し記憶する処理の
フローチャート、第11図は3つの位置と参照点の関係
の説明図、第12図は2つの位置から参照点を算出し記
憶する処理のフローチャート、第13図は2つの位置と
参照点の関係の説明図、第14図は相対位置を算出し記
憶する処理のフローチャート、第16図は参照点と相対
位置を指定してロボットに動作させる処理のフローチャ
ート、第16図(a)、 (b)は現在の参照点と次の
参照点を指定されて、現在の参照点とロボット先端の相
対位置を保ちながら、現在の参照点と次の参照点の間を
補間して参照点を移動するようにロボットを動作させる
処理のフローチャート、第17図は従来例における把持
位置教示点の姿勢の違いによる他端の把持位置の変位の
例を示す説明図である。 1・・・・・・第1のロボットマニピュレータ、2・・
・・・・第2のロボットマニピュレータ、3・・・・・
・ワーク、e・・・・・・制御装置本体、γ・・・・・
・ティーチングボックス、8・・・・・・コンソール端
末、10・・・・・・中央制御ユニッ)、11,12・
・・・・・演算ユニット、13,14・・・・・・サー
ボ制御ユニッ)、15(1)〜15(イ)・・・・・・
モータおよびエンコーダ、16・・・・・・中央制御ユ
ニットのCPU、17・・・・・・中央制御ユニットの
メモリ、18・・・・・・I10インターフェース回路
、21・・・・・・演算ユニットの2ポ一トRAM、2
2・・・・1.演算ユニットのCPU、23・・・・・
・演算ユニットのメモリ。 代理人の氏名 弁理士 粟 野 重 孝 ほか1名2−
−−72I?7ニヒ\L−タ 3−−−ワ・り 51〜53− 参りpJ・ p、、 P5−tP!nイ12 第3 +o−’PR制啼部ユ +5(+1”14m)−’−ダh−xvxンコ6−1%
lはy装置べ$ γ−−−グ1−+ツク″ζS−lクス δ−・コンソールIsX C「 qり 保 第10図 ト Cアー 〇− 蒜 第11図 第14 図 第13 図 第 図 第 図 第 図
来の教示方法の一例の説明図、第3図は本発明の一実施
例におけるロボットマニピュレータの軸構成の説明図、
第4図は本実゛施例におけるシ7テム構成の説明図、第
6図は制御装置のハードウェア構成図、第6図は中央制
御ユニットの構成図、第7図は演算ユニットの構成図、
第8図はサーボ制御ユニットの構成図、第9図はティー
チングボックスの処理に関する処理のフローチャト、第
10図は3つの位置から参照点を算出し記憶する処理の
フローチャート、第11図は3つの位置と参照点の関係
の説明図、第12図は2つの位置から参照点を算出し記
憶する処理のフローチャート、第13図は2つの位置と
参照点の関係の説明図、第14図は相対位置を算出し記
憶する処理のフローチャート、第16図は参照点と相対
位置を指定してロボットに動作させる処理のフローチャ
ート、第16図(a)、 (b)は現在の参照点と次の
参照点を指定されて、現在の参照点とロボット先端の相
対位置を保ちながら、現在の参照点と次の参照点の間を
補間して参照点を移動するようにロボットを動作させる
処理のフローチャート、第17図は従来例における把持
位置教示点の姿勢の違いによる他端の把持位置の変位の
例を示す説明図である。 1・・・・・・第1のロボットマニピュレータ、2・・
・・・・第2のロボットマニピュレータ、3・・・・・
・ワーク、e・・・・・・制御装置本体、γ・・・・・
・ティーチングボックス、8・・・・・・コンソール端
末、10・・・・・・中央制御ユニッ)、11,12・
・・・・・演算ユニット、13,14・・・・・・サー
ボ制御ユニッ)、15(1)〜15(イ)・・・・・・
モータおよびエンコーダ、16・・・・・・中央制御ユ
ニットのCPU、17・・・・・・中央制御ユニットの
メモリ、18・・・・・・I10インターフェース回路
、21・・・・・・演算ユニットの2ポ一トRAM、2
2・・・・1.演算ユニットのCPU、23・・・・・
・演算ユニットのメモリ。 代理人の氏名 弁理士 粟 野 重 孝 ほか1名2−
−−72I?7ニヒ\L−タ 3−−−ワ・り 51〜53− 参りpJ・ p、、 P5−tP!nイ12 第3 +o−’PR制啼部ユ +5(+1”14m)−’−ダh−xvxンコ6−1%
lはy装置べ$ γ−−−グ1−+ツク″ζS−lクス δ−・コンソールIsX C「 qり 保 第10図 ト Cアー 〇− 蒜 第11図 第14 図 第13 図 第 図 第 図 第 図
Claims (8)
- (1)ロボットをマニュアル動作させてロボット先端位
置を記憶させることにより、移動経路上の代表的な位置
と姿勢を表わす参照点と運転時のロボット先端の動作位
置の前記参照点からの相対位置とを教示し、参照点の列
で運転時のロボット先端の動作位置経路を指定すること
を特徴とするロボットの動作教示方法。 - (2)移動経路上にセットされたワーク上の特定の1つ
または複数の点にロボット先端を移動させてその時のロ
ボット先端の位置を記憶させることにより教示した参照
点と、1つの参照点の教示時と同じワーク位置でワーク
を把持する複数のロボットの把持位置の教示を行ってこ
の把持位置の前記参照点に対する相対位置とを用いて、
複数のロボットにより把持されるワークの移動教示を行
うことを特徴とする特許請求の範囲第1項記載のロボッ
トの動作教示方法。 - (3)ロボットをマニュアル動作させる手段と、ロボッ
ト先端の現在位置または現在位置姿勢を検出し記憶する
手段と、記憶された複数の位置から参照点を算出し記憶
する手段と、参照点の1つからのロボット先端の位置ま
たは位置姿勢の相対位置を算出し記憶する手段と、記憶
された参照点と相対位置を指定されてこれらをもとにロ
ボットの動作目標位置を算出しロボットに動作させる手
段と、現在の参照点と次の参照点を指定されて、現在の
参照点とロボット先端の相対位置を保ちながら、現在の
参照点と次の参照点の間を補間して参照点を移動するよ
うにロボットを動作させる手段とを有することを特徴と
するロボットの制御装置。 - (4)記憶された複数の位置から参照点を算出し記憶す
る手段において、3つの位置から参照点を算出し、前記
3つの位置のうち、第1の位置は参照点の位置を代表し
、他の位置は参照点の姿勢を代表することを特徴とする
特許請求の範囲第3項記載のロボットの制御装置。 - (5)記憶された複数の位置から参照点を算出し記憶す
る手段において、2つの位置から参照点を算出し、前記
2つの位置のうち、第1の位置は参照点の位置を代表し
、他の位置は参照点の姿勢を代表することを特徴とする
特許請求の範囲第3項記載のロボットの制御装置。 - (6)ロボットは複数台であり、記憶された参照点と各
ロボットの相対位置が指定されて各ロボットの動作目標
位置として各ロボットに動作させる手段と、現在の参照
点と次の参照点を指定されて、現在の参照点と各ロボッ
ト先端の相対位置を保ちながら、現在の参照点と次の参
照点の間を補間して参照点を移動するように各ロボット
を動作させる手段とを有することを特徴とする特許請求
の範囲第3項記載のロボットの制御装置。 - (7)ロボットをマニュアル動作させる手段と、ロボッ
ト先端の現在位置または現在位置姿勢を検出し記憶する
手段と、記憶された位置または位置姿勢を参照点とし、
参照点の1つからのロボット先端の現在位置または現在
位置姿勢の相対位置を算出し記憶する手段と、記憶され
た参照点と相対位置を指定されてこれらをもとにロボッ
トの動作目標位置を算出しロボットに動作させる手段と
、現在の参照点と次の参照点を指定されて、現在の参照
点とロボット先端の相対位置を保ちながら、現在の参照
点と次の参照点の間を補間して参照点を移動するように
ロボットを動作させる手段とを有することを特徴とする
ロボットの制御装置。 - (8)ロボットは複数台であり、記憶された参照点と各
ロボットの相対位置が指定されて各ロボットの動作目標
位置として各ロボットに動作させる手段と、現在の参照
点と次の参照点を指定されて、現在の参照点と各ロボッ
ト先端の相対位置を保ちながら、現在の参照点と次の参
照点の間を補間して参照点を移動するように各ロボット
を動作させる手段とを有することを特徴とする特許請求
の範囲第7項記載のロボットの制御装置。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP63210304A JP2512099B2 (ja) | 1988-08-24 | 1988-08-24 | ロボットの動作教示方法および制御装置 |
US07/476,426 US5371836A (en) | 1988-08-24 | 1989-08-22 | Position teaching method and control apparatus for robot |
KR1019900700815A KR950000814B1 (ko) | 1988-08-24 | 1989-08-22 | 로보트의 동작지시 방법 및 제어장치 |
DE68926739T DE68926739T2 (de) | 1988-08-24 | 1989-08-22 | Lernverfahren und steuergerät für ein roboter |
EP89909442A EP0383944B1 (en) | 1988-08-24 | 1989-08-22 | Action teaching method and control apparatus for a robot |
PCT/JP1989/000850 WO1990002029A1 (en) | 1988-08-24 | 1989-08-22 | Robot action teaching method and control apparatus therefor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP63210304A JP2512099B2 (ja) | 1988-08-24 | 1988-08-24 | ロボットの動作教示方法および制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH0259285A true JPH0259285A (ja) | 1990-02-28 |
JP2512099B2 JP2512099B2 (ja) | 1996-07-03 |
Family
ID=16587189
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP63210304A Expired - Lifetime JP2512099B2 (ja) | 1988-08-24 | 1988-08-24 | ロボットの動作教示方法および制御装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US5371836A (ja) |
EP (1) | EP0383944B1 (ja) |
JP (1) | JP2512099B2 (ja) |
KR (1) | KR950000814B1 (ja) |
DE (1) | DE68926739T2 (ja) |
WO (1) | WO1990002029A1 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0584678A (ja) * | 1991-09-24 | 1993-04-06 | Matsushita Electric Works Ltd | 複数ロボツトによる物品の移載方法 |
JP2014046374A (ja) * | 2012-08-29 | 2014-03-17 | Nakamura Tome Precision Ind Co Ltd | 旋盤におけるワークの機内搬送方法 |
Families Citing this family (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1995025991A1 (fr) * | 1994-03-23 | 1995-09-28 | Kabushiki Kaisha Yaskawa Denki | Controleur de machine |
JP3804994B2 (ja) * | 1994-07-15 | 2006-08-02 | ファナック株式会社 | ロボットの教示方法 |
DE4441240C1 (de) * | 1994-11-19 | 1996-05-09 | Leica Lasertechnik | Vorrichtung und Verfahren zur Regelung der Bewegung eines Gegenstandes |
JPH09319425A (ja) * | 1996-05-29 | 1997-12-12 | Kobe Steel Ltd | 部品の組立方法及び組立装置 |
US5960125A (en) * | 1996-11-21 | 1999-09-28 | Cognex Corporation | Nonfeedback-based machine vision method for determining a calibration relationship between a camera and a moveable object |
US6023645A (en) * | 1997-05-15 | 2000-02-08 | Mitsubishi Denki Kabushiki Kaisha | Trajectory control apparatus and trajectory control method for intra-planar multifreedom SCARA type of robot, and computer-readable recording medium with trajectory control program for intra-planar multifreedom SCARA type of robot stored therein |
JP3349652B2 (ja) * | 1997-07-16 | 2002-11-25 | 本田技研工業株式会社 | オフラインティーチング方法 |
US6016385A (en) * | 1997-08-11 | 2000-01-18 | Fanu America Corp | Real time remotely controlled robot |
JPH1177569A (ja) * | 1997-09-10 | 1999-03-23 | Honda Motor Co Ltd | オフラインティーチング装置 |
US6687402B1 (en) | 1998-12-18 | 2004-02-03 | Cognex Corporation | Machine vision methods and systems for boundary feature comparison of patterns and images |
KR100345150B1 (ko) * | 2000-09-29 | 2002-07-24 | 현대자동차주식회사 | 레이저 측정기를 이용한 로봇 위치 보정 방법 |
US6591160B2 (en) | 2000-12-04 | 2003-07-08 | Asyst Technologies, Inc. | Self teaching robot |
WO2004014244A2 (en) | 2002-08-13 | 2004-02-19 | Microbotics Corporation | Microsurgical robot system |
DE10302592A1 (de) * | 2003-01-22 | 2004-07-29 | Claas Fertigungstechnik Gmbh | Verfahren und Vorrichtung zum Betreiben eines Arbeitsroboters |
JP3946711B2 (ja) * | 2004-06-02 | 2007-07-18 | ファナック株式会社 | ロボットシステム |
US9390203B2 (en) * | 2004-06-15 | 2016-07-12 | Abb Ab | Method and system for off-line programming of multiple interacting robots |
US8111904B2 (en) | 2005-10-07 | 2012-02-07 | Cognex Technology And Investment Corp. | Methods and apparatus for practical 3D vision system |
WO2007116624A1 (ja) * | 2006-04-10 | 2007-10-18 | Kabushiki Kaisha Yaskawa Denki | 自動機械システム |
US8162584B2 (en) | 2006-08-23 | 2012-04-24 | Cognex Corporation | Method and apparatus for semiconductor wafer alignment |
DE102008061153A1 (de) * | 2008-12-09 | 2010-06-17 | Renate Grünfeld | Verfahren zur mehrdimensionalen automatischen, elektromotorischen Bewegung einer kartesisch geführten Sonde zu einem Objekt |
CN103576657B (zh) * | 2013-11-07 | 2016-01-20 | 大连东方之星信息技术有限公司 | 一种带有自由组合模块档案展示方法 |
US9874628B2 (en) * | 2013-11-12 | 2018-01-23 | The Boeing Company | Dual hidden point bars |
JP6572262B2 (ja) * | 2017-06-06 | 2019-09-04 | ファナック株式会社 | 教示位置修正装置および教示位置修正方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6149205A (ja) * | 1984-08-16 | 1986-03-11 | Seiko Instr & Electronics Ltd | ロボツト制御方式 |
Family Cites Families (38)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE235218C (ja) * | ||||
US3744032A (en) * | 1971-07-15 | 1973-07-03 | Unimotion Inc | Stationary base programmed manipulator arrangement for continuously moving workpiece |
JPS5024686A (ja) * | 1973-07-09 | 1975-03-15 | ||
US4025838A (en) * | 1974-12-26 | 1977-05-24 | Kawasaki Heavy Industries, Ltd. | Signal modification device for memory controlled manipulator apparatus |
US4146924A (en) * | 1975-09-22 | 1979-03-27 | Board Of Regents For Education Of The State Of Rhode Island | System for visually determining position in space and/or orientation in space and apparatus employing same |
CA1119279A (en) * | 1978-04-20 | 1982-03-02 | Yung-Ming Yen-Chen | Off-line teach assist apparatus and on-line control apparatus |
JPS5599605A (en) * | 1979-01-25 | 1980-07-29 | Fanuc Ltd | Control system for industrial robot |
US4385358A (en) * | 1979-10-19 | 1983-05-24 | Tokico Ltd. | Robot |
JPS5769314A (en) * | 1980-10-13 | 1982-04-28 | Fanuc Ltd | Numerical control system |
JPS584377A (ja) * | 1981-03-18 | 1983-01-11 | 株式会社安川電機 | 関節形産業用ロボツトの制御装置 |
JPS57207908A (en) * | 1981-06-17 | 1982-12-20 | Hitachi Ltd | Robot controller |
JPS5822686A (ja) * | 1981-08-05 | 1983-02-10 | 日産自動車株式会社 | 2腕多軸ロボツトにおける軸駆動制御装置 |
DE3277087D1 (en) * | 1981-09-24 | 1987-10-01 | Hitachi Ltd | Control system for robot hand |
JPS5927307A (ja) * | 1982-08-04 | 1984-02-13 | Hitachi Ltd | 経路制御方法及び装置 |
CA1184273A (en) * | 1982-09-23 | 1985-03-19 | Kazuyoshi Yasukawa | Robot control apparatus |
JPS59114609A (ja) * | 1982-12-22 | 1984-07-02 | Hitachi Ltd | ロボットの制御装置 |
US4484120A (en) * | 1983-04-13 | 1984-11-20 | Nordson Corporation | Auxiliary function command presequencing for a robot controller |
JPS60205720A (ja) * | 1984-03-30 | 1985-10-17 | Matsushita Electric Ind Co Ltd | ロボツト動作教示装置 |
JPS60205721A (ja) * | 1984-03-30 | 1985-10-17 | Matsushita Electric Ind Co Ltd | ロボツト動作教示装置 |
US4689756A (en) * | 1984-06-29 | 1987-08-25 | Shin Meiwa Industry Co., Ltd. | Robot interpolation control method |
JPS6142004A (ja) * | 1984-08-06 | 1986-02-28 | Toyota Central Res & Dev Lab Inc | 追従ロボツト装置 |
US4706204A (en) * | 1985-03-05 | 1987-11-10 | Mitsubishi Denki Kabushiki Kaisha | Controller for movable robot for moving a work element through a continuous path |
JP2597978B2 (ja) * | 1985-04-25 | 1997-04-09 | 川崎重工業株式会社 | 切断作業を行うロボツト制御データの作成方法 |
JPS61250705A (ja) * | 1985-04-30 | 1986-11-07 | Hitachi Ltd | 産業用ロボツトの座標変換方式 |
JPS6293710A (ja) * | 1985-10-18 | 1987-04-30 | Tokico Ltd | 工業用ロボツト |
DE3545505C2 (de) * | 1985-12-20 | 1995-08-10 | Kuka Schweissanlagen & Roboter | Verfahren und Vorrichtung zum Aufsuchen und Verfolgen einer Kehlnaht beim Schutzgas-Lichtbogenschweißen |
JPH085018B2 (ja) * | 1986-02-26 | 1996-01-24 | 株式会社日立製作所 | 遠隔マニピユレ−シヨン方法及び装置 |
JPS62232006A (ja) * | 1986-04-02 | 1987-10-12 | Yokogawa Electric Corp | ロボツト・システム |
JP2506760B2 (ja) * | 1986-05-12 | 1996-06-12 | 松下電器産業株式会社 | ロボットの制御装置 |
JPH07104692B2 (ja) * | 1986-10-02 | 1995-11-13 | トヨタ自動車株式会社 | 予見追跡制御型ロボツト |
US4835730A (en) * | 1987-02-27 | 1989-05-30 | Adept Technology, Inc. | Database driven robot programming system and method |
US4821207A (en) * | 1987-04-28 | 1989-04-11 | Ford Motor Company | Automated curvilinear path interpolation for industrial robots |
US4835710A (en) * | 1987-07-17 | 1989-05-30 | Cincinnati Milacron Inc. | Method of moving and orienting a tool along a curved path |
US4831549A (en) * | 1987-07-28 | 1989-05-16 | Brigham Young University | Device and method for correction of robot inaccuracy |
US4987527A (en) * | 1987-10-26 | 1991-01-22 | Hitachi, Ltd. | Perspective display device for displaying and manipulating 2-D or 3-D cursor, 3-D object and associated mark position |
JP3207409B2 (ja) * | 1988-03-10 | 2001-09-10 | ファナック株式会社 | ロボットのツール姿勢制御方法 |
JP2708458B2 (ja) * | 1988-04-01 | 1998-02-04 | 株式会社豊田中央研究所 | 倣い制御ロボット |
CA1314085C (en) * | 1988-05-25 | 1993-03-02 | Andras G. Fule | Linear interpolation for a component placement robot |
-
1988
- 1988-08-24 JP JP63210304A patent/JP2512099B2/ja not_active Expired - Lifetime
-
1989
- 1989-08-22 US US07/476,426 patent/US5371836A/en not_active Expired - Lifetime
- 1989-08-22 DE DE68926739T patent/DE68926739T2/de not_active Expired - Fee Related
- 1989-08-22 WO PCT/JP1989/000850 patent/WO1990002029A1/ja active IP Right Grant
- 1989-08-22 EP EP89909442A patent/EP0383944B1/en not_active Expired - Lifetime
- 1989-08-22 KR KR1019900700815A patent/KR950000814B1/ko not_active IP Right Cessation
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6149205A (ja) * | 1984-08-16 | 1986-03-11 | Seiko Instr & Electronics Ltd | ロボツト制御方式 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0584678A (ja) * | 1991-09-24 | 1993-04-06 | Matsushita Electric Works Ltd | 複数ロボツトによる物品の移載方法 |
JP2014046374A (ja) * | 2012-08-29 | 2014-03-17 | Nakamura Tome Precision Ind Co Ltd | 旋盤におけるワークの機内搬送方法 |
Also Published As
Publication number | Publication date |
---|---|
EP0383944B1 (en) | 1996-06-26 |
US5371836A (en) | 1994-12-06 |
EP0383944A4 (en) | 1993-02-24 |
KR950000814B1 (ko) | 1995-02-02 |
EP0383944A1 (en) | 1990-08-29 |
DE68926739D1 (de) | 1996-08-01 |
KR900701484A (ko) | 1990-12-03 |
DE68926739T2 (de) | 1996-10-31 |
WO1990002029A1 (en) | 1990-03-08 |
JP2512099B2 (ja) | 1996-07-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPH0259285A (ja) | ロボットの動作教示方法および制御装置 | |
US4698777A (en) | Industrial robot circular arc control method for controlling the angle of a tool | |
EP0381185B1 (en) | Method and apparatus for controlling tracking path of working point of industrial robot | |
EP0577437B1 (en) | Control apparatus for industrial robot | |
JPH079606B2 (ja) | ロボット制御装置 | |
JP2694669B2 (ja) | ロボットの動作制御方法 | |
JP2006099474A (ja) | ロボットの軌跡制御方法 | |
JP2728399B2 (ja) | ロボツトの制御方法 | |
EP0380678B1 (en) | Method of controlling tool attitude of a robot | |
EP0188626B1 (en) | System for correcting position of tool | |
WO1990009859A1 (en) | Method and apparatus for multi-layer buildup welding | |
JPS5815801B2 (ja) | 工業用ロボツトの軌跡制御方式 | |
US11964391B2 (en) | Robot system | |
US5276777A (en) | Locus correcting method for industrial robots | |
JPS62251901A (ja) | 多軸ロボツトの経路制御装置 | |
JPH0131201B2 (ja) | ||
WO1991003779A1 (en) | Robot control method | |
WO1991004521A1 (en) | A method for the control of the path of a robot cell | |
JPS6029288A (ja) | ロボツト装置 | |
JPS58100972A (ja) | 溶接ロボツトの制御方法および装置 | |
JPH01121188A (ja) | 自動工作機器の制御方法 | |
JPS5814205A (ja) | 産業用ロボツト | |
JPH04359302A (ja) | ロボットの制御方法 | |
JP2014124733A (ja) | ロボット制御装置及びロボットの制御方法 | |
JPH06226667A (ja) | 7軸マニピュレータの制御方法 |