JPS60220408A - 関節形ロボツト用制御装置 - Google Patents
関節形ロボツト用制御装置Info
- Publication number
- JPS60220408A JPS60220408A JP7645284A JP7645284A JPS60220408A JP S60220408 A JPS60220408 A JP S60220408A JP 7645284 A JP7645284 A JP 7645284A JP 7645284 A JP7645284 A JP 7645284A JP S60220408 A JPS60220408 A JP S60220408A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- data
- point
- control device
- articulated robot
- 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)
- Manipulator (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔発明の利用分野〕
本発明は関節形ロボットのための制御装置に関するもの
である。
である。
関節形ロボットは複数たとえば5の自由度をもち、その
自由度の数に応じた軸をもつ。その軸の少なくともひと
つはロボット手首先端付近に予め設定された作用点の位
置に影響をおよぼす回転軸である。このロボットの制御
装置はロボット各軸の各サーボ制御回路に指令値を与え
、ロボット目標点を位置ぎめする機能をもつ。関節形ロ
ボットはその各軸に応じた可動部をもつ。この可動部は
アームあるいは手首の要素となるが、各可動部の動きを
なめらかなものとするためには各軸の速度をその訓諭速
度が一定となるように定めることが望ましい。それは可
動部に与える振動が小さくなり、また負荷も小さくなる
ためである。可動部の振動が小さくなるのは訓諭速度が
一定であり、加速度の急変が少ないためである。負荷が
小さいのも同様な理由であるが、これが小さければ可動
部あるいはアクチュエータあるいはその間の動力伝達路
の疲労も小さくなり、これら機械系が長寿命化する。
自由度の数に応じた軸をもつ。その軸の少なくともひと
つはロボット手首先端付近に予め設定された作用点の位
置に影響をおよぼす回転軸である。このロボットの制御
装置はロボット各軸の各サーボ制御回路に指令値を与え
、ロボット目標点を位置ぎめする機能をもつ。関節形ロ
ボットはその各軸に応じた可動部をもつ。この可動部は
アームあるいは手首の要素となるが、各可動部の動きを
なめらかなものとするためには各軸の速度をその訓諭速
度が一定となるように定めることが望ましい。それは可
動部に与える振動が小さくなり、また負荷も小さくなる
ためである。可動部の振動が小さくなるのは訓諭速度が
一定であり、加速度の急変が少ないためである。負荷が
小さいのも同様な理由であるが、これが小さければ可動
部あるいはアクチュエータあるいはその間の動力伝達路
の疲労も小さくなり、これら機械系が長寿命化する。
し力)しながら、関節形ロボットにおいてはその各軸の
速度をその訓諭速度が一定となるように制御することは
困難である。これはその各軸の速度が前記作用点の速度
のみならず、その作用点の位置にも影響をおよぼすため
である。このため、後にも指摘するように、各軸の訓諭
速度を無理に一定に制御しようとすると、作用点の軌跡
に みが生ずる結果となり、実用に供することが難かし
くなる。
速度をその訓諭速度が一定となるように制御することは
困難である。これはその各軸の速度が前記作用点の速度
のみならず、その作用点の位置にも影響をおよぼすため
である。このため、後にも指摘するように、各軸の訓諭
速度を無理に一定に制御しようとすると、作用点の軌跡
に みが生ずる結果となり、実用に供することが難かし
くなる。
本発明は関節形ロボット各軸の速度をその訓諭速度がな
るべく一定となるように制御し、もって機械系の振動お
よび負荷を軽減するものである。
るべく一定となるように制御し、もって機械系の振動お
よび負荷を軽減するものである。
〔発明の概要)
本発明の制御装置は始点と終点の各位置をあられすデー
タおよびその間を移動するときの始速度、最大速度、終
速度をあられすデータを記憶する手段を備える。これら
データのほとんどは関節形ロボットの教示時ζこ所定の
教示プロセスにしたがって生成される。始点も終点も関
節形ロボントの作用点のための位置決め目標点であり、
また一種の教示点である。始点、終点の区別は相対的で
あり、始点はその直前の教示点に対しては終点となり、
ままだ終点はその直後の教示点に対しては始点となる。
タおよびその間を移動するときの始速度、最大速度、終
速度をあられすデータを記憶する手段を備える。これら
データのほとんどは関節形ロボットの教示時ζこ所定の
教示プロセスにしたがって生成される。始点も終点も関
節形ロボントの作用点のための位置決め目標点であり、
また一種の教示点である。始点、終点の区別は相対的で
あり、始点はその直前の教示点に対しては終点となり、
ままだ終点はその直後の教示点に対しては始点となる。
始速度および終速度はそれぞれ始点および終点−こおけ
る速度であり、最大速度は始点終点間を作用点が移動す
るときの上限速度ないしは目標速度である。
る速度であり、最大速度は始点終点間を作用点が移動す
るときの上限速度ないしは目標速度である。
本発明装置は始点、終点間の移動軌跡に沿った各補間点
の位置データを演算する補間点演算手段を備える。この
手段はと演算プログラムを主体としたものであって、第
一と第二と第三の演算手段を含む。第一演算手段は前記
移動軌跡を所定値Bであられされる訓諭速度Bの区間、
訓諭速度−Bの区間、最大速度による定速区間、訓諭速
度−Bの区間、訓諭速度Bの区間に、こ間の順序で区分
するためのデータを演算する。訓諭速度Bの区間は加速
度の増加区間であり、訓諭速度−Bの区間は加速度の減
少区間である。第一演算手段の演算は始速度、速入速度
、終速度にもとづくものであって、かりに始速度が予め
定めた最大速度と同一の値であるのならば始点につづく
訓諭速度Bの区間、訓諭速度−Bの区間の長さはともに
零となる。
の位置データを演算する補間点演算手段を備える。この
手段はと演算プログラムを主体としたものであって、第
一と第二と第三の演算手段を含む。第一演算手段は前記
移動軌跡を所定値Bであられされる訓諭速度Bの区間、
訓諭速度−Bの区間、最大速度による定速区間、訓諭速
度−Bの区間、訓諭速度Bの区間に、こ間の順序で区分
するためのデータを演算する。訓諭速度Bの区間は加速
度の増加区間であり、訓諭速度−Bの区間は加速度の減
少区間である。第一演算手段の演算は始速度、速入速度
、終速度にもとづくものであって、かりに始速度が予め
定めた最大速度と同一の値であるのならば始点につづく
訓諭速度Bの区間、訓諭速度−Bの区間の長さはともに
零となる。
第二演算手段は上記各区間におけるサンプリング間隔ご
との速度データを演算するためのものであって、たとえ
ば訓諭速度Bの区間においてはその訓諭速度が所定値B
となるような速度がめられる。演算の形態ないしは都合
によっては前記速度は予め時間の定数を乗じた、あるい
はそれで除した長さあるいは加速度の単位であられされ
ることもあるが、その値が速度に比例するものであれば
、形式的なその単位の選び方は自由でよい。第三の演算
手段は前記第二の演算手段ζこよる速度データζこもと
すき各サンプリングタイムごとの各補間点の位置データ
を演算するためのものである。サンプリングタイムごと
の位置データを演算するという意味は演算のタイミング
を特定するものではなく、あるサンプリンタイムにおい
て使用される位置データを演算するということであるが
、当然のことながら、この演算はそのサンプリングタイ
ムが到達する以前に終了していなければならない。
との速度データを演算するためのものであって、たとえ
ば訓諭速度Bの区間においてはその訓諭速度が所定値B
となるような速度がめられる。演算の形態ないしは都合
によっては前記速度は予め時間の定数を乗じた、あるい
はそれで除した長さあるいは加速度の単位であられされ
ることもあるが、その値が速度に比例するものであれば
、形式的なその単位の選び方は自由でよい。第三の演算
手段は前記第二の演算手段ζこよる速度データζこもと
すき各サンプリングタイムごとの各補間点の位置データ
を演算するためのものである。サンプリングタイムごと
の位置データを演算するという意味は演算のタイミング
を特定するものではなく、あるサンプリンタイムにおい
て使用される位置データを演算するということであるが
、当然のことながら、この演算はそのサンプリングタイ
ムが到達する以前に終了していなければならない。
本発明装置は各補間点の位置データを関節形ロボットの
各軸データに変換する手段と、各軸データをサンプリン
グタイムごとに各軸のサーボ制御回路に指令値として与
える手段を備える。前記の変換はたとえば直交座標と、
たとえば各軸の一連の回転角度で示される座標との間の
一種の座標変換であり、その変換後の各軸データが所定
のサンプリングタイムの到来を待って各サーボ制御回路
へ入力される運びとなる。この結果、関節形ロボットの
作用点は始点力1ら所要の移動軌跡をたどってで終点へ
向うのである。
各軸データに変換する手段と、各軸データをサンプリン
グタイムごとに各軸のサーボ制御回路に指令値として与
える手段を備える。前記の変換はたとえば直交座標と、
たとえば各軸の一連の回転角度で示される座標との間の
一種の座標変換であり、その変換後の各軸データが所定
のサンプリングタイムの到来を待って各サーボ制御回路
へ入力される運びとなる。この結果、関節形ロボットの
作用点は始点力1ら所要の移動軌跡をたどってで終点へ
向うのである。
第1図は本発明に係る関節形ロボット用制御装置の一例
を示すブロック図である。1は中央処理装置(CPU)
、 2はプログラムメモリ、3はデータメモリ、4は入
出力装置、5はサーボ制御回路、6は関節形ロボットの
各軸を駆動するサーボモータのようなアクチュエータ、
7はフィードバック回路である。入出力装置4はキーボ
ード、キャラクタデスプレイ等であり、教示示にはこれ
らを操作し、関節形ロボットに必要なデータを生成し、
データメモリ3に記憶する。教示のためのプログラムは
プログラムメモリ2に予め記憶されている。
を示すブロック図である。1は中央処理装置(CPU)
、 2はプログラムメモリ、3はデータメモリ、4は入
出力装置、5はサーボ制御回路、6は関節形ロボットの
各軸を駆動するサーボモータのようなアクチュエータ、
7はフィードバック回路である。入出力装置4はキーボ
ード、キャラクタデスプレイ等であり、教示示にはこれ
らを操作し、関節形ロボットに必要なデータを生成し、
データメモリ3に記憶する。教示のためのプログラムは
プログラムメモリ2に予め記憶されている。
動作時にはプログラムメモリ2からデータを読み出し、
必要な処理を施し、サーボ制御回路5へ指令値として出
力する。そのためのプログラムもプログラムメモリ2に
予め記憶されている。メモリ2も3も一種の記憶手段で
あって、プログラムとデータのための記憶エリアが異な
るさいう以上には区別しがたい。
必要な処理を施し、サーボ制御回路5へ指令値として出
力する。そのためのプログラムもプログラムメモリ2に
予め記憶されている。メモリ2も3も一種の記憶手段で
あって、プログラムとデータのための記憶エリアが異な
るさいう以上には区別しがたい。
データメモリ3の中には各教示点の位置をあられすデー
タが記憶されている。各教示点を一連の動作経路として
とらえると、ある教示点は次の教示点に対する始点とな
り、次の教示点は終点となる。関節形ロボットの作用点
は動作時lこ始点から終点に向って移動することになる
が、その際の始速度、最大速度、終速度もデータメモリ
3に記憶される。始速度は始点の速度、終速度は終点の
速度と考えてよい。最大速度はその間の上限値であり、
目標値であって、始点と、終点との間の距離が長いとき
lこは、その間のほとんどの区間は指定された最大速度
で移動する。
タが記憶されている。各教示点を一連の動作経路として
とらえると、ある教示点は次の教示点に対する始点とな
り、次の教示点は終点となる。関節形ロボットの作用点
は動作時lこ始点から終点に向って移動することになる
が、その際の始速度、最大速度、終速度もデータメモリ
3に記憶される。始速度は始点の速度、終速度は終点の
速度と考えてよい。最大速度はその間の上限値であり、
目標値であって、始点と、終点との間の距離が長いとき
lこは、その間のほとんどの区間は指定された最大速度
で移動する。
プログラムメモリ2にはユーザープログラムとこのプロ
グラムを中央処理装置1で処理するための制御プログラ
ムが記憶されている。本発明における補間点演算のため
のプログラムは一種のユーザープログラムであって、こ
の点については後に改めて説明する。サーボ制御回路5
とアクチュエータ6とフィードバック回路7は第1図中
に一組しか図示していないが、この組の数は関節形ロボ
ットの各可動部を動力1すための軸の数と一致する。
グラムを中央処理装置1で処理するための制御プログラ
ムが記憶されている。本発明における補間点演算のため
のプログラムは一種のユーザープログラムであって、こ
の点については後に改めて説明する。サーボ制御回路5
とアクチュエータ6とフィードバック回路7は第1図中
に一組しか図示していないが、この組の数は関節形ロボ
ットの各可動部を動力1すための軸の数と一致する。
第2図は一例として5自由度の関節形ロボットを略示し
たものであって、各軸Q、 Q、 Q、 Q、 Q。
たものであって、各軸Q、 Q、 Q、 Q、 Q。
はすべて回転軸である。PIFIF、F4F、はそれぞ
れ各軸Q、〜Q、によって可動される可動部である。最
先端の可動部Q、の先に作用点Pが設定されている。関
節形ロボットはこの作用点Pを目標として制御される。
れ各軸Q、〜Q、によって可動される可動部である。最
先端の可動部Q、の先に作用点Pが設定されている。関
節形ロボットはこの作用点Pを目標として制御される。
第3図はその様子を2自由度のもので、XYの直角座標
によってあられしたものである。作用点Pは始点Ps力
1ら終点Pgへ移動し、その間にWのような移動軌跡が
生ずる。移動軌跡Wは直線、円弧、その他の関数補間に
よるものである。移動軌跡Wは始点psを出発する時間
TをOとすれば、この時間′Pの経過によって表示する
ことも可能である。
によってあられしたものである。作用点Pは始点Ps力
1ら終点Pgへ移動し、その間にWのような移動軌跡が
生ずる。移動軌跡Wは直線、円弧、その他の関数補間に
よるものである。移動軌跡Wは始点psを出発する時間
TをOとすれば、この時間′Pの経過によって表示する
ことも可能である。
第4図は始点psを出発する時間TをOとし、終点Pg
に到達する時間Tを’I’d −1−2Tpとして、時
間Tによって測った移動軌跡Wの長さをあられしたもの
であつり、縦軸方向に移動速度■、加速度A1加加速度
Bあるいは−Bが表示されている。
に到達する時間Tを’I’d −1−2Tpとして、時
間Tによって測った移動軌跡Wの長さをあられしたもの
であつり、縦軸方向に移動速度■、加速度A1加加速度
Bあるいは−Bが表示されている。
この固め1らもわかるように移動軌跡Wは基本的には5
つの区間に区分される。1すなわち、前記Bを所定値と
したときに、加加速度が十BとなるO〜Tp区間、−B
となるTp〜2Tp区間、零となる2TI)−Td区間
、−BとなるTd−Td+昨区間、十BとなるTd+T
i)〜Td−1−2′l11)区間の5つである。
つの区間に区分される。1すなわち、前記Bを所定値と
したときに、加加速度が十BとなるO〜Tp区間、−B
となるTp〜2Tp区間、零となる2TI)−Td区間
、−BとなるTd−Td+昨区間、十BとなるTd+T
i)〜Td−1−2′l11)区間の5つである。
第4図の区間は例示的であって始速度、終速度がともに
零でなければまた異なったものとなる。しかし、加加速
度は十B、 −B、零のいずれかである。
零でなければまた異なったものとなる。しかし、加加速
度は十B、 −B、零のいずれかである。
以上のように、各区間はTp、 Td、 T’pの関数
となり、これらの変数Tp、 Td、 Thは第5図の
フローチャートでめることができる。これは補間点演算
中の移動軌跡りを区分するための第一演算に該当する。
となり、これらの変数Tp、 Td、 Thは第5図の
フローチャートでめることができる。これは補間点演算
中の移動軌跡りを区分するための第一演算に該当する。
この第一演算は与えられた始点PsPgを補間しようと
するときに一度だけ行いはよい。第5図のLrは第4図
の緩加減速区間(O〜2Tp、 Td〜2Th)の実際
の長さを示しているが、これが始点Ps終点Pg間の移
動軌跡の長さLを越え定速区間(2Tp−Td)の長さ
L−Lrが負となるときには、この区間(2Tp −T
d )の長さL−Lrを零となるように目標速度VSを
V S/に修正し、再演算する。この修正は目標速度V
sを微小増分VSOだけ修正し、繰返えし演算によって
めてもよい。
するときに一度だけ行いはよい。第5図のLrは第4図
の緩加減速区間(O〜2Tp、 Td〜2Th)の実際
の長さを示しているが、これが始点Ps終点Pg間の移
動軌跡の長さLを越え定速区間(2Tp−Td)の長さ
L−Lrが負となるときには、この区間(2Tp −T
d )の長さL−Lrを零となるように目標速度VSを
V S/に修正し、再演算する。この修正は目標速度V
sを微小増分VSOだけ修正し、繰返えし演算によって
めてもよい。
第6図は始速度■0、終速度Vooをともに零とした緩
加減速のパターンを示したものである。このときの’r
pはVs/Bの平方根となり、TdはL/Vsとなる。
加減速のパターンを示したものである。このときの’r
pはVs/Bの平方根となり、TdはL/Vsとなる。
また、緩加減速区間(0〜2Tp、 Td −Td+2
Tp )の実際の長さLrは2TpVsとなる。これが
Lを越えるときには第7図に、示すようにVsをV/S
に修正し、TpをTppに修正する。この場合のTdは
2Tppとなる。第8図は始速度■0−0、終速度Vo
o=−Vs とした緩加速のパターンを示したものであ
り、LrがLを越えるときには第9図のように修正され
る。第10図は始速度Vo = Vs 1終速度Voo
−0とした緩減速のパターンのものでありLr>Lの
ときには第11図のように修正される。
Tp )の実際の長さLrは2TpVsとなる。これが
Lを越えるときには第7図に、示すようにVsをV/S
に修正し、TpをTppに修正する。この場合のTdは
2Tppとなる。第8図は始速度■0−0、終速度Vo
o=−Vs とした緩加速のパターンを示したものであ
り、LrがLを越えるときには第9図のように修正され
る。第10図は始速度Vo = Vs 1終速度Voo
−0とした緩減速のパターンのものでありLr>Lの
ときには第11図のように修正される。
第12図は以上の各区間におけるサンプリング間隔xT
ごとの速度データを演算する第二演算手段のフローチャ
ートを示したもので、各区間に応じた速度の増分△Vi
がめられ、さらにサンプリング間隔dごとの速度■iが
められる。lは1.2.3.4・・・と増加し、始点P
s終点Pg間の補間点の数だけ繰返えされる。この第1
2図の例は第6図の緩加減速パターンについて例示した
ものであって、第6図の時間TがTiのときの速度Vi
がめられ、第12図のボックス100における補間点の
位置データの演算に利用される。
ごとの速度データを演算する第二演算手段のフローチャ
ートを示したもので、各区間に応じた速度の増分△Vi
がめられ、さらにサンプリング間隔dごとの速度■iが
められる。lは1.2.3.4・・・と増加し、始点P
s終点Pg間の補間点の数だけ繰返えされる。この第1
2図の例は第6図の緩加減速パターンについて例示した
ものであって、第6図の時間TがTiのときの速度Vi
がめられ、第12図のボックス100における補間点の
位置データの演算に利用される。
第13図は補間点の位置データを演算する第三演算手段
のフローチャートを示したもので、第14図第15図を
参照すれば明らかなように、兄■Ziは補間点Piの直
交座標を示している。Xs Ysムは始点psの直交座
標であり、Lx Lg Lzはそ随 れぞれ始点Ps終
点Pg間のx、 y、 z座標の距離でありl、;p
+L、l + Lz′1の平方根はその間の実際の距離
りとなる。この第13〜15図も直線補間のケースにつ 第13図に示すような補間点Pi (Xi Yi Zi
)の計算が終了すると第16図に示すように、補間点
Piの直交座標データが関節形ロボット各軸の関節座標
に変換され、各軸の位置データとして実際のi番目のサ
ンプリングタイムが到来したときに第1図5のサーボ制
御回路へ出力される。
のフローチャートを示したもので、第14図第15図を
参照すれば明らかなように、兄■Ziは補間点Piの直
交座標を示している。Xs Ysムは始点psの直交座
標であり、Lx Lg Lzはそ随 れぞれ始点Ps終
点Pg間のx、 y、 z座標の距離でありl、;p
+L、l + Lz′1の平方根はその間の実際の距離
りとなる。この第13〜15図も直線補間のケースにつ 第13図に示すような補間点Pi (Xi Yi Zi
)の計算が終了すると第16図に示すように、補間点
Piの直交座標データが関節形ロボット各軸の関節座標
に変換され、各軸の位置データとして実際のi番目のサ
ンプリングタイムが到来したときに第1図5のサーボ制
御回路へ出力される。
第17図はシュミレーションの事例を示したものでさっ
て、関節形ロボットの作用点Pに対して速度v1加速度
A、加加速度の定数をBとする制御を行った場合、その
関節形ロボットのひとつの軸および別の軸の速度、加速
度、加加速度はそれぞれV、 V、 、八人、BIへの
ようになる。これを本発明によらない第18図のシュミ
レーション事例と比較してみれば明らかなように各軸に
おける一ガa速度の変動が小さくなることがわかる。そ
れは各軸においても作用点Pのそれと近似した加加速度
制御が結果的に営まれるためである。もつとも、たとえ
ば第9図に示すような理想的な各軸における速度V、
V、の特性とはならないが、この第19図の場合はその
作用点Pの移動軌跡が第20図のように大きく不特定な
形に む結果となる。しかし、本発明においてはその移
動軌跡を保証しながら近似的な加加速度制御が実現され
る。
て、関節形ロボットの作用点Pに対して速度v1加速度
A、加加速度の定数をBとする制御を行った場合、その
関節形ロボットのひとつの軸および別の軸の速度、加速
度、加加速度はそれぞれV、 V、 、八人、BIへの
ようになる。これを本発明によらない第18図のシュミ
レーション事例と比較してみれば明らかなように各軸に
おける一ガa速度の変動が小さくなることがわかる。そ
れは各軸においても作用点Pのそれと近似した加加速度
制御が結果的に営まれるためである。もつとも、たとえ
ば第9図に示すような理想的な各軸における速度V、
V、の特性とはならないが、この第19図の場合はその
作用点Pの移動軌跡が第20図のように大きく不特定な
形に む結果となる。しかし、本発明においてはその移
動軌跡を保証しながら近似的な加加速度制御が実現され
る。
本発明によれば関節形ロボットの作用点の軌跡を ませ
ることなく、その各軸に対して近似的な訓諭速度一定制
御を行うことができる。このため、その機械系の振動あ
るいは負荷が低減する。
ることなく、その各軸に対して近似的な訓諭速度一定制
御を行うことができる。このため、その機械系の振動あ
るいは負荷が低減する。
第1図は本発明装置のブロック図、第2図は関節形ロボ
ットの説明図、第3図は関節形ロボットの作用点の移動
軌跡を示す説明図、第4図は原理説明図、第5図は第一
演算手段のフローチャート、第6図は緩加減速パターン
を示す速度等の変化図、第7図はその修正後の変化図、
第8図は緩加速パターンを示す速度等の変化図、第9図
はその修正後の変化図、第10図は緩減速パターンを示
す速度等の変化図、第11図はその修正後の変化図、第
12図は第二演算手段のフローチャート、第13図は第
三演算手段のフローチャアト、第14図は増分ハLiの
説明図、第15図は補間点の説明図、第16図は位置デ
ータの出力を示すフローチャート、第17図は本発明に
よる各軸の変化図、第18である。図中の1は中央処理
装置、2はプログラムメモリ、3はデータメモリ、5は
サーボ制御回路を示す。 V 早 812] 不10 [21 第u 図 ゛ 第 ノ3 図 界!4 図 阜 1.s 図 、第 76 [21、第 )9 図 $rt8I21 阜 、7C21
ットの説明図、第3図は関節形ロボットの作用点の移動
軌跡を示す説明図、第4図は原理説明図、第5図は第一
演算手段のフローチャート、第6図は緩加減速パターン
を示す速度等の変化図、第7図はその修正後の変化図、
第8図は緩加速パターンを示す速度等の変化図、第9図
はその修正後の変化図、第10図は緩減速パターンを示
す速度等の変化図、第11図はその修正後の変化図、第
12図は第二演算手段のフローチャート、第13図は第
三演算手段のフローチャアト、第14図は増分ハLiの
説明図、第15図は補間点の説明図、第16図は位置デ
ータの出力を示すフローチャート、第17図は本発明に
よる各軸の変化図、第18である。図中の1は中央処理
装置、2はプログラムメモリ、3はデータメモリ、5は
サーボ制御回路を示す。 V 早 812] 不10 [21 第u 図 ゛ 第 ノ3 図 界!4 図 阜 1.s 図 、第 76 [21、第 )9 図 $rt8I21 阜 、7C21
Claims (1)
- 【特許請求の範囲】 1、始点と終点の各位置をあられすデータおよびその間
を移動するときの始速度、最大速度、終速度をあられす
データを記憶する手段と、始点と終点間の移線跡に沿っ
た各補間点の位置データを演算する補間点演算手段と、
各補間点の位置データを関節形ロボットの各軸データに
変換する手段と、各軸データをサンプリングタイムごと
に各軸のサーボ制御回路に指令値として与える手段とを
備え、また上記補間点演算手段は前記始速度、最大速度
、終速度の各データから前記移動軌跡を、所定値Bであ
られされる訓諭速度Bの区間、訓諭速度−Bの区間、最
大速度による定速区間、訓諭速度−Bの区間、訓諭速度
Bの区間に、この区間の順序で区分するデータを演算す
る第一演算手段と、上記各区間におけるサンプリング間
隔ごとの速度データを演算する第二演算手段と、第二演
算手段による速度データにもとずき各サンプリングタイ
ムごとの各補間点の位置データを演算する第三演算手段
とを備えたことを特徴とする関節形ロボット用制御装置
。 2、始速度を零とし、速入速度および終速度を予め定め
た同一の値とした緩加速パターンの速度情報を含むデー
タを記憶する特許請求の範囲第1項記載の記憶手段を備
えた同項記載の関節形ロボット用制御装置。 3、始速度および最大速度を予め定めた同一の値とし、
終速度を零とする緩減速パターンの速度情報を含むデー
タを記憶する特許請求の範囲第1項記載の記憶手段を備
えた同項記載の関節形ロボット用制御装置。 4、始動度および終速度を零とし、最大速度を予め定め
た値とする緩加減速パターンの速度情報を含むデータを
記憶する特許請求の範囲第1項記載の記憶手段を備えた
同項記載の関節形ロボット用制御装置。 5、移動軌跡を特徴とする特許請求の範囲第1項記載の
補間点演算手段を備えた同項記載の関節形ロボット用制
御装置。 6、移動軌跡を区分するためのものであって、始点から
終点へ移動するための時間であられされたデータを演算
する特許請求の範囲第1項記載の第一演算手段を備えた
同項記載の関節形ロボット用制御装置。 7゜始点以後の訓諭速度Bおよび−Bの区間と、終点以
前の訓諭速度−BおよびBの区間を優先させ、始点終点
間ζこおけるその残りの区間を定速区間とする特許請求
の範囲第1項記載の第一演算手段を備えた同項記の関節
形ロボット用制御装置。 8、定速区間の長さを示す演算値が負となるときに、定
速区間の長さを零とする特許請求の範囲第1項記載の第
一演算手段を備えた同項記載の関節形ロボット用制御装
置。 9、始点以後における訓諭速度Bと−Bの各区間の長さ
を同一とし、終点以前における訓諭速度−BとBの各区
間の長さを特徴とする特許請求の範囲第1項記載の第一
演算手段を備えた同項記載の関節形ロボット用制御装置
。 10、サンプリングタイムごとの速度データを特徴とす
る特許請求の範囲第1項記載の第二演算手段を備えた同
項記載の関節形ロボット用制御装置。 11、サンプリング間隔ごとの速度データを、それぞれ
前回の値に今回の増分を加算してめる特許請求の範囲第
1項記載の第二演算手段を備えた同項記載の関節形ロボ
ット用制御装置。 ソ、各サンプリングタイムごとの速度データにサンプリ
ング間隔時間を乗じた値を各サンプリングタイムごとに
累算し、補間点の位置データとする特許請求の範囲第1
項記載の第三演算手段を備えた同項記載の関節形ロボッ
ト用制御装置。 13、各補間点において、各座標成分に応じた位置デー
タを演算する特許請求の範囲第1項記載の第三演算手段
を備えた同項記載の関節形ロボット用制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7645284A JPS60220408A (ja) | 1984-04-18 | 1984-04-18 | 関節形ロボツト用制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7645284A JPS60220408A (ja) | 1984-04-18 | 1984-04-18 | 関節形ロボツト用制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS60220408A true JPS60220408A (ja) | 1985-11-05 |
Family
ID=13605537
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP7645284A Pending JPS60220408A (ja) | 1984-04-18 | 1984-04-18 | 関節形ロボツト用制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS60220408A (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0199103A (ja) * | 1987-10-13 | 1989-04-18 | Yamatake Honeywell Co Ltd | ロボット制御装置 |
WO1993022107A1 (en) * | 1992-04-23 | 1993-11-11 | Kabushiki Kaisha Komatsu Seisakusho | Method of controlling industrial robot |
JP2017035782A (ja) * | 1999-05-28 | 2017-02-16 | ブルックス オートメーション インコーポレイテッド | 時間最適アーム動作を生成する装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5769314A (en) * | 1980-10-13 | 1982-04-28 | Fanuc Ltd | Numerical control system |
JPS5917608A (ja) * | 1982-07-20 | 1984-01-28 | Shin Meiwa Ind Co Ltd | 産業用ロボツトの位置制御装置 |
JPS5945515A (ja) * | 1982-09-09 | 1984-03-14 | Hitachi Ltd | モ−トルの位置制御方法 |
-
1984
- 1984-04-18 JP JP7645284A patent/JPS60220408A/ja active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5769314A (en) * | 1980-10-13 | 1982-04-28 | Fanuc Ltd | Numerical control system |
JPS5917608A (ja) * | 1982-07-20 | 1984-01-28 | Shin Meiwa Ind Co Ltd | 産業用ロボツトの位置制御装置 |
JPS5945515A (ja) * | 1982-09-09 | 1984-03-14 | Hitachi Ltd | モ−トルの位置制御方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0199103A (ja) * | 1987-10-13 | 1989-04-18 | Yamatake Honeywell Co Ltd | ロボット制御装置 |
WO1993022107A1 (en) * | 1992-04-23 | 1993-11-11 | Kabushiki Kaisha Komatsu Seisakusho | Method of controlling industrial robot |
JP2017035782A (ja) * | 1999-05-28 | 2017-02-16 | ブルックス オートメーション インコーポレイテッド | 時間最適アーム動作を生成する装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0086950B1 (en) | Method of controlling an industrial robot | |
Miller | Sensor-based control of robotic manipulators using a general learning algorithm | |
US4529921A (en) | Tracking control system of multijoint robot | |
EP0130570A2 (en) | Method and apparatus for controlling a robot hand along a predetermined path | |
JPS591180A (ja) | 制御された経路の運動を行なうマニピユレ−タ | |
US4972131A (en) | Method of an apparatus for controlling velocity of industrial robot | |
EP0619536B1 (en) | Method and apparatus for a numerically controlled industrial machine | |
US20180361591A1 (en) | Robot system that displays speed | |
JPH01164280A (ja) | 加減速制御方式 | |
JPH0916241A (ja) | ロボットの加減速動作の設定方法 | |
US4914363A (en) | Method for controlling the motion of a machine element | |
JPS60220408A (ja) | 関節形ロボツト用制御装置 | |
CN107645979A (zh) | 用于使机器人手臂的运动同步的机器人*** | |
JPH01121909A (ja) | 直交座標型ロボットにおける動作速度制御方法 | |
JPH06105412B2 (ja) | 関節形ロボツトの動作制御方法 | |
JPH0695294B2 (ja) | 産業用ロボットの軌跡補間方法 | |
JPH0375888B2 (ja) | ||
JPH0623928B2 (ja) | ロボツトハンドの軌道修正方法 | |
JPH02144705A (ja) | ロボットアームの制御方法 | |
JPS60138611A (ja) | ア−ムロボツトの制御装置 | |
JPS59229614A (ja) | ロボツト制御装置 | |
JP2601433B2 (ja) | 工業用ロボットの補間制御方法および装置 | |
KR0154433B1 (ko) | 로보트의 원호보간방법 | |
JP3457693B2 (ja) | ロボットの軌跡制御方法 | |
JPH01316185A (ja) | 産業用ロボットの経路生成方法 |