JPH0436812A - ロボットの制御装置 - Google Patents
ロボットの制御装置Info
- Publication number
- JPH0436812A JPH0436812A JP14133390A JP14133390A JPH0436812A JP H0436812 A JPH0436812 A JP H0436812A JP 14133390 A JP14133390 A JP 14133390A JP 14133390 A JP14133390 A JP 14133390A JP H0436812 A JPH0436812 A JP H0436812A
- Authority
- JP
- Japan
- Prior art keywords
- arm
- speed
- amplifier
- robot
- motor
- 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
- 230000004044 response Effects 0.000 claims abstract description 16
- 230000003321 amplification Effects 0.000 claims abstract description 8
- 238000003199 nucleic acid amplification method Methods 0.000 claims abstract description 8
- 238000001514 detection method Methods 0.000 claims abstract description 5
- 230000036544 posture Effects 0.000 description 18
- 238000010586 diagram Methods 0.000 description 13
- 230000010355 oscillation Effects 0.000 description 8
- 239000003638 chemical reducing agent Substances 0.000 description 5
- 238000000034 method Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 2
- 210000000707 wrist Anatomy 0.000 description 2
- 241000555745 Sciuridae Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 239000003795 chemical substances by application Substances 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 125000001475 halogen functional group Chemical group 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔産業上の利用分野]
本発明は、ロボットの制御装置に関するものであり、更
に詳しくは、ロボッ)・のアームを回転駆動するモータ
、特に減速機を介さないで駆動するダイレクト・ドライ
ブ・モータの場合、該モータに対する速度フィートバン
ク系の周波数応答特性の改善を図ってアーム駆動の高速
応答を可能にするロボットの制御装置に関するものであ
る。
に詳しくは、ロボッ)・のアームを回転駆動するモータ
、特に減速機を介さないで駆動するダイレクト・ドライ
ブ・モータの場合、該モータに対する速度フィートバン
ク系の周波数応答特性の改善を図ってアーム駆動の高速
応答を可能にするロボットの制御装置に関するものであ
る。
〔従来の技術]
近年、組立ロボットは電気・電子関連の業界分野で電子
部品のハンドリング1基板への挿入・搭載のために超高
速化、高精度化のニーズが高い。
部品のハンドリング1基板への挿入・搭載のために超高
速化、高精度化のニーズが高い。
しかし、ヘル1へやハーモニックトライブなどの滅速機
とモータを組み合わせてアームを駆動する従来のロボッ
トではガタやハックラッシがあり精度と高速化の点で限
界があった。そこで、この問題を解決するために減速機
を介さずに直接アームを駆動可能な高トルク・高精度な
りD(ダイレクト・ドライブ)モータが使用されるよう
になってき/こ。
とモータを組み合わせてアームを駆動する従来のロボッ
トではガタやハックラッシがあり精度と高速化の点で限
界があった。そこで、この問題を解決するために減速機
を介さずに直接アームを駆動可能な高トルク・高精度な
りD(ダイレクト・ドライブ)モータが使用されるよう
になってき/こ。
しかしながら、DDモータは減速機がなく、機構部の振
動は、位置検出器で直接検出されるため、モータの速度
制御サーボ系の帯域を広げて応答特性を改善しようとし
て速度ループのゲインを上げていくと、機構系の持つ共
振周波数で発振を引き起ごしてしまう。このため、機械
共振系が存在すると速度ループゲインを大きくすること
ができない。従って位置帯域幅が小さくなり、ザーボ剛
性が低下し、ロボットの高速化、高精度化が図れないと
いう問題があった。また、この機械共振の周波数はロボ
ソl〜のアーム姿勢1負荷変動により変化するものであ
る。
動は、位置検出器で直接検出されるため、モータの速度
制御サーボ系の帯域を広げて応答特性を改善しようとし
て速度ループのゲインを上げていくと、機構系の持つ共
振周波数で発振を引き起ごしてしまう。このため、機械
共振系が存在すると速度ループゲインを大きくすること
ができない。従って位置帯域幅が小さくなり、ザーボ剛
性が低下し、ロボットの高速化、高精度化が図れないと
いう問題があった。また、この機械共振の周波数はロボ
ソl〜のアーム姿勢1負荷変動により変化するものであ
る。
上記の問題に対して従来は、共振周波数に共振と逆特性
のフィルタを設定して共振のピークを抑えてノυ振をな
くしていた。また、アーム姿勢、負荷変動によって共振
周波数が変化するのに合わせて、フィルタの特性を変化
させるものであった。
のフィルタを設定して共振のピークを抑えてノυ振をな
くしていた。また、アーム姿勢、負荷変動によって共振
周波数が変化するのに合わせて、フィルタの特性を変化
させるものであった。
前述のフィルタの使用例については、雑誌「省力と自動
化」の1989年2月号の特集rDDモータ技術とその
応用(その2)」の50ページに記載されている。
化」の1989年2月号の特集rDDモータ技術とその
応用(その2)」の50ページに記載されている。
〔発明が解決しようとする課題]
上記従来技術は、機構部の共振を抑制することは可能で
あるが、モータの速度ループゲインは一定としているた
め設定可能なゲインの値は、あらゆるアーム姿勢や負荷
条件に対しても発振をおこさない最も小さい値に制限さ
れてしまう。つまり、それぞれのアーム姿勢、負荷条件
において速度ループゲインが最適値となっていないため
、高速な運動特性(高速応答)をあらゆる動作条件で充
分発揮できないという問題があった。
あるが、モータの速度ループゲインは一定としているた
め設定可能なゲインの値は、あらゆるアーム姿勢や負荷
条件に対しても発振をおこさない最も小さい値に制限さ
れてしまう。つまり、それぞれのアーム姿勢、負荷条件
において速度ループゲインが最適値となっていないため
、高速な運動特性(高速応答)をあらゆる動作条件で充
分発揮できないという問題があった。
本発明は、アーム姿勢、負荷が変化する場合においても
、それに応した最適な速度ループゲインを得て、高速な
動作特性を得ることのできるロボットの制御装置を提供
することを目的とする。
、それに応した最適な速度ループゲインを得て、高速な
動作特性を得ることのできるロボットの制御装置を提供
することを目的とする。
上記目的を達成するために、本発明では、アームを駆動
するモータの速度指令を増幅する速度アンプ(モータの
速度制御ループに含まれる速度アンプ)の増幅率を、ア
ーム姿勢、負荷条件(特に荷重)に依存して最適な値に
なるよう可変として、常に最適な速度ループゲインを得
るようにしたものである。
するモータの速度指令を増幅する速度アンプ(モータの
速度制御ループに含まれる速度アンプ)の増幅率を、ア
ーム姿勢、負荷条件(特に荷重)に依存して最適な値に
なるよう可変として、常に最適な速度ループゲインを得
るようにしたものである。
〔作用]
以上のように構成した本発明のロボットの制御装置は、
アームの姿勢、負荷条件によって、アームを駆動するモ
ータの速度ループゲインを常に最適値になるように調整
できるので、サーボ周波数帯域幅を常に最大に取れ、そ
の結果、加減速の短い高速動作時の応答特性を向上させ
ることができる。
アームの姿勢、負荷条件によって、アームを駆動するモ
ータの速度ループゲインを常に最適値になるように調整
できるので、サーボ周波数帯域幅を常に最大に取れ、そ
の結果、加減速の短い高速動作時の応答特性を向上させ
ることができる。
以下、本発明の実施例を第1図より第6図を用いて説明
する。
する。
第2図は本発明の制御装置による制御対象としてのロボ
ットの主要構造図である。ロボットベース19上には第
1アーノ、モータ8により水平方向に回転される第1ア
ーム15が設けられ、第17−1.の先端には第2アー
ムモータ9により水平方向に回転される第27−1.1
6が設けられている。
ットの主要構造図である。ロボットベース19上には第
1アーノ、モータ8により水平方向に回転される第1ア
ーム15が設けられ、第17−1.の先端には第2アー
ムモータ9により水平方向に回転される第27−1.1
6が設けられている。
また、第2アーム16の先端には上・下方向に動作する
リスI・軸17に連結されたハフ1:1日が取付しJら
れ、第1アー1.15および第2アーム16によりハン
ド18を水平方向に移動させ、位置決めして作業を行な
うようになっている。
リスI・軸17に連結されたハフ1:1日が取付しJら
れ、第1アー1.15および第2アーム16によりハン
ド18を水平方向に移動させ、位置決めして作業を行な
うようになっている。
第3図は上記第2図のロボットを上面から見た場合の上
面モデル図である。ここで、角度θAθ6は第1アーl
、】5に対してなす第2アーム16の角度である。
面モデル図である。ここで、角度θAθ6は第1アーl
、】5に対してなす第2アーム16の角度である。
産業用ロボットにおいて、アームを駆動するモータのサ
ーボ系としては、速度制御系と位置制御系があるが、本
発明が関係するのは速度制御系の方である。
ーボ系としては、速度制御系と位置制御系があるが、本
発明が関係するのは速度制御系の方である。
そごで、第4図に、第2図における第1モータ8(或い
は第2モータ9)を制御する速度制御ループのブロック
線図を示した。
は第2モータ9)を制御する速度制御ループのブロック
線図を示した。
第4図において、4は速度アンプ(そのゲインEが速度
ループゲインとなる)、6ばモータドライバ、8はモー
タ(モータを伝達関数で表すと図示の如<KT/(JS
)となり、ここでI(□はトルク定数、Jはモータイナ
ーシャ、Sはラプラス演算子、である)、30はF/V
コンバータ(モータ8の回転速度を表すエンコーダ・パ
ルス周波数を入力され電圧に変換してフィードバックす
る)で、KF/VばF/Vコンバータ30のゲインであ
る。
ループゲインとなる)、6ばモータドライバ、8はモー
タ(モータを伝達関数で表すと図示の如<KT/(JS
)となり、ここでI(□はトルク定数、Jはモータイナ
ーシャ、Sはラプラス演算子、である)、30はF/V
コンバータ(モータ8の回転速度を表すエンコーダ・パ
ルス周波数を入力され電圧に変換してフィードバックす
る)で、KF/VばF/Vコンバータ30のゲインであ
る。
即ち、第4図の速度制御ループでは、モータ8の回転速
度をF/Vコンバータ30によりフィードバックして速
度指令との間で減算を行い、その減算により得られる誤
差信号が零になるように、該誤差信号を速度アンプ4で
増幅してモータドライハロに加えてフィードバック制御
を行い、モータ8の回転速度が速度指令に一致するよう
に制御しているわけである。
度をF/Vコンバータ30によりフィードバックして速
度指令との間で減算を行い、その減算により得られる誤
差信号が零になるように、該誤差信号を速度アンプ4で
増幅してモータドライハロに加えてフィードバック制御
を行い、モータ8の回転速度が速度指令に一致するよう
に制御しているわけである。
一般にサーボ制御系では、入力信号として正弦波交流を
加え、角周波数(ω)の変化に対する振幅比や位相の特
性を調べ、これにより系の特性を知る方法が周波数応答
と呼ばれて良く知られているが、第5図は、かかる意味
での一般のサーボ制御系の開ループ周波数応答特性のモ
デル図である。
加え、角周波数(ω)の変化に対する振幅比や位相の特
性を調べ、これにより系の特性を知る方法が周波数応答
と呼ばれて良く知られているが、第5図は、かかる意味
での一般のサーボ制御系の開ループ周波数応答特性のモ
デル図である。
以下、この特性モデル図について説明する。位相が−1
80°の時のゲインの絶対値をゲイン余裕といい、この
ゲイン余裕が0clBであると発振を起ごず。そのため
、一般のザーボ系では、12〜20dBのゲイン余裕を
とることが望ましいとされζいる。
80°の時のゲインの絶対値をゲイン余裕といい、この
ゲイン余裕が0clBであると発振を起ごず。そのため
、一般のザーボ系では、12〜20dBのゲイン余裕を
とることが望ましいとされζいる。
ここで、この周波数特性を持つ制御系において上げるこ
とが可能なループゲインの値は、ゲイン余裕を12dB
とるとすると、位相が一180°の時のゲインの絶対値
から12dBをひいた値となり、第5図中に示すadB
となる。
とが可能なループゲインの値は、ゲイン余裕を12dB
とるとすると、位相が一180°の時のゲインの絶対値
から12dBをひいた値となり、第5図中に示すadB
となる。
尚、ループゲインをadB以上にすると、上述に述べた
ように不安定となり発振を起こすことが合成に本発明の
制御対象であるロボットのアーム角度が第3図に見られ
る如く、θ8.θ6である場合の速度制御系の開ループ
周波数応答特性を第6図に示す。実線が角度θヶのとき
の特性であり、破線が角度θ8のときの特性である。
ように不安定となり発振を起こすことが合成に本発明の
制御対象であるロボットのアーム角度が第3図に見られ
る如く、θ8.θ6である場合の速度制御系の開ループ
周波数応答特性を第6図に示す。実線が角度θヶのとき
の特性であり、破線が角度θ8のときの特性である。
特性は第6図に見られるように、アームの姿勢でイナー
シャ等が変化するので一定とはならず、この図で、角度
θ4およびθおの時のゲイン余裕はそれぞれ図に示すC
A、C,となり、アーム角度により変化することが分か
るであろう。すなわち、アーム角度がθ8の時は角度θ
9の時と比較し、(GA −CB )dBだけ速度ルー
プゲインを」二げることか可能であることを示している
。
シャ等が変化するので一定とはならず、この図で、角度
θ4およびθおの時のゲイン余裕はそれぞれ図に示すC
A、C,となり、アーム角度により変化することが分か
るであろう。すなわち、アーム角度がθ8の時は角度θ
9の時と比較し、(GA −CB )dBだけ速度ルー
プゲインを」二げることか可能であることを示している
。
また、前記はアーム姿勢が変化した場合について述べた
が、同様に負荷条件(例えば荷重)によっても、上げる
ことが可能な速度ループゲインは変化する。
が、同様に負荷条件(例えば荷重)によっても、上げる
ことが可能な速度ループゲインは変化する。
以上述べたように、アーム姿勢および負荷条件により周
波数応答特性が変化するような場合、従来は、発振を防
くためにアーJ、姿勢と負荷条件の組み合わせで決まる
速度ループゲインの最小値を設定していたため、速度ル
ープゲインを」二げる余地がある場合でもその分を犠牲
にしていたので、高速動作特性を充分発揮できなかった
が、ロボットのアーム姿勢、負荷条件に合わせて、速度
ループケインを変化さゼ常に最適な設定にすることで、
常に最適な高速動作特性が得られる。これが本発明の原
理である。
波数応答特性が変化するような場合、従来は、発振を防
くためにアーJ、姿勢と負荷条件の組み合わせで決まる
速度ループゲインの最小値を設定していたため、速度ル
ープゲインを」二げる余地がある場合でもその分を犠牲
にしていたので、高速動作特性を充分発揮できなかった
が、ロボットのアーム姿勢、負荷条件に合わせて、速度
ループケインを変化さゼ常に最適な設定にすることで、
常に最適な高速動作特性が得られる。これが本発明の原
理である。
そこで、本発明では上記速度ループゲインを、アーJ、
姿勢、負荷条件に応じて制御回路により可変できるよ・
うにした。
姿勢、負荷条件に応じて制御回路により可変できるよ・
うにした。
第1図は、かかる本発明の一実施例を示すブロック図で
ある。具体的には同図は、速度ループゲイン可変部を含
むDDモータ制御部の構成図である。
ある。具体的には同図は、速度ループゲイン可変部を含
むDDモータ制御部の構成図である。
第1アームと第2アームの制御部は同一の構成となって
いるので第1図を用いて第1アー1、についてその構成
を説明する。ます、ロボット動作指令手段lより出力さ
れた指令は第1アーム位置制御手段2から速度指令とし
て出力される。この速度指令を第1アーム速度アンプ4
で所定の倍率に増幅し第1アームモータドライバ6に送
り第1アームモータ8を駆動する。10はエンコーダで
あり、モータ8の回転速度に比例した繰り返し周波数で
パルス列を出力する。また、前記ロボット動作指令手段
Jには、アーム姿勢および負荷条件により決定され、1
対1に対応する、最適な速度アンプ倍率データをあらか
じめ格納されている最適ゲイン記憶手段13が存在する
。12はゲイン指令手段である。
いるので第1図を用いて第1アー1、についてその構成
を説明する。ます、ロボット動作指令手段lより出力さ
れた指令は第1アーム位置制御手段2から速度指令とし
て出力される。この速度指令を第1アーム速度アンプ4
で所定の倍率に増幅し第1アームモータドライバ6に送
り第1アームモータ8を駆動する。10はエンコーダで
あり、モータ8の回転速度に比例した繰り返し周波数で
パルス列を出力する。また、前記ロボット動作指令手段
Jには、アーム姿勢および負荷条件により決定され、1
対1に対応する、最適な速度アンプ倍率データをあらか
じめ格納されている最適ゲイン記憶手段13が存在する
。12はゲイン指令手段である。
以上のように構成されるモータ制御システムの動作につ
いて以下説明する。ここでも第1アームについてのみ説
明する。
いて以下説明する。ここでも第1アームについてのみ説
明する。
まず外部や操作入力手段からロボットに起動がかげられ
るとロボット動作指令手段1より、あらかじめ決められ
た動作パターンの位置の指令が第1アー1、位置指令手
段2に出力され、第1アーム位置指令手段2ば現在の位
置フィードバンク値により速度指令値を第1アーム速度
アンプ4に出力する。
るとロボット動作指令手段1より、あらかじめ決められ
た動作パターンの位置の指令が第1アー1、位置指令手
段2に出力され、第1アーム位置指令手段2ば現在の位
置フィードバンク値により速度指令値を第1アーム速度
アンプ4に出力する。
ここで、ロボット動作中において、アームの姿勢または
負荷条件が変化すると、そのことはロボット動作指令手
段1において分かるので、その条件に対応した最適な第
1アーム速度アンプ4の倍率データが最適ゲイン記憶手
段13より読み出されてケイン指令手段12を介し第1
アー11.速度アンプ4に送られる。第1アーム速度ア
ンプ4は倍率データに対応した増幅率で、速度指令から
速度フィードバック値を減算して得られる誤差信号を増
幅し第17−ノ、モータトライバ6に送り、第1アーム
モータ8を駆動する。
負荷条件が変化すると、そのことはロボット動作指令手
段1において分かるので、その条件に対応した最適な第
1アーム速度アンプ4の倍率データが最適ゲイン記憶手
段13より読み出されてケイン指令手段12を介し第1
アー11.速度アンプ4に送られる。第1アーム速度ア
ンプ4は倍率データに対応した増幅率で、速度指令から
速度フィードバック値を減算して得られる誤差信号を増
幅し第17−ノ、モータトライバ6に送り、第1アーム
モータ8を駆動する。
ここで上記第1アーム速度アンプ40倍率データは、現
在の第1アームエンコーダ10及び第2アームエンコー
ダ11よりの位置フィードバック値と負荷検出手段14
の検出した負荷値によって前記のアーム姿勢や負荷条件
の変化が分かるので、これをキーとして最適な最大ゲイ
ン値が最適ゲイン記憶手段13より選び出されるわけで
ある。負荷検出手段14は、リスト軸17(第2図)の
保持方によって負荷を検出する方法や、ロボットに現在
の負荷の質量等を入力する方法等いくつか考えられるが
、いずれの方法をとってもかまわない。
在の第1アームエンコーダ10及び第2アームエンコー
ダ11よりの位置フィードバック値と負荷検出手段14
の検出した負荷値によって前記のアーム姿勢や負荷条件
の変化が分かるので、これをキーとして最適な最大ゲイ
ン値が最適ゲイン記憶手段13より選び出されるわけで
ある。負荷検出手段14は、リスト軸17(第2図)の
保持方によって負荷を検出する方法や、ロボットに現在
の負荷の質量等を入力する方法等いくつか考えられるが
、いずれの方法をとってもかまわない。
以上第1アームモータ8の制御についてのみ説明したが
、前記と同様の制御が第2アームに行われていることは
言うまでもない。
、前記と同様の制御が第2アームに行われていることは
言うまでもない。
本実施例によれば、ロボットのアーム姿勢または、負荷
条件により速度ループゲインを瞬時に最適な値に制御す
ることができるので、常に発振をおこさない最大値にま
で制御系のループケインを向上させることができる。従
って応答周波数を向上させ、短い加減速で高速の動作を
行え、位置決めのための時間も短くなるので、短いタク
トでロボットが作業することが可能となる。
条件により速度ループゲインを瞬時に最適な値に制御す
ることができるので、常に発振をおこさない最大値にま
で制御系のループケインを向上させることができる。従
って応答周波数を向上させ、短い加減速で高速の動作を
行え、位置決めのための時間も短くなるので、短いタク
トでロボットが作業することが可能となる。
本発明によれば、ロボットのアーム駆動モータの周波数
応答特性を向」ニさせることができるので、高速応答が
可能となり、タクトタイムの短縮によりロボッI−・シ
ステムの能率向上に効果がある。
応答特性を向」ニさせることができるので、高速応答が
可能となり、タクトタイムの短縮によりロボッI−・シ
ステムの能率向上に効果がある。
また、負荷変動に対しても強い信頼性の高いシステムを
構築できる。
構築できる。
特に、減速機を用いないダイレクト・ドライブ形ロボッ
トにおいては、発生しやすい機構系の共振による発振を
避けながら最大限にザーボ系の周波数特性を向上できる
ので、その特長である高速2位置決め時間が短い等の点
を十分に活用できる効果がある。
トにおいては、発生しやすい機構系の共振による発振を
避けながら最大限にザーボ系の周波数特性を向上できる
ので、その特長である高速2位置決め時間が短い等の点
を十分に活用できる効果がある。
第1図は本発明の一実施例であるLノポット制御装置の
制御ブロック図、第2図は本発明の制御対象であるロボ
ットの主要構造図、第3図は本発明の制御対象であるロ
ボットの上面モデル図、第4図は第2図における第1ア
ームモータあるいは第2アームモータの速度制御ループ
のブロック線図、第5図はザーボ制御系の開ループ特性
のモデル図、第6図は第3図に示すアーム姿勢角度時の
速度制御ループの開ループ周波数応答特性図、である。 符号の説明 1・・・ロボット動作指令手段、2・・・第1アーム位
置制御手段、4・・・第1アーム速度アンプ、6・・・
第エイ 1アーl、モータトライバ、8・・・第1アームモータ
、9・・・第2アームモータ、10・・・第1アームエ
ンコーダ、12・・・ゲイン指令手段、19・・・ロボ
ットベース、15・・・第1アーム、16・・・第2ア
ーム、17・・・リスト軸、18・・・ハンド。 代理人 弁理士 並 木 昭 夫 第 2 fa3 図 図 1、[J 第 図 第 図 周席数(Hz) −
制御ブロック図、第2図は本発明の制御対象であるロボ
ットの主要構造図、第3図は本発明の制御対象であるロ
ボットの上面モデル図、第4図は第2図における第1ア
ームモータあるいは第2アームモータの速度制御ループ
のブロック線図、第5図はザーボ制御系の開ループ特性
のモデル図、第6図は第3図に示すアーム姿勢角度時の
速度制御ループの開ループ周波数応答特性図、である。 符号の説明 1・・・ロボット動作指令手段、2・・・第1アーム位
置制御手段、4・・・第1アーム速度アンプ、6・・・
第エイ 1アーl、モータトライバ、8・・・第1アームモータ
、9・・・第2アームモータ、10・・・第1アームエ
ンコーダ、12・・・ゲイン指令手段、19・・・ロボ
ットベース、15・・・第1アーム、16・・・第2ア
ーム、17・・・リスト軸、18・・・ハンド。 代理人 弁理士 並 木 昭 夫 第 2 fa3 図 図 1、[J 第 図 第 図 周席数(Hz) −
Claims (1)
- 【特許請求の範囲】 1、ロボットのアームを回転駆動するモータと、前記ロ
ボットのアーム位置を指定するアーム位置指令を受けて
速度指令信号を出力するアーム位置制御手段と、該アー
ム位置制御手段からの速度指令信号を増幅して出力する
速度アンプと、該速度アンプからの増幅出力を受けて前
記モータをドライブするモータドライバと、前記モータ
により回転駆動される前記アームの回転速度を検出して
前記速度指令信号より減算することにより該アームの回
転速度を前記速度指令に一致させる速度フィードバック
系と、を有して成るロボットの制御装置において、 前記アームの姿勢又は該アームにかかる負荷に応じた最
適の速度アンプ増幅率データを予め求めて記憶しておく
記憶手段と、前記アームの姿勢又は該アームにかかる負
荷を検出する検出手段と、検出されたアームの姿勢又は
アームにかかる負荷に応じた最適の速度アンプ増幅率デ
ータを前記記憶手段から読み出して前記速度アンプのゲ
インとして該速度アンプに指令するゲイン指令手段と、
を具備したことを特徴とするロボットの制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP14133390A JPH0436812A (ja) | 1990-06-01 | 1990-06-01 | ロボットの制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP14133390A JPH0436812A (ja) | 1990-06-01 | 1990-06-01 | ロボットの制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH0436812A true JPH0436812A (ja) | 1992-02-06 |
Family
ID=15289513
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP14133390A Pending JPH0436812A (ja) | 1990-06-01 | 1990-06-01 | ロボットの制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0436812A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005265159A (ja) * | 2004-03-22 | 2005-09-29 | Hino Motors Ltd | クラッチ制御装置 |
-
1990
- 1990-06-01 JP JP14133390A patent/JPH0436812A/ja active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005265159A (ja) * | 2004-03-22 | 2005-09-29 | Hino Motors Ltd | クラッチ制御装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPS6223322B2 (ja) | ||
JPH0199485A (ja) | サーボ電動機の制御装置 | |
JPS63274385A (ja) | サ−ボモ−タの速度制御装置 | |
WO1988004445A1 (en) | Numerical controller | |
JPH0722873B2 (ja) | 送り軸の位置制御装置 | |
JP4639417B2 (ja) | ロボットの制御装置 | |
JPH03130808A (ja) | ロボットの制御方法およびその制御装置 | |
JPH0436812A (ja) | ロボットの制御装置 | |
JPS61120214A (ja) | 位置決め制御装置 | |
JPS6190207A (ja) | ロボツト制御装置 | |
JPS61163406A (ja) | ロボツト制御装置 | |
JP4171192B2 (ja) | サーボ制御装置 | |
JPS61217802A (ja) | ロボツト制御装置 | |
JPS6144797Y2 (ja) | ||
JPS6140616A (ja) | 位置制御方式 | |
JP3125015B2 (ja) | 直交型ロボットの駆動制御装置 | |
JPH11282538A (ja) | サーボ装置 | |
JP2691591B2 (ja) | 力制御ロボットの制御方式 | |
JPS616711A (ja) | ロボツトの位置サ−ボ制御装置 | |
JPS59706A (ja) | 工業用ロボツト制御装置 | |
JPH04286003A (ja) | ロボットの制御方法 | |
JPH0224078A (ja) | マニピュレータ制御装置 | |
JP2515549B2 (ja) | 多軸サ−ボ機構の円弧軌跡制御装置 | |
JPS6257008A (ja) | 位置決め制御方式 | |
JPH0231407B2 (ja) | Ichigimekikonoseigyohoshiki |