JPS62251810A - ロボツトア−ムの加減速制御装置 - Google Patents
ロボツトア−ムの加減速制御装置Info
- Publication number
- JPS62251810A JPS62251810A JP9527786A JP9527786A JPS62251810A JP S62251810 A JPS62251810 A JP S62251810A JP 9527786 A JP9527786 A JP 9527786A JP 9527786 A JP9527786 A JP 9527786A JP S62251810 A JPS62251810 A JP S62251810A
- Authority
- JP
- Japan
- Prior art keywords
- acceleration
- arm
- driving
- deceleration
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 46
- 230000036544 posture Effects 0.000 abstract 4
- 239000003638 chemical reducing agent Substances 0.000 description 6
- 238000001514 detection method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000052 comparative effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
Landscapes
- Numerical Control (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
「産業上の利用分野」
本発明はロボットアームの加減速制御装置に洪する。
「従来の技術」
従来のロボットアームの加減速制御装置では。
特願昭５Ｂ−１６３５７６号明＃書の「ロボットコント
ローラ」１こ示されるように、アームの加減速曲線は記
憶装置に記憶された複数個の加減速曲線のうちから一つ
が選択されて使用されていた。
ローラ」１こ示されるように、アームの加減速曲線は記
憶装置に記憶された複数個の加減速曲線のうちから一つ
が選択されて使用されていた。
［発明が解決しようとする問題点］
しかし、従来の加減速ｔｆＪ制御装置では、使用される
加減速曲線が有限個に限られておりその制御に際して最
適な加減速曲線は得られなかった。最適な制御に近づけ
るため記憶装置に多くの加ｉ／ｊ！速曲線を記憶させる
と容置の大きな記憶装置が必要となるという問題点があ
った。そこで本発明はこのような問題点を解決するもの
で、その目的とするところは、大きな記憶容量がなくと
も最適な加減速曲線をただひとつ短時間に得ることにあ
る。
加減速曲線が有限個に限られておりその制御に際して最
適な加減速曲線は得られなかった。最適な制御に近づけ
るため記憶装置に多くの加ｉ／ｊ！速曲線を記憶させる
と容置の大きな記憶装置が必要となるという問題点があ
った。そこで本発明はこのような問題点を解決するもの
で、その目的とするところは、大きな記憶容量がなくと
も最適な加減速曲線をただひとつ短時間に得ることにあ
る。
［問題点を解決するための手段］
本発明のロボットアームの加減速制御装置は水平に複数
の関節を備えたロボットの制御装置において、駆！ＩＩ
前のアームの姿勢を検出する手段および駆動後の予定ア
ーム姿勢を算出する手段と、前記検出結果と算出結果に
基づいて各軸の駆動パルスの比とアームの姿勢から各軸
の加減速を決定するひとつの数値を生成する手段と４そ
の数値から各軸の加減速曲線を生成する手段を有し、そ
の加減速曲線に沿ってアームを駆動することを特徴とす
る。
の関節を備えたロボットの制御装置において、駆！ＩＩ
前のアームの姿勢を検出する手段および駆動後の予定ア
ーム姿勢を算出する手段と、前記検出結果と算出結果に
基づいて各軸の駆動パルスの比とアームの姿勢から各軸
の加減速を決定するひとつの数値を生成する手段と４そ
の数値から各軸の加減速曲線を生成する手段を有し、そ
の加減速曲線に沿ってアームを駆動することを特徴とす
る。
［作 川」
本発明の上記構成によれば１回時に駆動される複数の駆
動軸のうちアームの負荷変動の影響を受ける駆動軸の許
容最大角加速度を負荷に応じて求めそれと他方のＦＦ許
容最大角加速度比と、各軸の移動パルス数の比からただ
ひとつの加減速曲線を決定する。
動軸のうちアームの負荷変動の影響を受ける駆動軸の許
容最大角加速度を負荷に応じて求めそれと他方のＦＦ許
容最大角加速度比と、各軸の移動パルス数の比からただ
ひとつの加減速曲線を決定する。
従って１本発明によれば、ロボットアームの駆動前の姿
勢と駆動後の予定姿勢に応じて最適な加′ｇ速制御を行
なうことがで９６゜ ［実施例］ 第１図は本発明になるロボットアームの加減速ルＪ御装
置の対象となる水平に２輌の関節を備えたロボットであ
る。１０１はロボットの基部を示し、１０２は１０１に
固定されて第１アームを駆動するためのモータおよび減
速機であり、１０３は１０２によって駆動される第１ア
ームである。１０４はＮＳｌアームあるいは１０１に示
される基部に固定され第２アームを駆動するモータおよ
び減速機であり、１０５は１０４によって駆動される第
２のアームである。＄２図はＷＳ１図に示されるロボッ
トが駆動された時の駆動前と愚答後の状態を示す図であ
る。ｔｓ２図の矢印のようにアームが動く時、駆動前と
駆動後の第１のアームと第２のアームの相対的な位置の
変化により本実施例では第１関韮のみがアームの負荷変
動の影響を受けることになる。 第３図に本発明になる
ロボットアームの加減速制御装置のｆ！ｆ４１図に示す
ロボットに対するブロック図を示す、以下、詳細はこの
ブロック図に沿って進める。駆動指令３０１は使用者が
ロボットに対して与えるものであり、この指令に基づい
て現在のアーム姿勢と駆動後の予定アーム姿勢が各関節
にとりつけられたモータの回転角度により決定される（
図中３０２，３０３）、各関節にとりつけられたモータ
および減速機は許容されるｌ・ルクが決まっているため
負荷変動の影響のない第２関節については許容最大角加
速度は一意に決るが負荷変動の影響を受ける第１関節に
ついては前期各姿勢に地色て許容最大角加速度を算出す
る（図中３０４）、さらに図中３０５では前記検出結果
に基づいて各関節の駆動パルスの比を計算する０図中３
０６では、３０４にて計算された第１関節の最大角加速
度と、第２関節の最大角加速度を比較して加減速曲線を
生成するのに主となる軸を決定し、３０７では３０６に
て決定された主となる軸に対してその最大角加速度より
主となる軸に関する加減速曲線を生成する。他力の加減
速曲線は３０５で計算された１１Ａ動パルスの比を３０
７の出力に掛けることによって生成される。
勢と駆動後の予定姿勢に応じて最適な加′ｇ速制御を行
なうことがで９６゜ ［実施例］ 第１図は本発明になるロボットアームの加減速ルＪ御装
置の対象となる水平に２輌の関節を備えたロボットであ
る。１０１はロボットの基部を示し、１０２は１０１に
固定されて第１アームを駆動するためのモータおよび減
速機であり、１０３は１０２によって駆動される第１ア
ームである。１０４はＮＳｌアームあるいは１０１に示
される基部に固定され第２アームを駆動するモータおよ
び減速機であり、１０５は１０４によって駆動される第
２のアームである。＄２図はＷＳ１図に示されるロボッ
トが駆動された時の駆動前と愚答後の状態を示す図であ
る。ｔｓ２図の矢印のようにアームが動く時、駆動前と
駆動後の第１のアームと第２のアームの相対的な位置の
変化により本実施例では第１関韮のみがアームの負荷変
動の影響を受けることになる。 第３図に本発明になる
ロボットアームの加減速制御装置のｆ！ｆ４１図に示す
ロボットに対するブロック図を示す、以下、詳細はこの
ブロック図に沿って進める。駆動指令３０１は使用者が
ロボットに対して与えるものであり、この指令に基づい
て現在のアーム姿勢と駆動後の予定アーム姿勢が各関節
にとりつけられたモータの回転角度により決定される（
図中３０２，３０３）、各関節にとりつけられたモータ
および減速機は許容されるｌ・ルクが決まっているため
負荷変動の影響のない第２関節については許容最大角加
速度は一意に決るが負荷変動の影響を受ける第１関節に
ついては前期各姿勢に地色て許容最大角加速度を算出す
る（図中３０４）、さらに図中３０５では前記検出結果
に基づいて各関節の駆動パルスの比を計算する０図中３
０６では、３０４にて計算された第１関節の最大角加速
度と、第２関節の最大角加速度を比較して加減速曲線を
生成するのに主となる軸を決定し、３０７では３０６に
て決定された主となる軸に対してその最大角加速度より
主となる軸に関する加減速曲線を生成する。他力の加減
速曲線は３０５で計算された１１Ａ動パルスの比を３０
７の出力に掛けることによって生成される。
Ｌ発明の効果」
以上述べたように本発明によれば、ロボットの負荷変動
の影響を受ける軸の最大角加速度を駆動ｆｌｔｌ後のア
ームの姿勢を求めることにより得て、それらの比から主
たる軸を定め、その主たる軸の加減速曲線を生成し前記
検出結果の比によりすべての軸の加減速曲線を、短時間
で容量の大きな記憶装置を必要とせず生成することがｏ
ｆ能である。
の影響を受ける軸の最大角加速度を駆動ｆｌｔｌ後のア
ームの姿勢を求めることにより得て、それらの比から主
たる軸を定め、その主たる軸の加減速曲線を生成し前記
検出結果の比によりすべての軸の加減速曲線を、短時間
で容量の大きな記憶装置を必要とせず生成することがｏ
ｆ能である。
第１図は本発明の対象となるロボットの側面図、ｊＢ２
図は第１図のロボットの駆動前と駆動後のアームの姿勢
を示す平面図、第３図は本発明になるロボットアームの
加減速制御装置のブロック図である。 １０１・・・・・・ロボット基部 １０２・・・・・・モータおよび減速機１０３・・・・
・・第１アーム １０４・・・・・・モータおよび減速機１０５・・・・
・・第２アーム ２０３・・・・・・駆動後の予定ｆ５１アーム位置２０
４・・・・・・駆！ｊｌｖｋの予定モータおよび減速機
位置 ２０５・・・・・・駆！ＩＪ後の予定第２アーム位置３
０１・・・・・・駆動指令 ３０２・・・・・・現在のアーム姿勢検出手段３０３・
・・・・・駆動後の予定アーム姿勢算出手段 ３０４・・・・・・許容最大角加速度計算手段３０５・
・・・・・駆動パルスの比計算手段３０６・・・・・・
比較判断手段 ３０７・・・・・・加減速曲線生成手段具 上 葵１（２１ 箕２田
図は第１図のロボットの駆動前と駆動後のアームの姿勢
を示す平面図、第３図は本発明になるロボットアームの
加減速制御装置のブロック図である。 １０１・・・・・・ロボット基部 １０２・・・・・・モータおよび減速機１０３・・・・
・・第１アーム １０４・・・・・・モータおよび減速機１０５・・・・
・・第２アーム ２０３・・・・・・駆動後の予定ｆ５１アーム位置２０
４・・・・・・駆！ｊｌｖｋの予定モータおよび減速機
位置 ２０５・・・・・・駆！ＩＪ後の予定第２アーム位置３
０１・・・・・・駆動指令 ３０２・・・・・・現在のアーム姿勢検出手段３０３・
・・・・・駆動後の予定アーム姿勢算出手段 ３０４・・・・・・許容最大角加速度計算手段３０５・
・・・・・駆動パルスの比計算手段３０６・・・・・・
比較判断手段 ３０７・・・・・・加減速曲線生成手段具 上 葵１（２１ 箕２田
Claims (1)
- （１）水平に複数の関節を備えたロボットの制御装置に
おいて、駆動前のアームの姿勢を検出する手段および駆
動後の予定アーム姿勢を算出する手段と、前記検出結果
と算出結果に基づいて各軸の駆動パルス数の比を計算す
る手段とアームの負荷変動の影響を受ける軸の許容最大
角加速度を算出、比較判断する手段と、各軸の加減速曲
線を生成する手段とを有し、その加減速曲線に沿ってア
ームを駆動することを特徴とするロボットアームの加減
速制御装置
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP9527786A JPS62251810A (ja) | 1986-04-24 | 1986-04-24 | ロボツトア−ムの加減速制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP9527786A JPS62251810A (ja) | 1986-04-24 | 1986-04-24 | ロボツトア−ムの加減速制御装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPS62251810A true JPS62251810A (ja) | 1987-11-02 |
Family
ID=14133277
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP9527786A Pending JPS62251810A (ja) | 1986-04-24 | 1986-04-24 | ロボツトア−ムの加減速制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS62251810A (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01156804A (ja) * | 1987-12-14 | 1989-06-20 | Fanuc Ltd | 産業用関接型ロボットにおける教示・再生方法 |
| WO1992021074A1 (en) * | 1991-05-10 | 1992-11-26 | Fanuc Ltd | Acceleration/deceleration time constant control system for servo motor |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6057407A (ja) * | 1983-09-06 | 1985-04-03 | Seiko Epson Corp | ロボツトコントロ−ラ |
| JPS60230206A (ja) * | 1984-04-27 | 1985-11-15 | Matsushita Electric Ind Co Ltd | 角加速度制御方法 |
-
1986
- 1986-04-24 JP JP9527786A patent/JPS62251810A/ja active Pending
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6057407A (ja) * | 1983-09-06 | 1985-04-03 | Seiko Epson Corp | ロボツトコントロ−ラ |
| JPS60230206A (ja) * | 1984-04-27 | 1985-11-15 | Matsushita Electric Ind Co Ltd | 角加速度制御方法 |
| JPS60233715A (ja) * | 1984-04-27 | 1985-11-20 | Matsushita Electric Ind Co Ltd | 角加速度制御方法 |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01156804A (ja) * | 1987-12-14 | 1989-06-20 | Fanuc Ltd | 産業用関接型ロボットにおける教示・再生方法 |
| WO1992021074A1 (en) * | 1991-05-10 | 1992-11-26 | Fanuc Ltd | Acceleration/deceleration time constant control system for servo motor |
| US5371452A (en) * | 1991-05-10 | 1994-12-06 | Fanuc Ltd. | Adjustable time constant control and method system for a servomotor |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6204619B1 (en) | Dynamic control algorithm and program for power-assisted lift device | |
| WO2003086718A1 (fr) | Robot | |
| JPS60233715A (ja) | 角加速度制御方法 | |
| JP3766484B2 (ja) | 多関節ロボットの負荷重量及び負荷重心位置の自動算出方法 | |
| JPH04306711A (ja) | 加減速パターン生成装置及びパターン生成方法 | |
| JPH03130808A (ja) | ロボットの制御方法およびその制御装置 | |
| JP4016305B2 (ja) | ロボットの制御装置 | |
| JPS62251810A (ja) | ロボツトア−ムの加減速制御装置 | |
| JPH071463B2 (ja) | ロボツト制御装置 | |
| JPH04324507A (ja) | 駆動装置の加減速制御方法及びロボットシステム | |
| JPH0392911A (ja) | スライディングモード制御によるロボット制御方法 | |
| JP2778458B2 (ja) | 走行ロボット | |
| JPS61208514A (ja) | マニピユレ−タの制御方法 | |
| JPH1153021A (ja) | 産業用ロボットの加減速パターン生成方法 | |
| JPS6231406A (ja) | 多関節ロボツトの位置決め制御装置 | |
| JPS61114317A (ja) | 産業用ロボツトの教示方法 | |
| JPH0639066B2 (ja) | 産業用ロボツトの制御方法 | |
| JP2650889B2 (ja) | 関節形ロボットの教示方法 | |
| JPH03234490A (ja) | ロボットの制御方法 | |
| JPH0255803B2 (ja) | ||
| JPS6380303A (ja) | 産業用ロボツトの速度制御方法 | |
| JP2549192Y2 (ja) | ロボット制御装置 | |
| KR100198148B1 (ko) | 다축 수직 다관절 로보트의 관성 제어 방법 | |
| JPH05250029A (ja) | 産業用ロボット | |
| JPH11184512A (ja) | ロボットの制御ゲイン決定方法 |