JPS636603A - ロボツトの制御方法 - Google Patents
ロボツトの制御方法Info
- Publication number
- JPS636603A JPS636603A JP15090086A JP15090086A JPS636603A JP S636603 A JPS636603 A JP S636603A JP 15090086 A JP15090086 A JP 15090086A JP 15090086 A JP15090086 A JP 15090086A JP S636603 A JPS636603 A JP S636603A
- Authority
- JP
- Japan
- Prior art keywords
- command value
- deviation
- value
- arm
- target
- 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
- 238000000034 method Methods 0.000 title claims description 11
- 238000006073 displacement reaction Methods 0.000 claims abstract description 26
- 238000009434 installation Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
Landscapes
- Numerical Control (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は、動作軸の移動経路を連続的に制御して目標軌
跡で動作させるロボットの制御方法に関するものである
。
跡で動作させるロボットの制御方法に関するものである
。
(従来の技術)
従来において、この種のロボット制御方法として、予め
記憶した所定時間毎の位置指令値を順次に出力して各動
作軸を変位させると共に、指令値と変化量との偏差が減
少するように速度と位置のフィードバック制御を行うよ
うにしたものがある。
記憶した所定時間毎の位置指令値を順次に出力して各動
作軸を変位させると共に、指令値と変化量との偏差が減
少するように速度と位置のフィードバック制御を行うよ
うにしたものがある。
また、指令値を動作軸相互間の干渉や遠心力等の影響を
考慮して設定し、これを公称指令値として次々に出力し
、各動作軸の位置と速度の現在値との偏差を減少させる
ようにフィードバック制御するようにしたものがある。
考慮して設定し、これを公称指令値として次々に出力し
、各動作軸の位置と速度の現在値との偏差を減少させる
ようにフィードバック制御するようにしたものがある。
(発明が解決しようとする問題点)
ところが、前者の方法においては、制御系が各動作軸毎
に構成されているため、制御装置の構成が簡単になると
いう利点があるが、高速で大変位の移動を伴う動作をさ
せるためには各動作軸相互間の干渉による負荷変動が生
じたり、遠心力や車力などの影響で蛇行や行き過ぎ等が
生じ、高速で高精度の軌跡側?JDはnしいという問題
がある。
に構成されているため、制御装置の構成が簡単になると
いう利点があるが、高速で大変位の移動を伴う動作をさ
せるためには各動作軸相互間の干渉による負荷変動が生
じたり、遠心力や車力などの影響で蛇行や行き過ぎ等が
生じ、高速で高精度の軌跡側?JDはnしいという問題
がある。
−方、後者の方法では8速・高精度の軌跡制御は可能で
あるが、多数の目標位置がある場合には各目標位置毎の
公称指令値を記憶するための記憶容量が膨大になって高
価な構成となってしまう問題がある。
あるが、多数の目標位置がある場合には各目標位置毎の
公称指令値を記憶するための記憶容量が膨大になって高
価な構成となってしまう問題がある。
本発明は安価にして簡単な構成で多数の目標位置に高速
・高精度で軌跡の制御を行うことができるロボットの制
御方法を提供することを目的としている。
・高精度で軌跡の制御を行うことができるロボットの制
御方法を提供することを目的としている。
(問題点を解決するための手段)
本発明は、プレイバック運転によって軌跡の目標値に対
応した所定時間毎の指令値に対する動作軸の変位量のt
rA差を検出して該偏差に応じて同所定時間の指令値を
前記偏差によって修正し、その修正した指令値に対する
動作軸の変位量と目標値との偏差が許容範囲になるまで
修正動作を繰返し、許容偏差範囲に収束した指令値によ
ってそれぞれ対応した動作軸を駆動して目標軌跡に変位
させるようにしたものである。
応した所定時間毎の指令値に対する動作軸の変位量のt
rA差を検出して該偏差に応じて同所定時間の指令値を
前記偏差によって修正し、その修正した指令値に対する
動作軸の変位量と目標値との偏差が許容範囲になるまで
修正動作を繰返し、許容偏差範囲に収束した指令値によ
ってそれぞれ対応した動作軸を駆動して目標軌跡に変位
させるようにしたものである。
(作用)
軌跡の目標値に対応した所定時間毎の指令値はプレイバ
ック運転毎に動作軸の変位量との偏差に応じて修正され
る。この修正は目n IUと変位量との差が許容範囲に
なるまで繰返される。これによって、目標値に対し許容
範囲内で動作軸の変位量を収束させる指令値が得られる
。従って、この最終的に得られた指令値を用いることに
より、動作軸を目標値に対して許容範囲内で高速・高:
精度で収束させることができる。
ック運転毎に動作軸の変位量との偏差に応じて修正され
る。この修正は目n IUと変位量との差が許容範囲に
なるまで繰返される。これによって、目標値に対し許容
範囲内で動作軸の変位量を収束させる指令値が得られる
。従って、この最終的に得られた指令値を用いることに
より、動作軸を目標値に対して許容範囲内で高速・高:
精度で収束させることができる。
(実施例)
第1図は本発明を適用するロボットの一例を示す斜視図
であり、第1アーム1と第2アーム2とを有し、基台3
を設置面に平行な面で図示するS方向に、また第1アー
ムを基台3を支点として図示するL方向に傾斜させ、さ
らに第2アーム2を第1アームの上端を支点として図示
するり方向に傾斜させ得るように構成され、さらに第2
アーム2をその円周方向(α方向)に、第2アーム2の
先端に取付けた関節部4をβ方向に、関節部4に取付け
た治具5をγ方向にそれぞれ回動変位させ得るように構
成されている。
であり、第1アーム1と第2アーム2とを有し、基台3
を設置面に平行な面で図示するS方向に、また第1アー
ムを基台3を支点として図示するL方向に傾斜させ、さ
らに第2アーム2を第1アームの上端を支点として図示
するり方向に傾斜させ得るように構成され、さらに第2
アーム2をその円周方向(α方向)に、第2アーム2の
先端に取付けた関節部4をβ方向に、関節部4に取付け
た治具5をγ方向にそれぞれ回動変位させ得るように構
成されている。
これらの各回初変位部はそれぞれに対応して設けられた
動作軸の回動変位によって変位し、治具5を目標軌跡に
制御する。
動作軸の回動変位によって変位し、治具5を目標軌跡に
制御する。
このようなロボットにおいて、第1アーム1゜第2アー
ム2および基台3に対して治具5が円形の軌跡を描くよ
うな指定値を与えると、これらのアーム1,2および基
台3がL方向、α方向、S方向に回動変位し、その合成
ベクトルによって冶具5がX軸方向およびY軸方向に変
位し、第2図の実線で示すような円形の軌跡が得られる
。
ム2および基台3に対して治具5が円形の軌跡を描くよ
うな指定値を与えると、これらのアーム1,2および基
台3がL方向、α方向、S方向に回動変位し、その合成
ベクトルによって冶具5がX軸方向およびY軸方向に変
位し、第2図の実線で示すような円形の軌跡が得られる
。
この場合、アーム1,2および基台3の応答遅れや慣性
によってこれらは指令値通りに動かず、治具5の実際の
軌跡は第2図の破線で示すように円軌跡とはならない。
によってこれらは指令値通りに動かず、治具5の実際の
軌跡は第2図の破線で示すように円軌跡とはならない。
そこで、本発明では各動作軸の実際の変位ωと指令値と
の偏差を指令値の各出力時間毎に求め、この偏差が軌跡
の目標値の許容範囲内に収束するまで修正するプレイバ
ック運転を沁返すものである。
の偏差を指令値の各出力時間毎に求め、この偏差が軌跡
の目標値の許容範囲内に収束するまで修正するプレイバ
ック運転を沁返すものである。
すなわち、説明を簡単にするために1つの駆動軸につい
てのみ代表して説明すると、所定時間Δを毎に第3図に
示すように変化する指令値(変位角度情報)Xl 、X
2 、X3・・・が与えられるが、実際の変位量はxl
、x2.x3.・・・となり、目標の軌跡とずれてしま
う。そこで、本発明は第1回目のプレイバック運転にお
いて次のようにして −各時間毎の指令値X1 、
X2 、X3・・・を修正する。
てのみ代表して説明すると、所定時間Δを毎に第3図に
示すように変化する指令値(変位角度情報)Xl 、X
2 、X3・・・が与えられるが、実際の変位量はxl
、x2.x3.・・・となり、目標の軌跡とずれてしま
う。そこで、本発明は第1回目のプレイバック運転にお
いて次のようにして −各時間毎の指令値X1 、
X2 、X3・・・を修正する。
丁なりち、運転開始時の指令値×1については、この指
令値x1を与えた時の動作軸の変位1x1はxl =Q
であるからその偏差はXlとなり、この偏差X1で動作
軸を駆動する。この駆vJ1111作によって指令値×
1との偏差はXl−Xlまで縮まる、しかし、xlの次
の指令値×2が与えられると、新たな偏差として[×2
−xI Jが生じ、動作軸はこの偏差rX2−xI J
で駆動されることになる。
令値x1を与えた時の動作軸の変位1x1はxl =Q
であるからその偏差はXlとなり、この偏差X1で動作
軸を駆動する。この駆vJ1111作によって指令値×
1との偏差はXl−Xlまで縮まる、しかし、xlの次
の指令値×2が与えられると、新たな偏差として[×2
−xI Jが生じ、動作軸はこの偏差rX2−xI J
で駆動されることになる。
従って、×1を×1に近付けるためには×1°=X1/
xi ・×1 とした修正指令値X1°を与えればよい。同様に、×2
については「×2−xI Jという偏差の信号によって
rx2−xi Jだけ変位するからrX2−×1」の変
位量に近付けるためには X2’= (<X2 −xl )/ (x2
−xl ) )・(X2−xl ) +X 1 とした修正指令値X2’を与えればよい。
xi ・×1 とした修正指令値X1°を与えればよい。同様に、×2
については「×2−xI Jという偏差の信号によって
rx2−xi Jだけ変位するからrX2−×1」の変
位量に近付けるためには X2’= (<X2 −xl )/ (x2
−xl ) )・(X2−xl ) +X 1 とした修正指令値X2’を与えればよい。
すなわち、動作軸の変位量の目標値rX2−X1」に偏
差の信号rX2−xI Jに対する動作軸の変位量の倍
率r (X2−xi )/ (x2−xl )」を乗算
した指令値×2°を実際の動きを考慮した指令値として
動作軸に与えることにより、動作軸の変位量を目標値に
近付けることができる。
差の信号rX2−xI Jに対する動作軸の変位量の倍
率r (X2−xi )/ (x2−xl )」を乗算
した指令値×2°を実際の動きを考慮した指令値として
動作軸に与えることにより、動作軸の変位量を目標値に
近付けることができる。
−膜化すると、第nステップ目の指令値Xnについては
Xn’= ((Xn−xo−1)/xn −xo 、)
(Xn−X、−1)+Xn、、−1・ (1)という演
算によって修正指令値Xn“を求め、この修正指令値X
n”で駆動することにより第nステップ目の目標]直に
近付けることができる。
(Xn−X、−1)+Xn、、−1・ (1)という演
算によって修正指令値Xn“を求め、この修正指令値X
n”で駆動することにより第nステップ目の目標]直に
近付けることができる。
そこで、本発明においてはそれぞれのステップにおいて
、指令値Xnに対する変位量xnの偏差を検出して前述
の第(1)式に従って各ステップ毎の指令値xnを修正
して配置しておき、次のプレイバック運転時に前回修正
しておいた指令値Xn゛によって再び同様の修正動作を
実行し、その修正した指令値に対する実際の変位量が目
標値の許容範囲内1x′n−xnl≦εに収束したなら
ば、修正終了としてこの最終の修正指令値によって以後
のプレイバック運転を行う。
、指令値Xnに対する変位量xnの偏差を検出して前述
の第(1)式に従って各ステップ毎の指令値xnを修正
して配置しておき、次のプレイバック運転時に前回修正
しておいた指令値Xn゛によって再び同様の修正動作を
実行し、その修正した指令値に対する実際の変位量が目
標値の許容範囲内1x′n−xnl≦εに収束したなら
ば、修正終了としてこの最終の修正指令値によって以後
のプレイバック運転を行う。
第4図に以上の修正動作の手順をフローチャートで示し
ている。
ている。
このように、複数回のプレイバック運転により動作軸の
実際の変位量が目標値の許容範囲内に収束するまで指令
値を修正し、この修正した指令値を用いて実用時のプレ
イバック運転を行うようにしたことにより、動作軸の慣
性や自重、相互間干渉など全ての条件を考慮した精度の
高い指令値を極めて簡単に得ることができる。この結果
、動作軌跡の目標値の多少、あるいは変位量の多少に関
係なく動作軸を高精度で目標値に制御することができる
。また、修正した指令値は前回の記憶位置に記憶させる
ため、記憶容量も増加することでもない。さらに、指令
値の修正動作は前回のステップの変位量を加味して行っ
ているため、動作軸の相互間干渉などの他に時間的な相
互間干渉をも抑制することができる。
実際の変位量が目標値の許容範囲内に収束するまで指令
値を修正し、この修正した指令値を用いて実用時のプレ
イバック運転を行うようにしたことにより、動作軸の慣
性や自重、相互間干渉など全ての条件を考慮した精度の
高い指令値を極めて簡単に得ることができる。この結果
、動作軌跡の目標値の多少、あるいは変位量の多少に関
係なく動作軸を高精度で目標値に制御することができる
。また、修正した指令値は前回の記憶位置に記憶させる
ため、記憶容量も増加することでもない。さらに、指令
値の修正動作は前回のステップの変位量を加味して行っ
ているため、動作軸の相互間干渉などの他に時間的な相
互間干渉をも抑制することができる。
(発明の効果)
以上説明したように本発明は、複数回のプレイバック運
転によって動作軸の実際の変位量が目標値の許容範囲内
に収束するまで指令値を修正し、この修正した指令値を
用いて実用時のプレイバック運転を行うようにしたため
、安価にして簡単な構成で多数の目標値に高速・高:精
度で軌跡の制御を行うことができる効果がある。
転によって動作軸の実際の変位量が目標値の許容範囲内
に収束するまで指令値を修正し、この修正した指令値を
用いて実用時のプレイバック運転を行うようにしたため
、安価にして簡単な構成で多数の目標値に高速・高:精
度で軌跡の制御を行うことができる効果がある。
第1図は本発明を適用するロボットの一例を示す斜視図
、第2図は目標となる円軌跡と実際の軌跡の一例を示す
図、第3図は所定時間毎の指令値と変位量の変化を示す
図、第4図は指令値の修正動作の手順を示すフローチャ
ートである。 1・−第1アーム、2・・・第2アーム、3・・・基台
、4・・・関節部、5・・・治具。
、第2図は目標となる円軌跡と実際の軌跡の一例を示す
図、第3図は所定時間毎の指令値と変位量の変化を示す
図、第4図は指令値の修正動作の手順を示すフローチャ
ートである。 1・−第1アーム、2・・・第2アーム、3・・・基台
、4・・・関節部、5・・・治具。
Claims (1)
- 【特許請求の範囲】 複数の動作軸のそれぞれに対して所定時間毎に指令値を
与え、各動作軸を指令値で教示された軌跡に変位させる
ロボットの制御方法において、プレイバック運転によっ
て軌跡の目標値に対応した所定時間毎の指令値に対する
動作軸の変位量の偏差を検出して該偏差に応じて同所定
時間の指令値を修正し、 その修正した指令値に対する動作軸の変位量と目標値と
の偏差が許容範囲になるまで修正動作を繰返し、 許容偏差範囲に収束した指令値によつてそれぞれ対応し
た動作軸を駆動して目標軌跡に変位させることを特徴と
するロボットの制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15090086A JPS636603A (ja) | 1986-06-27 | 1986-06-27 | ロボツトの制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15090086A JPS636603A (ja) | 1986-06-27 | 1986-06-27 | ロボツトの制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS636603A true JPS636603A (ja) | 1988-01-12 |
Family
ID=15506835
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP15090086A Pending JPS636603A (ja) | 1986-06-27 | 1986-06-27 | ロボツトの制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS636603A (ja) |
-
1986
- 1986-06-27 JP JP15090086A patent/JPS636603A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5020001A (en) | Robot controller | |
EP0172486A2 (en) | Tracking robot apparatus | |
US7925382B2 (en) | Robot controller and robot control method | |
JP3380327B2 (ja) | パラレルリンクマニピュレータのたわみ補正制御方法 | |
JP3296585B2 (ja) | 位置および力を制御するハイブリッドシステム | |
JPS636603A (ja) | ロボツトの制御方法 | |
JPS618236A (ja) | 移動体制御装置 | |
JP7227018B2 (ja) | 学習制御装置、ロボット制御装置およびロボット | |
JPH0916229A (ja) | 産業用ロボット | |
JPS6010648B2 (ja) | ロボットの外力補償用制御方法 | |
JPS59220806A (ja) | 工業用ロボツトの制御方法 | |
JPS60118478A (ja) | 関節形ロボツトの位置制御装置 | |
JPS61255409A (ja) | 2軸位置決め制御装置 | |
JP2752784B2 (ja) | ロボットの姿勢修正方法 | |
JPH0639066B2 (ja) | 産業用ロボツトの制御方法 | |
JPH06289918A (ja) | ロボットの学習制御方法 | |
JP3031499B2 (ja) | 学習制御方法 | |
JPH0343171A (ja) | 多関節ロボット制御装置 | |
JP2778285B2 (ja) | 倣いセンサロボットシステム | |
JPS6132108A (ja) | 手動運転機能を備えた数値制御装置 | |
JPH02218574A (ja) | 工業用ロボットにおける軌跡補正方法 | |
JP2724054B2 (ja) | 位置決め制御装置 | |
JPH0732281A (ja) | ロボット制御装置 | |
JPS6315303A (ja) | 学習制御方法 | |
JPS6340908A (ja) | ロボツト制御装置 |