JPH05224703A - ダイレクトドライブロボットの制御装置 - Google Patents
ダイレクトドライブロボットの制御装置Info
- Publication number
- JPH05224703A JPH05224703A JP4027765A JP2776592A JPH05224703A JP H05224703 A JPH05224703 A JP H05224703A JP 4027765 A JP4027765 A JP 4027765A JP 2776592 A JP2776592 A JP 2776592A JP H05224703 A JPH05224703 A JP H05224703A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- transfer function
- gain
- control
- frequency band
- 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.)
- Granted
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
(57)【要約】
【目的】 水平系ダイレクトドライブロボットの位置制
御において、オートチューニングを可能にする。 【構成】 最適レギュレータ理論により算出した制御ゲ
インと、そのゲインで定まる入力から出力への伝達関数
の周波数帯域を狭めない速度フィルタの組をテーブル化
しておき、それぞれの組についてロボットにステップ応
答させた際に、所定時間後の最大偏差が所定値を越えな
い組の中で最も伝達関数の周波数帯域の広い組を最適サ
ーボパラメータとして採用することにより、ロボットの
オートチューニングを実現する。
御において、オートチューニングを可能にする。 【構成】 最適レギュレータ理論により算出した制御ゲ
インと、そのゲインで定まる入力から出力への伝達関数
の周波数帯域を狭めない速度フィルタの組をテーブル化
しておき、それぞれの組についてロボットにステップ応
答させた際に、所定時間後の最大偏差が所定値を越えな
い組の中で最も伝達関数の周波数帯域の広い組を最適サ
ーボパラメータとして採用することにより、ロボットの
オートチューニングを実現する。
Description
【0001】
【産業上の利用分野】本発明はダイレクトドライブロボ
ット(以下、DDロボットと略す)の制御装置に関する
ものである。
ット(以下、DDロボットと略す)の制御装置に関する
ものである。
【0002】
【従来の技術】水平系のDDロボットの概略構成を図2
に示す。図2において、1は1軸、2は2軸である。こ
のようなDDロボットにおける各軸1、2を単独で制御
する場合の従来の位置制御系を図8に示す。
に示す。図2において、1は1軸、2は2軸である。こ
のようなDDロボットにおける各軸1、2を単独で制御
する場合の従来の位置制御系を図8に示す。
【0003】図8において、3は位置ループ用PIDコ
ントローラ、4は速度ループ用PIDコントローラ、5
はPWMインバータから成る電流アンプ、6はDDロボ
ット単軸の伝達関数G(S)、7はローパスフィルタか
らなる速度フィルタであり、θ*は位置指令、θは位
置、ω*は速度指令、ωは速度である。
ントローラ、4は速度ループ用PIDコントローラ、5
はPWMインバータから成る電流アンプ、6はDDロボ
ット単軸の伝達関数G(S)、7はローパスフィルタか
らなる速度フィルタであり、θ*は位置指令、θは位
置、ω*は速度指令、ωは速度である。
【0004】このような制御系では、負荷であるDDロ
ボットのダイナミックス(伝達関数)を考慮せず、定性
的に位置・速度ループをPIDコントローラで制御して
いる。
ボットのダイナミックス(伝達関数)を考慮せず、定性
的に位置・速度ループをPIDコントローラで制御して
いる。
【0005】
【発明が解決しようとする課題】しかしながら、図8に
示したような定性的に構築された制御系では、そのサー
ボパラメータ(制御ゲイン及び速度フィルタのカットオ
フ周波数)を定量的に決定するのは困難であり、人間が
経験と勘で調整を行ってきた。しかし、このような調整
法では、調整に時間がかかる上に調整にばらつきが出て
しまい、最適な調整になっているか疑問である。また、
DDロボットが負荷を持つことによる慣性モーメントの
変化に即座に対応できない。
示したような定性的に構築された制御系では、そのサー
ボパラメータ(制御ゲイン及び速度フィルタのカットオ
フ周波数)を定量的に決定するのは困難であり、人間が
経験と勘で調整を行ってきた。しかし、このような調整
法では、調整に時間がかかる上に調整にばらつきが出て
しまい、最適な調整になっているか疑問である。また、
DDロボットが負荷を持つことによる慣性モーメントの
変化に即座に対応できない。
【0006】本発明は、上記従来の問題点に鑑み、DD
ロボットのサーボパラメータを自動調整できるようにし
たDDロボットの制御装置を提供することを目的とす
る。
ロボットのサーボパラメータを自動調整できるようにし
たDDロボットの制御装置を提供することを目的とす
る。
【0007】
【課題を解決するための手段】本発明のDDロボットの
制御装置は、最適レギュレータ理論により算出した制御
ゲインと、そのゲインで定まる入力から出力への伝達関
数の周波数帯域を狭めない速度フィルタの組をテーブル
化しておき、それぞれの組についてロボットにステップ
応答させた際に、所定時間後の最大偏差が所定値を越え
ない組の中で伝達関数の周波数帯域の広い組を最適サー
ボパラメータとして採用する手段を備えたことを特徴と
する。
制御装置は、最適レギュレータ理論により算出した制御
ゲインと、そのゲインで定まる入力から出力への伝達関
数の周波数帯域を狭めない速度フィルタの組をテーブル
化しておき、それぞれの組についてロボットにステップ
応答させた際に、所定時間後の最大偏差が所定値を越え
ない組の中で伝達関数の周波数帯域の広い組を最適サー
ボパラメータとして採用する手段を備えたことを特徴と
する。
【0008】又、好適には最適レギュレータ理論を用い
て制御ゲインを求める際に必要な慣性モーメントに関す
る情報を、ロボットの姿勢を固定した状態で一定振幅の
電流で駆動することにより求める手段を備える。
て制御ゲインを求める際に必要な慣性モーメントに関す
る情報を、ロボットの姿勢を固定した状態で一定振幅の
電流で駆動することにより求める手段を備える。
【0009】
【作用】本発明は上記した構成によって、DDロボット
の最適なサーボパラメータを自動的に決定することがで
き、また上記好適な慣性モーメントを求める手段を備え
ると複雑な計算をすることなしにそれを得ることができ
る。
の最適なサーボパラメータを自動的に決定することがで
き、また上記好適な慣性モーメントを求める手段を備え
ると複雑な計算をすることなしにそれを得ることができ
る。
【0010】
【実施例】以下、本発明の一実施例のDDロボットの制
御装置について図1〜図7を参照しながら説明する。
御装置について図1〜図7を参照しながら説明する。
【0011】DDロボットの機構的な概略構成は、従来
例で説明した図2と同じであり、その説明を援用してこ
こでの説明は省略する。なお、このDDロボットに用い
られているモータは、ロータが永久磁石から成る回転磁
界形同期機である。このモータの運動方程式は、位置を
θ(t)、角速度をω(t)、三相対称電流の振幅(ト
ルク電流)をi(t)とすると、次のようになる。
例で説明した図2と同じであり、その説明を援用してこ
こでの説明は省略する。なお、このDDロボットに用い
られているモータは、ロータが永久磁石から成る回転磁
界形同期機である。このモータの運動方程式は、位置を
θ(t)、角速度をω(t)、三相対称電流の振幅(ト
ルク電流)をi(t)とすると、次のようになる。
【0012】
【数1】
【0013】位置の目標値をθ*(t)=a(=一
定)、位置偏差をe(t)=θ*(t)−θ(t)、負
荷トルクT1 =0とし、まとめて行列表現すれば、以下
のようになる。
定)、位置偏差をe(t)=θ*(t)−θ(t)、負
荷トルクT1 =0とし、まとめて行列表現すれば、以下
のようになる。
【0014】
【数2】
【0015】ここで評価関数Hをq1 、q2 、q3 、r
を重みとして以下のように定義する。
を重みとして以下のように定義する。
【0016】
【数3】
【0017】このとき(数3)に対応するリカッチ方程
式は以下のようになる。
式は以下のようになる。
【0018】
【数4】
【0019】このリカッチ方程式の半正定な解を用い
て、最適制御v*(t)は以下のように決まる。
て、最適制御v*(t)は以下のように決まる。
【0020】
【数5】
【0021】(数5)より最適制御入力i*(t)は以
下のように決まる。
下のように決まる。
【0022】
【数6】
【0023】(数6)をブロック線図で表すと、図3の
ようになる。図3において、θ*は位置指令、θは位
置、eは位置偏差、i*は制御出力(電流指令)、ωは
角速度、11は積分要素、12は比例要素、13は微分
要素、14はDDロボット単軸の伝達関数、15はロー
パスフィルタである。
ようになる。図3において、θ*は位置指令、θは位
置、eは位置偏差、i*は制御出力(電流指令)、ωは
角速度、11は積分要素、12は比例要素、13は微分
要素、14はDDロボット単軸の伝達関数、15はロー
パスフィルタである。
【0024】以上述べた制御系において、重みq2 、q
3 、rを固定し、位置偏差eの重みq1 を大きくしてい
くと、ゲインが大きくなり、制御帯域が広がる。ここで
制御帯域とは、図4に示すように入力から出力への伝達
関数Wのゲインが−3db下がる点を指す。図4は速度フ
ィルタがない場合であるが、実際には速度フィルタをか
けることにより、図5に示すように制御帯域を狭めてし
まう。この狭める大きさの許容範囲を予め決めておき、
その範囲内で最も低いカットオフ周波数を速度フィルタ
のカットオフ周波数とし、そのときのゲインと組にし、
テーブル化しておく。
3 、rを固定し、位置偏差eの重みq1 を大きくしてい
くと、ゲインが大きくなり、制御帯域が広がる。ここで
制御帯域とは、図4に示すように入力から出力への伝達
関数Wのゲインが−3db下がる点を指す。図4は速度フ
ィルタがない場合であるが、実際には速度フィルタをか
けることにより、図5に示すように制御帯域を狭めてし
まう。この狭める大きさの許容範囲を予め決めておき、
その範囲内で最も低いカットオフ周波数を速度フィルタ
のカットオフ周波数とし、そのときのゲインと組にし、
テーブル化しておく。
【0025】次に、このゲインとフィルタの組を実際の
ロボットに適用してステップ応答させ、所定時間t1後
の最大偏差が、図6に示すように所定値εより小さけれ
ば制御帯域を広げるゲインとフィルタの組を選択し、図
7に示すようにε以上であれば制御帯域を狭める組を選
択する。
ロボットに適用してステップ応答させ、所定時間t1後
の最大偏差が、図6に示すように所定値εより小さけれ
ば制御帯域を広げるゲインとフィルタの組を選択し、図
7に示すようにε以上であれば制御帯域を狭める組を選
択する。
【0026】以上の操作を繰り返すことにより、最適な
ゲインとフィルタの組へと収束させる。この様子をフロ
ーチャートにしたものが図1である。図1において、ス
テップ#1はゲインとフィルタのカットオフ周波数のテ
ーブル化処理、ステップ#2はロボットにステップ応答
させる処理、ステップ#3は定常偏差が所定値εより大
であるか小であるかの判定処理、ステップ#4は定常偏
差がεより小の場合に制御帯域を広げるゲインとフィル
タの組を選択する処理、ステップ#5は定常偏差がεよ
り大の場合に制御帯域を狭めるゲインとフィルタの組を
選択する処理である。
ゲインとフィルタの組へと収束させる。この様子をフロ
ーチャートにしたものが図1である。図1において、ス
テップ#1はゲインとフィルタのカットオフ周波数のテ
ーブル化処理、ステップ#2はロボットにステップ応答
させる処理、ステップ#3は定常偏差が所定値εより大
であるか小であるかの判定処理、ステップ#4は定常偏
差がεより小の場合に制御帯域を広げるゲインとフィル
タの組を選択する処理、ステップ#5は定常偏差がεよ
り大の場合に制御帯域を狭めるゲインとフィルタの組を
選択する処理である。
【0027】最初は2軸2をサーボオフ状態で1軸1の
調整を図1に従って行い、次に1軸1はサーボオン状態
で2軸2の調整を行う。2軸2の調整の際には1軸1の
定状偏差もゲインとフィルタの組の選択の考慮に入れ
る。
調整を図1に従って行い、次に1軸1はサーボオン状態
で2軸2の調整を行う。2軸2の調整の際には1軸1の
定状偏差もゲインとフィルタの組の選択の考慮に入れ
る。
【0028】なお本実施例では、最適レギュレータ設計
の際に目標値θ*をステップ状にしているが、目標値追
従特性を良くするために目標値をランプ状(この場合制
御系は図3に示すI−PD制御系でなくPID制御系に
なる)等、他の形状にした場合も同様に本発明が適用で
きるのは言うまでもない。また、目標追従特性を良くす
るためにフィードフォワード補償を加える場合は、フィ
ードフォワード補償を加えない状態でゲインとフィルタ
のテーブルを作成すれば、同様に本発明は適用できる。
の際に目標値θ*をステップ状にしているが、目標値追
従特性を良くするために目標値をランプ状(この場合制
御系は図3に示すI−PD制御系でなくPID制御系に
なる)等、他の形状にした場合も同様に本発明が適用で
きるのは言うまでもない。また、目標追従特性を良くす
るためにフィードフォワード補償を加える場合は、フィ
ードフォワード補償を加えない状態でゲインとフィルタ
のテーブルを作成すれば、同様に本発明は適用できる。
【0029】(実施例2)(数4)のリカッチ方程式の
中でロボットのパラメータとしては、d/JとKt /J
の2つがある。そこで、機械的に姿勢を固定して慣性モ
ーメントが変動しないようにし、さらに(数1)におい
て以下の仮定をすれば(数7)で1/Jを求めることが
できる。
中でロボットのパラメータとしては、d/JとKt /J
の2つがある。そこで、機械的に姿勢を固定して慣性モ
ーメントが変動しないようにし、さらに(数1)におい
て以下の仮定をすれば(数7)で1/Jを求めることが
できる。
【0030】 電流オフセットioff と負荷トルクT
i がゼロ 粘性係数dとトルク定数Kt は既知で慣性モーメン
トJに関わらず一定
i がゼロ 粘性係数dとトルク定数Kt は既知で慣性モーメン
トJに関わらず一定
【0031】
【数7】
【0032】2軸2の1/Jを求めるときは、1軸1を
機械的にロボットベースに固定して2軸2の一定振幅の
三相対称電流を流し、2軸2回りの角加速度α(t)と
角速度ω(t)を計測すればよい。同様に1軸1の1/
Jを求めるときは、1軸1と2軸2間を所定の相対角度
で機械的に固定し、1軸1に一定振幅の三相対称電流を
流し、1軸1回りの角速度α(t)と角速度ω(t)を
計測すればよい。このように1/Jが求まれば、粘性係
数dとトルク定数Kt は既知であるので、直ちにKt /
J及びd/Jは求めることができる。
機械的にロボットベースに固定して2軸2の一定振幅の
三相対称電流を流し、2軸2回りの角加速度α(t)と
角速度ω(t)を計測すればよい。同様に1軸1の1/
Jを求めるときは、1軸1と2軸2間を所定の相対角度
で機械的に固定し、1軸1に一定振幅の三相対称電流を
流し、1軸1回りの角速度α(t)と角速度ω(t)を
計測すればよい。このように1/Jが求まれば、粘性係
数dとトルク定数Kt は既知であるので、直ちにKt /
J及びd/Jは求めることができる。
【0033】
【数8】
【0034】なお、実施例1、2とも水平2軸のロボッ
トを対称に説明を行ったが、3軸以上でも同様に実施可
能なのは言うまでもない。
トを対称に説明を行ったが、3軸以上でも同様に実施可
能なのは言うまでもない。
【0035】
【発明の効果】本発明によれば、以上のように最適レギ
ュレータ理論により算出した制御ゲインと、そのゲイン
で定まる入力から出力への伝達関数の周波数帯域を狭め
ない速度フィルタの組をテーブル化しておき、それぞれ
の組についてロボットにステップ応答させた際に、所定
時間後の最大偏差が所定値を越えない組の中で最も伝達
関数の周波数帯域の広い組を最適サーボパラメータとし
て採用することにより、ロボットのオートチューニング
を実現できるものである。
ュレータ理論により算出した制御ゲインと、そのゲイン
で定まる入力から出力への伝達関数の周波数帯域を狭め
ない速度フィルタの組をテーブル化しておき、それぞれ
の組についてロボットにステップ応答させた際に、所定
時間後の最大偏差が所定値を越えない組の中で最も伝達
関数の周波数帯域の広い組を最適サーボパラメータとし
て採用することにより、ロボットのオートチューニング
を実現できるものである。
【0036】又、最適レギュレータ理論を用いて制御ゲ
インを求める際に必要な慣性モーメントに関する情報
を、ロボットの姿勢を固定した状態で一定振幅の電流で
駆動して求めることにより複雑な計算なしで得ることが
できる。
インを求める際に必要な慣性モーメントに関する情報
を、ロボットの姿勢を固定した状態で一定振幅の電流で
駆動して求めることにより複雑な計算なしで得ることが
できる。
【図1】本発明の一実施例におけるDDロボットのオー
トチューニングのフローチャートである。
トチューニングのフローチャートである。
【図2】同実施例における水平系DDロボットの概略構
成を示す斜視図である。
成を示す斜視図である。
【図3】同実施例における一制御系のブロック線図であ
る。
る。
【図4】同実施例における速度フィルタ無しの場合の伝
達関数のボード線図である。
達関数のボード線図である。
【図5】同実施例における速度フィルタ有りの場合の伝
達関数のボード線図である。
達関数のボード線図である。
【図6】同実施例におけるステップ応答における偏差の
説明図である。
説明図である。
【図7】同実施例におけるステップ応答における偏差の
説明図である。
説明図である。
【図8】従来例における一制御系のブロック線図であ
る。
る。
11 積分要素 12 比例要素 13 微分要素 14 伝達関数 15 ローパスフィルタ
Claims (2)
- 【請求項1】 最適レギュレータ理論により算出した制
御ゲインと、そのゲインで定まる入力から出力への伝達
関数の周波数帯域を狭めない速度フィルタの組をテーブ
ル化しておき、それぞれの組についてロボットにステッ
プ応答させた際に、所定時間後の最大偏差が所定値を越
えない組の中で伝達関数の周波数帯域の広い組を最適サ
ーボパラメータとして採用する手段を備えたことを特徴
とするダイレクトドライブロボットの制御装置。 - 【請求項2】 最適レギュレータ理論を用いて制御ゲイ
ンを求める際に必要な慣性モーメントに関する情報を、
ロボットの姿勢を固定した状態で一定振幅の電流で駆動
することにより求める手段を備えたことを特徴とする請
求項1記載のダイレクトドライブロボットの制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP02776592A JP3190088B2 (ja) | 1992-02-14 | 1992-02-14 | ダイレクトドライブロボットの制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP02776592A JP3190088B2 (ja) | 1992-02-14 | 1992-02-14 | ダイレクトドライブロボットの制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH05224703A true JPH05224703A (ja) | 1993-09-03 |
| JP3190088B2 JP3190088B2 (ja) | 2001-07-16 |
Family
ID=12230094
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP02776592A Expired - Fee Related JP3190088B2 (ja) | 1992-02-14 | 1992-02-14 | ダイレクトドライブロボットの制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3190088B2 (ja) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2002005414A1 (fr) * | 2000-07-11 | 2002-01-17 | Kabushiki Kaisha Yaskawa Denki | Dispositif de commande pour un moteur |
| JP2007135344A (ja) * | 2005-11-11 | 2007-05-31 | Hitachi Industrial Equipment Systems Co Ltd | 電動機制御装置の自動調整法および装置 |
| JP2012185658A (ja) * | 2011-03-04 | 2012-09-27 | Takenaka Komuten Co Ltd | アクティブフィードバック制御装置及びプログラム |
| KR101339357B1 (ko) * | 2009-09-24 | 2013-12-09 | 현대중공업 주식회사 | 산업용 로봇 암의 자동튜닝 장치 및 방법 |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101841002B (zh) | 2004-09-24 | 2011-11-16 | 株式会社半导体能源研究所 | 发光器件 |
| US8115382B2 (en) | 2007-09-20 | 2012-02-14 | Semiconductor Energy Laboratory Co., Ltd. | Light-emitting element, light-emitting device, and electronic device, comprising controlled carrier transport |
| US8384283B2 (en) | 2007-09-20 | 2013-02-26 | Semiconductor Energy Laboratory Co., Ltd. | Light-emitting element, light-emitting device, and electronic device |
-
1992
- 1992-02-14 JP JP02776592A patent/JP3190088B2/ja not_active Expired - Fee Related
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2002005414A1 (fr) * | 2000-07-11 | 2002-01-17 | Kabushiki Kaisha Yaskawa Denki | Dispositif de commande pour un moteur |
| JP2007135344A (ja) * | 2005-11-11 | 2007-05-31 | Hitachi Industrial Equipment Systems Co Ltd | 電動機制御装置の自動調整法および装置 |
| KR101339357B1 (ko) * | 2009-09-24 | 2013-12-09 | 현대중공업 주식회사 | 산업용 로봇 암의 자동튜닝 장치 및 방법 |
| JP2012185658A (ja) * | 2011-03-04 | 2012-09-27 | Takenaka Komuten Co Ltd | アクティブフィードバック制御装置及びプログラム |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3190088B2 (ja) | 2001-07-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6784632B2 (en) | Positioning servo controller | |
| JPH0683403A (ja) | 適応pi制御方式 | |
| WO2005072264A2 (en) | System and method for adjusting a pid controller in a limited rotation motor system | |
| US5384525A (en) | Method of controlling a servomotor | |
| JPH05224703A (ja) | ダイレクトドライブロボットの制御装置 | |
| US7638965B2 (en) | Motor control apparatus | |
| US7183738B2 (en) | Motor control device | |
| US5652491A (en) | Position controller for an electric motor | |
| US5374882A (en) | Method of controlling servomotor | |
| WO1990016020A1 (en) | Zeroing method using a disturbance estimating observer | |
| US6920362B2 (en) | Control apparatus | |
| JPS62106516A (ja) | 産業用ロボツトのア−ム制御装置 | |
| Salem et al. | PD controller structures: comparison and selection for an electromechanical system | |
| JPH03107384A (ja) | モータ駆動制御装置 | |
| JPH08263143A (ja) | 外乱オブザーバを用いた制御ゲイン切り替え方式 | |
| JPH04362702A (ja) | 繰り返し制御における速度制御方法 | |
| KR100794893B1 (ko) | 모터 제어 장치 | |
| JPH0275001A (ja) | スライディングモード制御方式 | |
| JPH08116688A (ja) | サーボモータの発振検出方法及びサーボモータの速度ゲイン調整方法 | |
| JP2001356822A (ja) | 位置制御装置 | |
| JP2918269B2 (ja) | ロボットの移動制御方法 | |
| JP3555351B2 (ja) | 速度制御装置 | |
| JPH0833375A (ja) | 速度制御装置 | |
| Beazel et al. | Command shaping applied to nonlinear systems with configuration-dependent resonance | |
| JPH0297291A (ja) | モータの自動制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| LAPS | Cancellation because of no payment of annual fees |