JPS6346844B2 - - Google Patents
Info
- Publication number
- JPS6346844B2 JPS6346844B2 JP55155943A JP15594380A JPS6346844B2 JP S6346844 B2 JPS6346844 B2 JP S6346844B2 JP 55155943 A JP55155943 A JP 55155943A JP 15594380 A JP15594380 A JP 15594380A JP S6346844 B2 JPS6346844 B2 JP S6346844B2
- Authority
- JP
- Japan
- Prior art keywords
- coordinate system
- teaching
- transformation matrix
- amount
- internal reference
- 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.)
- Expired
Links
- 230000033001 locomotion Effects 0.000 claims description 41
- 239000011159 matrix material Substances 0.000 claims description 31
- 230000009466 transformation Effects 0.000 claims description 23
- 238000004364 calculation method Methods 0.000 claims description 16
- 230000008859 change Effects 0.000 claims description 14
- 238000006073 displacement reaction Methods 0.000 claims description 14
- 238000001514 detection method Methods 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 description 13
- 230000036544 posture Effects 0.000 description 12
- 238000000034 method Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 210000000245 forearm Anatomy 0.000 description 5
- 210000000707 wrist Anatomy 0.000 description 4
- 238000005070 sampling Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000003825 pressing Methods 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 210000004247 hand Anatomy 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Landscapes
- Numerical Control (AREA)
Description
本発明は、関節形ロボツトの関接教示装置に関
するものである。 通常プレイバツクロボツトの動作教示におい
て、ロボツトを実際に動かし、位置をロボツトに
記憶させることが必要であるが、従来はロボツト
の動作軸毎にコンソール上に正逆の指示スイツチ
を2個もち、一軸毎に動かして、位置を調節し間
接教示していた。従つて必要となるある点にロボ
ツトを位置決めする場合、全軸のスイツチをバラ
バラに使い、ロボツトを動かす必要があつたた
め、位置調整に熟練と多大な時間を必要とした。
また障害物によつてや、組立時のワークの穴など
の挿入の場合、ロボツト動作軌跡に制限が発生
し、一軸毎のバラバラな動きでは、実際の作業に
近い状態にして教示ができない事項が発生し、教
示作業に不都合があつた。 本発明の目的は、上記した従来技術の欠点をな
くし、プレイバツクロボツトの動作教示時の間接
操作を高機能化、簡易化すると共に、教示操作を
向上させて教示に必要な作業時間の短縮を図るよ
うにした関節ロボツトの間接教示装置を提供する
にある。 即ち本発明は、上記目的を達成するために、各
関節を駆動する駆動手段と、各関節の回転量を検
出する位置検出手段とを備え、少なくとも3自由
度を有する関節形ロボツトにおいて、上記検出手
段から検出される各関節の角度変位量をサンプル
毎に内部基準直交座標系の位置座標に変換する角
度・直交変換マトリツクス手段と、原点変更又は
手先姿勢移動の指示をする原点変更又は手先姿勢
移動指示スイツチと、上記駆動手段を駆動させて
関節を動作させ、任意の教示用直交座標系の基準
位置に位置付けし、上記原点変更又は手先姿勢移
動指示スイツチを操作して上記位置付けられた時
の内部基準直交座標系の基準位置からの変位量
を、上記位置検出手段または上記角度・直交変換
マトリツクス手段から検出してその値を記憶手段
に記憶させて教示用直交座標系を設定する教示用
直交座標系設定手段と、関節形ロボツトを移動さ
せるべく座標の各軸方向を指示する軸方向指示ス
イツチと、該軸方向指示スイツチの操作によりサ
ンプル毎に単位移動量を逐次創成する単位ベクト
ル創成手段と、上記教示用直交座標系設定手段の
記憶手段に記憶された基準位置からの変位量を読
出してこの変位量に基いて第1の変換マトリツク
スを算出し、この算出された第1の変換マトリツ
クスと上記単位ベクトル創成手段によつて逐次創
成された単位移動量とを掛算して内部基準直交座
標系の単位移動量を逐次求める第1の変換マトリ
ツクス手段と、上記角度・直交変換マトリツクス
手段から得られる前の位置の内部基準直交座標系
の位置座標と上記第1の変換マトリツクス手段よ
り求められた内部基準直交座標系の単位移動量と
を加算し、この加算された値に第2の変換マトリ
ツクスを掛算して次の目標位置への各関節の回転
角を逐次演算して求める演算手段とを備え、該演
算手段によつて逐次求められた回転角になるよう
に上記駆動手段を駆動して各関節を動作させて関
節形ロボツトの手先を教示点に位置付け、上記位
置検出手段から得られる各関節の回転角に基いて
各関節の位置データを記憶手段に記憶させること
を特徴とする関節形ロボツトの間接教示装置であ
る。特に、内部基準直交座標系を、鉛直に設けら
れた旋回台の軸をZ軸、及びこのZ軸に直交する
ように水平方向に設けられたX軸、Y軸で設定
し、教示用座標系をZ軸に共有させて水平方向に
上記X軸、及びY軸に対して所定の角度θ1〓回転
させて傾斜させてX′軸、Y′軸で設定し、水平方
向においてどちらの向きからでも間接的に直線教
示できるようにしたことを特徴とする。また内部
基準直交座標系を上記と同じように設定し、教示
用座標系を手首の向いている方向にZ′軸を設定
し、そのZ″軸に直交するX″軸、Y″軸を設定し、
水平面上に傾いて置かれた物体に沿つて間接的に
直線教示できるようにしたことを特徴とする。 以下本発明を図に示す実施例にもとづいて具体
的に説明する。第1図は本発明の関節形ロボツト
の間接教示方法を実施する装置の概略構成を示す
図である。1はプレイバツクロボツトの間接教示
操作に使用するコンソールである。ここでは、工
業用ロボツトは6自由度を有しているものと仮定
する。よつて指示スイツチ2a,2b,3a,3
b,4a,4b,5a,5b,6a,6b,7
a,7bはX、Y、Z、α、β、γについて正逆
指示するために計12ある。従来は、これらの正逆
の指示スイツチのペアにより対応するロボツトの
動作軸を動かせるだけであつた。本発明では、軸
単位指示スイツチ8を押した状態では、上記の動
作が可能になる様にしている。従来と区別される
点は、原点変更指示スイツチ9と手先姿勢移動指
示スイツチ10を設けたことにある。 ところで工業用ロボツトの内、多関節形ロボツ
トの一例を第2図に示す。即ち20は基台、21
は基台20に対して鉛直なZ軸まわりに駆動モー
タ16aによりθ1の角度で旋回できるようにした
旋回台、22はこの旋回台21に対してX軸方向
を向いた軸のまわりに駆動モータ16bによりθ2
の角度で回転するように連結された上腕、23は
この上腕22に対してX軸方向を向いた軸のまわ
りに駆動モータ16cによりθ3の角度で回転する
ように連結された前腕、24はこの前腕23の上
半部に軸心まわりに駆動モータ16dによつてθ4
の角度で旋回するように連結された前腕下半部、
25はこの前腕下半部24の先端にX軸方向を向
いた軸のまわりに駆動モータ16eによてつθ5の
角度で回転するように連結された手首、26はこ
の手首25の先に軸心まわりに駆動モータ16f
によつてθ5の角度で旋回するように連結された手
先である。手先26は、組立または加工する部品
をつかむチヤツク、または工具を取付けるチヤツ
クが設けられている。また11はインターフエー
ス回路、12はマイクロコンピユータ、13は入
出力端末である。また14a〜14fはA/D変
換回路、15a〜15fは各駆動モータを駆動す
る駆動回路、16a〜16fは関節形ロボツトの
各自由度を減速機を介して駆動する駆動モータ、
17a〜17fは各駆動モータ16a〜16fに
連続されたロータリエンコーダ(位置検出手段)、
18a〜18fはロータリエンコーダ17a〜1
7fの出力パルス列を計数して自由度(各軸)の
角度座標値(θ1〜θ6)を抽出するカウンタ回路で
ある。そこで多軸の関節形ロボツトの手先をある
直線などの気跡を描いて動かす場合、ソフトウエ
ア上でロボツト内部基準直交座標系〔X、Y、
Z、α、β、γ〕を想定して用いることが通常行
なわれている。その関係を第2図に示す。α、
β、γは手先26の振り、曲げ、ねじりに相当す
る角度である。即ちαは第2図に示すθ1に対応
し、βは第2図に示すθ2、θ3、θ5が対応し、γは
第2図に示すθ4、θ6が対応する。例えば第2図の
P1からP2点までロボツトの手先26を動かす場
合、P1の手先の位置を実現する各軸の角度P1〔θ1
〜θ6〕からP2〔θ1〜θ6〕まで各軸を別個に駆動す
ると手先26はランダムな軌跡を描いて移動す
る。これをロボツト内部基準直交座標系X、Y、
Zを設定し、P1〔X、Y、Z、α、β、γ〕、P2
〔X、Y、Z、α、β、γ〕を用いてサンプル毎
のPQ〔X、Y、Z、α、β、γ〕を算出して動か
すと、手先26は例えば直線的に動かすことが可
能となる。PQはロボツトの現在位置を表わす。
この場合直交座標系PQ〔X、Y、Z、α、β、
γ〕とPQ〔θ1〜θ6〕は座標変換マトリツクス
〔TXA〕を用いてサンプル毎に次の(1)式の計算を
行なつて各軸を駆動する。 PQ〔θ1〜θ6〕 =〔TXA〕PQ〔X、Y、Z、α、β、γ〕
……(1) 座標変換マトリツクス〔TXA〕は、ロボツト
毎の自由度、腕の長さなどから求められる。この
方式は関節形ロボツトを溶接などに用いる場合、
ポイントツーポイント教示補間コンテイニアーパ
ス駆動方式として広く行なわれている方法であ
る。 この方法を間接教示操作に利用すると、例えば
第1図のコンソール1の指示スイツチ2a,2b
〜7a,7bに対応して単位移動ベクトルM〔±
Δx、±Δy、±Δz、±Δα、±Δβ、±Δγ〕を設定
し、
サンプル毎に(2)式の計算を行なつてロボツトを駆
動すると、ロボツトは第2図に示した内部基準直
交座標系X、Y、Z上で、例えば直線的に移動さ
せたり、手先26の位置を保持したまま、手先2
6の姿勢を変ることが可能となる。 PQ(t)〔θ1〜θ6〕=〔TXA〕{PQ(t−1)〔
X、Y、Z、α、β、γ〕 PQ(t)〔θ1〜θ6〕=〔TXA〕{PQ(t−1)〔
X、Y、Z、α、β、γ〕 +M〔Δx、Δy、Δz、Δα、Δ
β、Δγ〕} ……(2) 上記コントロールシステムを一歩進めて原点変
更指示スイツチ9を押すことにより、内部基準直
交座標系を作業者が便利な、第3図に示すような
Z軸を中心にθ1Qだけ回転させた(傾けた)教示
座標系X′、Y′、Z′に変更することが可能な様に
した。これはまともに〔内部基準直交座標系〕=
〔TM(θ1Q)〕〔教示座標系〕の式を立てて行なつ
ても可能であるが、本発明では次のようにして行
う。まず、各軸スイツチ8を操作させた後各指示
スイツチ2a,2b〜7a,7bを適宜に操作
し、単位ベクトル創成手段47により単位移動量
〔Δx、Δy、Δz、Δα、Δβ、Δγ〕をサンプリング
毎逐次創成し、これら単位移動量をゲート回路4
5,46をONにして演算手段48に入力し、各
駆動モータ16a〜16fを駆動して第3図に示
すように旋回台21を回転させ、内部基準直交座
標系X、Y、Zの基準位置(Y軸)から変位量
θ1Q回転させた位置に移動させ、原点変更指示ス
イツチ9を操作することにより、ロータリエンコ
ーダ(位置検出手段)17aから検出されたカウ
ンタ回路18aに記憶された変位量θ1Qをマイク
ロコンプータ12のメモリ(記憶手段)41に記
憶させる。これにより教示用直交座標系X′、Y′、
Z′(但しZとZ′とは共通)が設定されたことにな
る。その後、教示用直交座標系において、指示ス
イツチ2a,2b,3a,3bを操作することに
より、マイクロコンピータ12の単位ベクトル創
成手段47により、サンプル信号によるサンプル
毎に単位移動量±Δx′、±Δy′が創成され、ゲート
回路43を通して変換マトリツクス手段51に入
力される。変換マトリツクス手段51は上記メモ
リ(記憶手段)41に記憶された変位量θ1Qを読
み出して第1の変換マトリツクス
するものである。 通常プレイバツクロボツトの動作教示におい
て、ロボツトを実際に動かし、位置をロボツトに
記憶させることが必要であるが、従来はロボツト
の動作軸毎にコンソール上に正逆の指示スイツチ
を2個もち、一軸毎に動かして、位置を調節し間
接教示していた。従つて必要となるある点にロボ
ツトを位置決めする場合、全軸のスイツチをバラ
バラに使い、ロボツトを動かす必要があつたた
め、位置調整に熟練と多大な時間を必要とした。
また障害物によつてや、組立時のワークの穴など
の挿入の場合、ロボツト動作軌跡に制限が発生
し、一軸毎のバラバラな動きでは、実際の作業に
近い状態にして教示ができない事項が発生し、教
示作業に不都合があつた。 本発明の目的は、上記した従来技術の欠点をな
くし、プレイバツクロボツトの動作教示時の間接
操作を高機能化、簡易化すると共に、教示操作を
向上させて教示に必要な作業時間の短縮を図るよ
うにした関節ロボツトの間接教示装置を提供する
にある。 即ち本発明は、上記目的を達成するために、各
関節を駆動する駆動手段と、各関節の回転量を検
出する位置検出手段とを備え、少なくとも3自由
度を有する関節形ロボツトにおいて、上記検出手
段から検出される各関節の角度変位量をサンプル
毎に内部基準直交座標系の位置座標に変換する角
度・直交変換マトリツクス手段と、原点変更又は
手先姿勢移動の指示をする原点変更又は手先姿勢
移動指示スイツチと、上記駆動手段を駆動させて
関節を動作させ、任意の教示用直交座標系の基準
位置に位置付けし、上記原点変更又は手先姿勢移
動指示スイツチを操作して上記位置付けられた時
の内部基準直交座標系の基準位置からの変位量
を、上記位置検出手段または上記角度・直交変換
マトリツクス手段から検出してその値を記憶手段
に記憶させて教示用直交座標系を設定する教示用
直交座標系設定手段と、関節形ロボツトを移動さ
せるべく座標の各軸方向を指示する軸方向指示ス
イツチと、該軸方向指示スイツチの操作によりサ
ンプル毎に単位移動量を逐次創成する単位ベクト
ル創成手段と、上記教示用直交座標系設定手段の
記憶手段に記憶された基準位置からの変位量を読
出してこの変位量に基いて第1の変換マトリツク
スを算出し、この算出された第1の変換マトリツ
クスと上記単位ベクトル創成手段によつて逐次創
成された単位移動量とを掛算して内部基準直交座
標系の単位移動量を逐次求める第1の変換マトリ
ツクス手段と、上記角度・直交変換マトリツクス
手段から得られる前の位置の内部基準直交座標系
の位置座標と上記第1の変換マトリツクス手段よ
り求められた内部基準直交座標系の単位移動量と
を加算し、この加算された値に第2の変換マトリ
ツクスを掛算して次の目標位置への各関節の回転
角を逐次演算して求める演算手段とを備え、該演
算手段によつて逐次求められた回転角になるよう
に上記駆動手段を駆動して各関節を動作させて関
節形ロボツトの手先を教示点に位置付け、上記位
置検出手段から得られる各関節の回転角に基いて
各関節の位置データを記憶手段に記憶させること
を特徴とする関節形ロボツトの間接教示装置であ
る。特に、内部基準直交座標系を、鉛直に設けら
れた旋回台の軸をZ軸、及びこのZ軸に直交する
ように水平方向に設けられたX軸、Y軸で設定
し、教示用座標系をZ軸に共有させて水平方向に
上記X軸、及びY軸に対して所定の角度θ1〓回転
させて傾斜させてX′軸、Y′軸で設定し、水平方
向においてどちらの向きからでも間接的に直線教
示できるようにしたことを特徴とする。また内部
基準直交座標系を上記と同じように設定し、教示
用座標系を手首の向いている方向にZ′軸を設定
し、そのZ″軸に直交するX″軸、Y″軸を設定し、
水平面上に傾いて置かれた物体に沿つて間接的に
直線教示できるようにしたことを特徴とする。 以下本発明を図に示す実施例にもとづいて具体
的に説明する。第1図は本発明の関節形ロボツト
の間接教示方法を実施する装置の概略構成を示す
図である。1はプレイバツクロボツトの間接教示
操作に使用するコンソールである。ここでは、工
業用ロボツトは6自由度を有しているものと仮定
する。よつて指示スイツチ2a,2b,3a,3
b,4a,4b,5a,5b,6a,6b,7
a,7bはX、Y、Z、α、β、γについて正逆
指示するために計12ある。従来は、これらの正逆
の指示スイツチのペアにより対応するロボツトの
動作軸を動かせるだけであつた。本発明では、軸
単位指示スイツチ8を押した状態では、上記の動
作が可能になる様にしている。従来と区別される
点は、原点変更指示スイツチ9と手先姿勢移動指
示スイツチ10を設けたことにある。 ところで工業用ロボツトの内、多関節形ロボツ
トの一例を第2図に示す。即ち20は基台、21
は基台20に対して鉛直なZ軸まわりに駆動モー
タ16aによりθ1の角度で旋回できるようにした
旋回台、22はこの旋回台21に対してX軸方向
を向いた軸のまわりに駆動モータ16bによりθ2
の角度で回転するように連結された上腕、23は
この上腕22に対してX軸方向を向いた軸のまわ
りに駆動モータ16cによりθ3の角度で回転する
ように連結された前腕、24はこの前腕23の上
半部に軸心まわりに駆動モータ16dによつてθ4
の角度で旋回するように連結された前腕下半部、
25はこの前腕下半部24の先端にX軸方向を向
いた軸のまわりに駆動モータ16eによてつθ5の
角度で回転するように連結された手首、26はこ
の手首25の先に軸心まわりに駆動モータ16f
によつてθ5の角度で旋回するように連結された手
先である。手先26は、組立または加工する部品
をつかむチヤツク、または工具を取付けるチヤツ
クが設けられている。また11はインターフエー
ス回路、12はマイクロコンピユータ、13は入
出力端末である。また14a〜14fはA/D変
換回路、15a〜15fは各駆動モータを駆動す
る駆動回路、16a〜16fは関節形ロボツトの
各自由度を減速機を介して駆動する駆動モータ、
17a〜17fは各駆動モータ16a〜16fに
連続されたロータリエンコーダ(位置検出手段)、
18a〜18fはロータリエンコーダ17a〜1
7fの出力パルス列を計数して自由度(各軸)の
角度座標値(θ1〜θ6)を抽出するカウンタ回路で
ある。そこで多軸の関節形ロボツトの手先をある
直線などの気跡を描いて動かす場合、ソフトウエ
ア上でロボツト内部基準直交座標系〔X、Y、
Z、α、β、γ〕を想定して用いることが通常行
なわれている。その関係を第2図に示す。α、
β、γは手先26の振り、曲げ、ねじりに相当す
る角度である。即ちαは第2図に示すθ1に対応
し、βは第2図に示すθ2、θ3、θ5が対応し、γは
第2図に示すθ4、θ6が対応する。例えば第2図の
P1からP2点までロボツトの手先26を動かす場
合、P1の手先の位置を実現する各軸の角度P1〔θ1
〜θ6〕からP2〔θ1〜θ6〕まで各軸を別個に駆動す
ると手先26はランダムな軌跡を描いて移動す
る。これをロボツト内部基準直交座標系X、Y、
Zを設定し、P1〔X、Y、Z、α、β、γ〕、P2
〔X、Y、Z、α、β、γ〕を用いてサンプル毎
のPQ〔X、Y、Z、α、β、γ〕を算出して動か
すと、手先26は例えば直線的に動かすことが可
能となる。PQはロボツトの現在位置を表わす。
この場合直交座標系PQ〔X、Y、Z、α、β、
γ〕とPQ〔θ1〜θ6〕は座標変換マトリツクス
〔TXA〕を用いてサンプル毎に次の(1)式の計算を
行なつて各軸を駆動する。 PQ〔θ1〜θ6〕 =〔TXA〕PQ〔X、Y、Z、α、β、γ〕
……(1) 座標変換マトリツクス〔TXA〕は、ロボツト
毎の自由度、腕の長さなどから求められる。この
方式は関節形ロボツトを溶接などに用いる場合、
ポイントツーポイント教示補間コンテイニアーパ
ス駆動方式として広く行なわれている方法であ
る。 この方法を間接教示操作に利用すると、例えば
第1図のコンソール1の指示スイツチ2a,2b
〜7a,7bに対応して単位移動ベクトルM〔±
Δx、±Δy、±Δz、±Δα、±Δβ、±Δγ〕を設定
し、
サンプル毎に(2)式の計算を行なつてロボツトを駆
動すると、ロボツトは第2図に示した内部基準直
交座標系X、Y、Z上で、例えば直線的に移動さ
せたり、手先26の位置を保持したまま、手先2
6の姿勢を変ることが可能となる。 PQ(t)〔θ1〜θ6〕=〔TXA〕{PQ(t−1)〔
X、Y、Z、α、β、γ〕 PQ(t)〔θ1〜θ6〕=〔TXA〕{PQ(t−1)〔
X、Y、Z、α、β、γ〕 +M〔Δx、Δy、Δz、Δα、Δ
β、Δγ〕} ……(2) 上記コントロールシステムを一歩進めて原点変
更指示スイツチ9を押すことにより、内部基準直
交座標系を作業者が便利な、第3図に示すような
Z軸を中心にθ1Qだけ回転させた(傾けた)教示
座標系X′、Y′、Z′に変更することが可能な様に
した。これはまともに〔内部基準直交座標系〕=
〔TM(θ1Q)〕〔教示座標系〕の式を立てて行なつ
ても可能であるが、本発明では次のようにして行
う。まず、各軸スイツチ8を操作させた後各指示
スイツチ2a,2b〜7a,7bを適宜に操作
し、単位ベクトル創成手段47により単位移動量
〔Δx、Δy、Δz、Δα、Δβ、Δγ〕をサンプリング
毎逐次創成し、これら単位移動量をゲート回路4
5,46をONにして演算手段48に入力し、各
駆動モータ16a〜16fを駆動して第3図に示
すように旋回台21を回転させ、内部基準直交座
標系X、Y、Zの基準位置(Y軸)から変位量
θ1Q回転させた位置に移動させ、原点変更指示ス
イツチ9を操作することにより、ロータリエンコ
ーダ(位置検出手段)17aから検出されたカウ
ンタ回路18aに記憶された変位量θ1Qをマイク
ロコンプータ12のメモリ(記憶手段)41に記
憶させる。これにより教示用直交座標系X′、Y′、
Z′(但しZとZ′とは共通)が設定されたことにな
る。その後、教示用直交座標系において、指示ス
イツチ2a,2b,3a,3bを操作することに
より、マイクロコンピータ12の単位ベクトル創
成手段47により、サンプル信号によるサンプル
毎に単位移動量±Δx′、±Δy′が創成され、ゲート
回路43を通して変換マトリツクス手段51に入
力される。変換マトリツクス手段51は上記メモ
リ(記憶手段)41に記憶された変位量θ1Qを読
み出して第1の変換マトリツクス
【式】を算出し、この算出
された第1の変換マトリツクスと創成された単位
移動量とにより次の(3)式に示す演算処理が施さ
れ、内部基準直交座標系におけるM(±Δx、±
Δy)Tなる単位移動量が逐次出力される。 同時にマイクロコンピユータ12のメモリ49
に、サンプリング1つ前の点PQ(t−1)の位置
座標PQ(t−1)〔X、Y、Z、α、β、γ〕が
PQ(t−1)〔θ1〜θ6〕から演算手段48により
逆変換されてメモリされる。演算手段48は、更
にメモリ49から逐次読み出されたサンプル前の
内部基準直交座標系の位置座標PQ(t−1)〔X、
Y、Z、α、β、γ〕と変換マトリツクス手段5
1から逐次出力される単位移動量〔Δx、Δy、
Δz、Δα、Δβ、Δγ〕と第2の変換マトリツクス
〔TXA〕とから次の式のように各関節の回転角θ1
〜θ6でもつて表わされる次の目標位置PQt〔θ1〜
θ6〕を逐次演算し、逐次演算された結果にもとづ
いてD/A変換回路14a〜14f、駆動回路1
5a〜15fを介し、駆動モータ16a〜16f
が駆動される。 PQt〔θ1〜θ6〕=〔TXA〕{PQ(t−1)〔X、Y、
Z、α、β、γ〕+M〔Δx、Δy、Δz、Δα、Δβ、
Δγ〕} なお50はカウンタ回路81a〜18fより出
力される〔θ1(t−1)〜θ6(t−1)〕を〔X(t
−1)、Y(t−1)、Z(t−1)、α(t−1)、
β(t−1)、γ(t−1)〕に変換する変換マトリ
ツクス手段である。 これにより、変換マトリツクス手段51により
上記(3)式の変換をサンプルh毎に行つて、演算手
段48で演算を行うと、上記(3)式の単位移動ベク
トルMをあたかも作業者31がコンソール1の指
示スイツチ2a,2b〜7a,7bを作業者エリ
ア32の教示座標系X′、Y′、Z′(Z)で考えられ
る移動方向に操作することにより関節形ロボツト
が作業者が頭に描く方向(X′方向、Y方向)に
移動するように変換することができる。このよう
にして移動されてカウンタ回路18a〜18fに
記憶された角度座標値〔θ1、θ2、θ3、θ4、θ5、θ6
〕
をサンプル毎にメモリに記憶させれば、ロボツト
の運動軌跡を間接教示したことになる。 ところで(Y、Y)軸だけ変換するのは(Z、
α、β、γ)軸は、作業エリアがかわつてもコン
ソールボタンと動く方向は、あまりイメージ的に
変化しないため、変換が不必要なためである。 これによりロボツト内部基準座標系のデータを
修正せず、移動ベクトルMのみの修正で動かすこ
とができる。従つて第2の変換マトリツクスであ
る座標変換マトリツクス〔TXA〕は変更せず、
固定された条件で使用できるため、プログラムが
単純ですむ利点がある。それは〔TXA〕が膨大
な演算式(プログラム)であるためである。 以上は旋回台21の軸の変更であるが、他の軸
も同様に行い得る。 次に上述のアルゴリズムを手先26に応用する
場合について説明する。まず、前記実施例と同様
に関節形ロボツトを移動させ、新たな教示用直交
座標系X″、Y″、Z″の基準位置に位置付ける。そ
して手先姿勢移動指示スイツチ10を操作するこ
とにより、ロータリエンコーダ(位置検出手段)
17d〜17fから検出されてカウンタ回路18
d〜18fに記憶された変位量θ3〜θ6を変換マト
リツクス手段50により変換された内部基準直交
座標系の基準位置から教示用直交座標系X″、Y″、
Z″の基準位置への現在の変位量〔αθ、βθ、γθ〕
のデータをメモリ(記憶手段)42に記憶させ、
教示用直交座標系X″、Y″、Z″が設定される。同
時にゲート回路44がONになり、単位ベクトル
創成手段47によりサンプル毎創成された単位移
動量Δx″、Δy″、Δz″が入力される。変換マトリ
ツクス手段52は、次の(4)式に示すように、上記
メモリ(記憶手段)42に記憶された変位量
〔αθ、βθ、γθ〕を読み出して第1の変換マトリツ
クスを算出すると共に教示用直交座標系において
単位ベクトル創成手段47によりサンプル毎創成
された単位移動量Δx″、Δy″、Δz″に上記第1の
変換マトリツクスを掛算して移動ベクトル変換を
行い、内部基準直交座標系における単位移動量M
(Δx、Δy、Δz〕を演算する。 そして演算手段48はPt〔θ1〜θ6〕=〔TXA〕
PQ(t−1)〔X、Y、Z、α、β、γ〕+M
〔Δx、Δy、Δz、Δα、Δβ、Δγ〕}の演算を施こ
し、この演算結果にもとづいてD/A変換回路1
4a〜14f、駆動回路15a〜15fを介し、
駆動モータ16a〜16fが駆動される。なお最
初のX、Y、Z、α、β、γはメモリ49に入力
されているX〓、Y〓、Z〓、α〓、β〓、γ〓を用い、
その
後は演算手段48によつて演算されたθ1〜θ6を
X、Y、Z、α、β、γに変換し、その値を用い
る。但し、PQ(t−1)〔X、Y、Z、α、β、
γ〕は、一つ前のサンプリング時の内部基準直交
座標系における位置座標を示す。このようにして
関節ロボツトは手先26の姿勢にイメージされた
(X″、Y″、Z″)軸上を動く。第2図にこの教示
座標系(X″、Y″、Z″)を示す。即ち手先26の
軸心をZ″軸とし、このZ″軸に直交し、第3図に
示す腕部材の長手に直角な方向をX″軸、これら
Z″軸、X″軸に直交する軸をY″とする。これはワ
ークを穴に挿入する作業の教示の時便利ある。即
ちワークと手先は姿勢の関係が直角平行なのが通
例であり、ワークの姿勢を一定にして、ワークの
軸に従つて(X″、Y″、Z″)(この場合はワーク
の直交座標系)に動かせるわけで、例えばワーク
を傾いた穴に挿入するなどの時、ワークの軸を穴
に軸方向と一致させ、手先姿勢指示スイツチ10
をおせば、一軸のスイツチ操作でプレイバツク中
と同様に教示時に間接操作によつてもワークを穴
に挿入させることができ、実際のプレイバツクと
教示中のロボツト動作を作業者は同一にして教示
できる。 以上各軸、原点座標系、手先姿勢座標系の三つ
のモードはコンソール1上のランプによつてその
区別を知らせる様になつている。また第4図に示
す53はコンピユータ12内に設けられたタイマ
ーウエイトであり、54はコンソール1上に設け
られた操作ボタンである。 以上説明したように本発明によれば、次のよう
な作用効果を奏する。 (1) 作業者が、作業領域にあわせてロボツトの指
先(手先)を動かせることにより、操作がより
簡便にし、間接教示を容易に行なわせることが
できる。 (2) ロボツトの動作が作業者のいだく動作方向・
座標系と一致するため操作ミスをなくすことが
できる。 (3) ワーク穴への挿入など動作軌跡の制約を受け
る場合でも、実際にロボツトにワークを持たせ
たまま、間接操作により動作させて必要な軌跡
を描かせることができるためより、実際作業の
とおりに教示することができる。 (4) 少ないスイツチ操作で、目標位置までロボツ
トを動かせることができる。 (5) (1)〜(4)によりプレイバツクロボツトの操作が
簡易化され、教示作業時間の短縮が予想され、
ロボツトの稼動時間の効率が向上する効果が得
られる。
移動量とにより次の(3)式に示す演算処理が施さ
れ、内部基準直交座標系におけるM(±Δx、±
Δy)Tなる単位移動量が逐次出力される。 同時にマイクロコンピユータ12のメモリ49
に、サンプリング1つ前の点PQ(t−1)の位置
座標PQ(t−1)〔X、Y、Z、α、β、γ〕が
PQ(t−1)〔θ1〜θ6〕から演算手段48により
逆変換されてメモリされる。演算手段48は、更
にメモリ49から逐次読み出されたサンプル前の
内部基準直交座標系の位置座標PQ(t−1)〔X、
Y、Z、α、β、γ〕と変換マトリツクス手段5
1から逐次出力される単位移動量〔Δx、Δy、
Δz、Δα、Δβ、Δγ〕と第2の変換マトリツクス
〔TXA〕とから次の式のように各関節の回転角θ1
〜θ6でもつて表わされる次の目標位置PQt〔θ1〜
θ6〕を逐次演算し、逐次演算された結果にもとづ
いてD/A変換回路14a〜14f、駆動回路1
5a〜15fを介し、駆動モータ16a〜16f
が駆動される。 PQt〔θ1〜θ6〕=〔TXA〕{PQ(t−1)〔X、Y、
Z、α、β、γ〕+M〔Δx、Δy、Δz、Δα、Δβ、
Δγ〕} なお50はカウンタ回路81a〜18fより出
力される〔θ1(t−1)〜θ6(t−1)〕を〔X(t
−1)、Y(t−1)、Z(t−1)、α(t−1)、
β(t−1)、γ(t−1)〕に変換する変換マトリ
ツクス手段である。 これにより、変換マトリツクス手段51により
上記(3)式の変換をサンプルh毎に行つて、演算手
段48で演算を行うと、上記(3)式の単位移動ベク
トルMをあたかも作業者31がコンソール1の指
示スイツチ2a,2b〜7a,7bを作業者エリ
ア32の教示座標系X′、Y′、Z′(Z)で考えられ
る移動方向に操作することにより関節形ロボツト
が作業者が頭に描く方向(X′方向、Y方向)に
移動するように変換することができる。このよう
にして移動されてカウンタ回路18a〜18fに
記憶された角度座標値〔θ1、θ2、θ3、θ4、θ5、θ6
〕
をサンプル毎にメモリに記憶させれば、ロボツト
の運動軌跡を間接教示したことになる。 ところで(Y、Y)軸だけ変換するのは(Z、
α、β、γ)軸は、作業エリアがかわつてもコン
ソールボタンと動く方向は、あまりイメージ的に
変化しないため、変換が不必要なためである。 これによりロボツト内部基準座標系のデータを
修正せず、移動ベクトルMのみの修正で動かすこ
とができる。従つて第2の変換マトリツクスであ
る座標変換マトリツクス〔TXA〕は変更せず、
固定された条件で使用できるため、プログラムが
単純ですむ利点がある。それは〔TXA〕が膨大
な演算式(プログラム)であるためである。 以上は旋回台21の軸の変更であるが、他の軸
も同様に行い得る。 次に上述のアルゴリズムを手先26に応用する
場合について説明する。まず、前記実施例と同様
に関節形ロボツトを移動させ、新たな教示用直交
座標系X″、Y″、Z″の基準位置に位置付ける。そ
して手先姿勢移動指示スイツチ10を操作するこ
とにより、ロータリエンコーダ(位置検出手段)
17d〜17fから検出されてカウンタ回路18
d〜18fに記憶された変位量θ3〜θ6を変換マト
リツクス手段50により変換された内部基準直交
座標系の基準位置から教示用直交座標系X″、Y″、
Z″の基準位置への現在の変位量〔αθ、βθ、γθ〕
のデータをメモリ(記憶手段)42に記憶させ、
教示用直交座標系X″、Y″、Z″が設定される。同
時にゲート回路44がONになり、単位ベクトル
創成手段47によりサンプル毎創成された単位移
動量Δx″、Δy″、Δz″が入力される。変換マトリ
ツクス手段52は、次の(4)式に示すように、上記
メモリ(記憶手段)42に記憶された変位量
〔αθ、βθ、γθ〕を読み出して第1の変換マトリツ
クスを算出すると共に教示用直交座標系において
単位ベクトル創成手段47によりサンプル毎創成
された単位移動量Δx″、Δy″、Δz″に上記第1の
変換マトリツクスを掛算して移動ベクトル変換を
行い、内部基準直交座標系における単位移動量M
(Δx、Δy、Δz〕を演算する。 そして演算手段48はPt〔θ1〜θ6〕=〔TXA〕
PQ(t−1)〔X、Y、Z、α、β、γ〕+M
〔Δx、Δy、Δz、Δα、Δβ、Δγ〕}の演算を施こ
し、この演算結果にもとづいてD/A変換回路1
4a〜14f、駆動回路15a〜15fを介し、
駆動モータ16a〜16fが駆動される。なお最
初のX、Y、Z、α、β、γはメモリ49に入力
されているX〓、Y〓、Z〓、α〓、β〓、γ〓を用い、
その
後は演算手段48によつて演算されたθ1〜θ6を
X、Y、Z、α、β、γに変換し、その値を用い
る。但し、PQ(t−1)〔X、Y、Z、α、β、
γ〕は、一つ前のサンプリング時の内部基準直交
座標系における位置座標を示す。このようにして
関節ロボツトは手先26の姿勢にイメージされた
(X″、Y″、Z″)軸上を動く。第2図にこの教示
座標系(X″、Y″、Z″)を示す。即ち手先26の
軸心をZ″軸とし、このZ″軸に直交し、第3図に
示す腕部材の長手に直角な方向をX″軸、これら
Z″軸、X″軸に直交する軸をY″とする。これはワ
ークを穴に挿入する作業の教示の時便利ある。即
ちワークと手先は姿勢の関係が直角平行なのが通
例であり、ワークの姿勢を一定にして、ワークの
軸に従つて(X″、Y″、Z″)(この場合はワーク
の直交座標系)に動かせるわけで、例えばワーク
を傾いた穴に挿入するなどの時、ワークの軸を穴
に軸方向と一致させ、手先姿勢指示スイツチ10
をおせば、一軸のスイツチ操作でプレイバツク中
と同様に教示時に間接操作によつてもワークを穴
に挿入させることができ、実際のプレイバツクと
教示中のロボツト動作を作業者は同一にして教示
できる。 以上各軸、原点座標系、手先姿勢座標系の三つ
のモードはコンソール1上のランプによつてその
区別を知らせる様になつている。また第4図に示
す53はコンピユータ12内に設けられたタイマ
ーウエイトであり、54はコンソール1上に設け
られた操作ボタンである。 以上説明したように本発明によれば、次のよう
な作用効果を奏する。 (1) 作業者が、作業領域にあわせてロボツトの指
先(手先)を動かせることにより、操作がより
簡便にし、間接教示を容易に行なわせることが
できる。 (2) ロボツトの動作が作業者のいだく動作方向・
座標系と一致するため操作ミスをなくすことが
できる。 (3) ワーク穴への挿入など動作軌跡の制約を受け
る場合でも、実際にロボツトにワークを持たせ
たまま、間接操作により動作させて必要な軌跡
を描かせることができるためより、実際作業の
とおりに教示することができる。 (4) 少ないスイツチ操作で、目標位置までロボツ
トを動かせることができる。 (5) (1)〜(4)によりプレイバツクロボツトの操作が
簡易化され、教示作業時間の短縮が予想され、
ロボツトの稼動時間の効率が向上する効果が得
られる。
第1図は本発明の関節形ロボツトの間接教示方
法を実施する装置の概略構成を示す図、第2図は
関節形ロボツトの構成と、内部基準直交座標系、
及び教示用座標系の一例とを示す図、第3図は教
示用座標系の他の一例を示す図、第4図は第1図
の示装置を更に具体的に示した構成図である。 符号の説明、8……各軸スイツチ、9……原点
変更指示スイツチ、10……手先姿勢移動指示ス
イツチ、12……マイクロコンピユータ、41,
42,49……メモリ、43,44,45,46
……ゲート回路、51,52,56……変換マト
リツクス手段、47……単位ベクトル創成手段、
48……演算手段、15a〜15f……駆動回
路、16a〜16f……駆動モータ。
法を実施する装置の概略構成を示す図、第2図は
関節形ロボツトの構成と、内部基準直交座標系、
及び教示用座標系の一例とを示す図、第3図は教
示用座標系の他の一例を示す図、第4図は第1図
の示装置を更に具体的に示した構成図である。 符号の説明、8……各軸スイツチ、9……原点
変更指示スイツチ、10……手先姿勢移動指示ス
イツチ、12……マイクロコンピユータ、41,
42,49……メモリ、43,44,45,46
……ゲート回路、51,52,56……変換マト
リツクス手段、47……単位ベクトル創成手段、
48……演算手段、15a〜15f……駆動回
路、16a〜16f……駆動モータ。
Claims (1)
- 1 各関節を駆動する駆動手段と、各関節の回転
量を検出する位置検出手段とを備え、少なくとも
3自由度を有するテイーチングプレイバツク式関
節形ロボツトにおいて、上記検出手段から検出さ
れる各関節の角度変位量をサンプル毎に内部基準
直交座標系の位置座標に変換する角度・直交変換
マトリツクス手段と、原点変更又は手先姿勢移動
の指示をする原点変更又は手先姿勢移動指示スイ
ツチと、上記駆動手段を駆動させて関節を動作さ
せ、任意の教示用直交座標系の基準位置に位置付
けし、上記原点変更又は手先姿勢移動指示スイツ
チを操作して上記位置付けられた時の内部基準直
交座標系の基準位置からの変位量を、上記位置検
出手段または上記角度・直交変換マトリツクス手
段から検出してその値を記憶手段に記憶させて教
示用直交座標系を設定する教示用直交座標系設定
手段と、関節形ロボツトを座標の各軸方向に移動
させるべく座標の各軸方向を指示する軸方向指示
スイツチと、該軸方向指示スイツチの操作により
サンプル毎に単位移動量を逐次創成する単位ベク
トル創成手段と、上記教示用直交座標系設定手段
の記憶手段に記憶された基準位置からの変位量を
読出してこの変位量に基いて第1の変換マトリツ
クスを算出し、この算出された第1の変換マトリ
ツクスと上記単位ベクトル創成手段によつて逐次
創成された単位移動量とを掛算して内部基準直交
座標系の単位移動量を逐次求める第1の変換マト
リツクス手段と、上記角度・直交変換マトリツク
ス手段から得られる前の位置の内部基準直交座標
系の位置座標と上記第1の変換マトリツクス手段
より求められた内部基準直交座標系の単位移動量
とを加算し、この加算された値に第2の変換マト
リツクスを掛算して次の目標位置への各関節の回
転角を逐次演算して求め、この演算結果にもとづ
いて上記駆動手段を駆動する演算手段とを備えた
ことを特徴とする関節形ロボツトの間接教示装
置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15594380A JPS5783390A (en) | 1980-11-07 | 1980-11-07 | Indirect instruction method for articulated type robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15594380A JPS5783390A (en) | 1980-11-07 | 1980-11-07 | Indirect instruction method for articulated type robot |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS5783390A JPS5783390A (en) | 1982-05-25 |
JPS6346844B2 true JPS6346844B2 (ja) | 1988-09-19 |
Family
ID=15616905
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP15594380A Granted JPS5783390A (en) | 1980-11-07 | 1980-11-07 | Indirect instruction method for articulated type robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS5783390A (ja) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58137589A (ja) * | 1982-02-09 | 1983-08-16 | 松下電器産業株式会社 | ロボットの移動方向指示方法 |
JPS5914482A (ja) * | 1982-07-09 | 1984-01-25 | 株式会社日立製作所 | ロボットのティーチング装置 |
JPS59135508A (ja) * | 1983-01-21 | 1984-08-03 | Shin Meiwa Ind Co Ltd | 産業用ロボツト |
JPS59182076A (ja) * | 1983-03-31 | 1984-10-16 | 株式会社日立製作所 | ロボツト据え付け誤差測定装置 |
JPS59181122A (ja) * | 1983-03-31 | 1984-10-15 | オリンパス光学工業株式会社 | 内視鏡等における進退誘導装置 |
JPS60193016A (ja) * | 1984-03-14 | 1985-10-01 | Toyota Motor Corp | ロボツト装置 |
JPS619707A (ja) * | 1984-06-25 | 1986-01-17 | Mitsubishi Electric Corp | 産業機械の制御装置 |
JPS6154506A (ja) * | 1984-08-24 | 1986-03-18 | Fanuc Ltd | ア−ク開始点探索時のツ−ルの探索姿勢制御方式 |
JPH0726724Y2 (ja) * | 1985-01-11 | 1995-06-14 | 株式会社安川電機 | 産業用ロボツトの教示装置 |
JPH0762803B2 (ja) * | 1985-11-02 | 1995-07-05 | 日立建機株式会社 | アーム式作業機の駆動制御装置 |
JPH0762804B2 (ja) * | 1985-11-02 | 1995-07-05 | 日立建機株式会社 | 作業機構の駆動制御装置 |
JPS62272305A (ja) * | 1986-05-21 | 1987-11-26 | Mitsubishi Electric Corp | 数値制御装置 |
JPS6325704A (ja) * | 1986-07-18 | 1988-02-03 | Tokico Ltd | 工業用ロボツト |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS49134059A (ja) * | 1973-04-27 | 1974-12-24 | ||
JPS50112969A (ja) * | 1974-02-18 | 1975-09-04 |
-
1980
- 1980-11-07 JP JP15594380A patent/JPS5783390A/ja active Granted
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS49134059A (ja) * | 1973-04-27 | 1974-12-24 | ||
JPS50112969A (ja) * | 1974-02-18 | 1975-09-04 |
Also Published As
Publication number | Publication date |
---|---|
JPS5783390A (en) | 1982-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7321808B2 (en) | Robot and multiple robot control method | |
US5617515A (en) | Method and apparatus for controlling and programming a robot or other moveable object | |
US8175750B2 (en) | Control apparatus and control method for robot arm, robot, control program for robot arm, and robot arm control-purpose integrated electronic circuit | |
KR101498836B1 (ko) | 7축 다관절 로봇의 제어 장치 및 교시 방법 | |
JPH079606B2 (ja) | ロボット制御装置 | |
JP2512099B2 (ja) | ロボットの動作教示方法および制御装置 | |
JP2684359B2 (ja) | ロボットのワーク直交座標系設定装置 | |
JPS6346844B2 (ja) | ||
KR960001962B1 (ko) | 로보트의 공구 자세 제어방법 | |
US5495090A (en) | Welding robot | |
JPH05303422A (ja) | 直接教示方式ロボット | |
JP2667153B2 (ja) | 複腕装置の直接教示方法 | |
JPS5878205A (ja) | 工業用ロボツトのテイ−チング方法 | |
JPH05345291A (ja) | ロボットの動作範囲制限方式 | |
JPWO2017175340A1 (ja) | 最適化装置及びそれを備えた垂直型多関節ロボット | |
JPS60108908A (ja) | 産業用ロボツト装置 | |
KR100321497B1 (ko) | 로봇의 운동지시 방법 | |
JP7352267B1 (ja) | 多関節ロボット、多関節ロボットの制御方法、ロボットシステム、及び、物品の製造方法 | |
CN112828897B (zh) | 示教装置、控制方法以及存储介质 | |
JP7185749B2 (ja) | ロボットシステム及びロボットシステムの制御方法 | |
WO2023162225A1 (ja) | ロボット制御装置および多関節ロボット | |
JP2669075B2 (ja) | ロボットの位置と姿勢の直接教示装置及び直接教示方法 | |
JPH10244481A (ja) | ロボットの動作プログラム作成方法および装置 | |
WO2024048285A1 (ja) | 多関節ロボット、多関節ロボットの制御方法、ロボットシステム、及び、物品の製造方法 | |
JPS6351282B2 (ja) |