JPH11285283A - 外乱補償制御装置 - Google Patents
外乱補償制御装置Info
- Publication number
- JPH11285283A JPH11285283A JP10081498A JP8149898A JPH11285283A JP H11285283 A JPH11285283 A JP H11285283A JP 10081498 A JP10081498 A JP 10081498A JP 8149898 A JP8149898 A JP 8149898A JP H11285283 A JPH11285283 A JP H11285283A
- Authority
- JP
- Japan
- Prior art keywords
- control
- disturbance
- amount
- target
- loop
- 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.)
- Withdrawn
Links
Landscapes
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
(57)【要約】
【課題】位置に依存した周期的な制御誤差や外乱を高精
度で抑えることができ、周期が変わっても制御装置の調
整が不要な外乱補償制御装置を提供する。 【解決手段】速度制御ゲイン部20及び制御対象を駆動
するモータ21と、そのフィードバック回路により制御
ループを構成している。この制御ループは、追従目標と
制御対象の出力情報との間の制御誤差に基づいてモータ
21を制御する。また、外乱オブザーバ9は、モータ2
1に加わる外乱量を推定し、上記外乱量が抑圧されるよ
うに上記推定された外乱量を上記制御ループに入力す
る。更に、繰り返し制御部31は、制御対象の出力速度
を積分器32により積分して現在の位置を求め、この現
在位置における上記推定された外乱量をメモリθ0 〜θ
n に記憶し、周期成分が抑圧されるように上記位置毎に
記憶された情報を上記制御ループに入力する。
度で抑えることができ、周期が変わっても制御装置の調
整が不要な外乱補償制御装置を提供する。 【解決手段】速度制御ゲイン部20及び制御対象を駆動
するモータ21と、そのフィードバック回路により制御
ループを構成している。この制御ループは、追従目標と
制御対象の出力情報との間の制御誤差に基づいてモータ
21を制御する。また、外乱オブザーバ9は、モータ2
1に加わる外乱量を推定し、上記外乱量が抑圧されるよ
うに上記推定された外乱量を上記制御ループに入力す
る。更に、繰り返し制御部31は、制御対象の出力速度
を積分器32により積分して現在の位置を求め、この現
在位置における上記推定された外乱量をメモリθ0 〜θ
n に記憶し、周期成分が抑圧されるように上記位置毎に
記憶された情報を上記制御ループに入力する。
Description
【0001】
【発明の属する技術分野】本発明は、制御対象に加わる
外乱量を推定し、それを抑圧する外乱補償制御装置に関
する。
外乱量を推定し、それを抑圧する外乱補償制御装置に関
する。
【0002】
【従来の技術】従来、ベルトコンベアや包装機械等で用
いられる速度制御や位置制御において、モータに取り付
けられた回転位相検出器もしくはモータの回転により走
行させられる制御対象の位置信号からの情報をもとに、
モータの回転位相をある基準位相もしくは目標位相に同
期して回転させるための位相制御と、モータに取り付け
られたエンコーダの情報から得られるモータ移転速度情
報をもとに、モータの回転速度を一定にコントロールす
る速度制御の他に、モータに印加される駆動電流もしく
は駆動電圧の情報と上記エンコーダからの速度情報をも
とに、現代制御理論における最小次元オブザーバで構成
され、アナログ回路もしくはソフトウェアのアルゴリズ
ム等により実現される外乱推定器によりモータ回転機構
部に加わっている外乱、すなわち負荷外乱トルクやモー
タ自身のトルクリップル等を推定し、フィードフォワー
ドでモータの制御電圧に戻す外乱抑圧制御手段を備えた
ものが知られている。
いられる速度制御や位置制御において、モータに取り付
けられた回転位相検出器もしくはモータの回転により走
行させられる制御対象の位置信号からの情報をもとに、
モータの回転位相をある基準位相もしくは目標位相に同
期して回転させるための位相制御と、モータに取り付け
られたエンコーダの情報から得られるモータ移転速度情
報をもとに、モータの回転速度を一定にコントロールす
る速度制御の他に、モータに印加される駆動電流もしく
は駆動電圧の情報と上記エンコーダからの速度情報をも
とに、現代制御理論における最小次元オブザーバで構成
され、アナログ回路もしくはソフトウェアのアルゴリズ
ム等により実現される外乱推定器によりモータ回転機構
部に加わっている外乱、すなわち負荷外乱トルクやモー
タ自身のトルクリップル等を推定し、フィードフォワー
ドでモータの制御電圧に戻す外乱抑圧制御手段を備えた
ものが知られている。
【0003】次に外乱オブザーバを用いた外乱抑圧制御
について説明する。モータに加わる外乱を検出するか、
推定できれば、外乱抑圧能力を大幅に改善することが可
能である。従来においては、外乱量を推定するオブザー
バにより外乱抑圧ループを構成し、積極的に外乱を抑圧
することにより、上記外乱抑圧能力を大幅に改善してい
る。モータに加わる外乱量(外乱トルク)は、直接測定
することができなくてもモータの入力電流と速度検出器
の出力から推定することが可能である。外乱オブザーバ
を含んだモータシステムは、あたかも外乱が加わってい
ないかのように、外乱による速度ムラを打ち消すことが
できる。
について説明する。モータに加わる外乱を検出するか、
推定できれば、外乱抑圧能力を大幅に改善することが可
能である。従来においては、外乱量を推定するオブザー
バにより外乱抑圧ループを構成し、積極的に外乱を抑圧
することにより、上記外乱抑圧能力を大幅に改善してい
る。モータに加わる外乱量(外乱トルク)は、直接測定
することができなくてもモータの入力電流と速度検出器
の出力から推定することが可能である。外乱オブザーバ
を含んだモータシステムは、あたかも外乱が加わってい
ないかのように、外乱による速度ムラを打ち消すことが
できる。
【0004】図12は、外乱オブザーバの原理的な構成
を示すブロック図である。図12において、1はモータ
トルク定数、2はモータの回転機構部の伝達関数表現、
3は外乱、4は角速度を角度に変換するための積分項を
伝達関数表現したもの、5は微分項を伝達関数表現した
もの、6はモータ慣性モーメント、7はモータトルク定
数1を電気的に表現している部分、8はその逆数を表し
ている。ここでKtはモータトルク定数、Jは回転軸回
りの慣性モーメント、Dは摩擦系の粘性抵抗、Fはクー
ロン摩擦力、Textは負荷トルク、下添え字nはその
パラメータの公称値である。
を示すブロック図である。図12において、1はモータ
トルク定数、2はモータの回転機構部の伝達関数表現、
3は外乱、4は角速度を角度に変換するための積分項を
伝達関数表現したもの、5は微分項を伝達関数表現した
もの、6はモータ慣性モーメント、7はモータトルク定
数1を電気的に表現している部分、8はその逆数を表し
ている。ここでKtはモータトルク定数、Jは回転軸回
りの慣性モーメント、Dは摩擦系の粘性抵抗、Fはクー
ロン摩擦力、Textは負荷トルク、下添え字nはその
パラメータの公称値である。
【0005】上記図12における外乱オブザーバは、完
全微分器を有するためモータに取り付けられた速度検出
器の出力に含まれるノイズを高周波域において増幅し、
この増幅されたノイズが外乱抑圧ループを巡回するとい
った問題が生ずる。
全微分器を有するためモータに取り付けられた速度検出
器の出力に含まれるノイズを高周波域において増幅し、
この増幅されたノイズが外乱抑圧ループを巡回するとい
った問題が生ずる。
【0006】そこで、図12の理想的なオブザーバを現
代制御理論の最小次元オブザーバの手法で、微分器5を
用いない形に作り変える。図13は、上記微分器5を用
いない形に作り変えた回路構成を示したもので、符号9
が作り変えた部分を示している。
代制御理論の最小次元オブザーバの手法で、微分器5を
用いない形に作り変える。図13は、上記微分器5を用
いない形に作り変えた回路構成を示したもので、符号9
が作り変えた部分を示している。
【0007】現代制御理論の最小次元オブザーバは図1
1に示すように構成されており、状態方程式を入力10
と出力12から微分方程式を逆に解くことによって、測
定不可能な状態を推定するものである。図11におい
て、11は状態方程式で表現されたモータ、10はモー
タ11の入力、12はモータ11の出力、13〜18は
最小次元オブザーバを構成する行列式もしくは積分器で
表現されるブロック、19は最小次元オブザーバの出力
である。
1に示すように構成されており、状態方程式を入力10
と出力12から微分方程式を逆に解くことによって、測
定不可能な状態を推定するものである。図11におい
て、11は状態方程式で表現されたモータ、10はモー
タ11の入力、12はモータ11の出力、13〜18は
最小次元オブザーバを構成する行列式もしくは積分器で
表現されるブロック、19は最小次元オブザーバの出力
である。
【0008】上記図13に示すように構成された外乱オ
ブザーバは、モータに加わる外乱量3を推定した推定外
乱量19を出力するが、図12の完全微分器を用いた理
想的な外乱オブザーバと異なり、全ての周波数領域にお
いて完全に外乱を推定できるわけではない。
ブザーバは、モータに加わる外乱量3を推定した推定外
乱量19を出力するが、図12の完全微分器を用いた理
想的な外乱オブザーバと異なり、全ての周波数領域にお
いて完全に外乱を推定できるわけではない。
【0009】外乱オブザーバによる外乱の減衰特性(s/
g )/(1+s/g )は、周波数特性として表される。す
なわち、外乱オブザーバの中で用いた係数gが図13の
外乱オブザーバの帯域を表しており、g rad/sec より低
い周波数で外乱を抑圧する能力を持ち、性能を向上させ
るためには係数gを大きくする必要がある。
g )/(1+s/g )は、周波数特性として表される。す
なわち、外乱オブザーバの中で用いた係数gが図13の
外乱オブザーバの帯域を表しており、g rad/sec より低
い周波数で外乱を抑圧する能力を持ち、性能を向上させ
るためには係数gを大きくする必要がある。
【0010】上記外乱オブザーバにより、従来のベルト
コンベアや包装機械等の位置・速度制御装置に、速度制
御ループ、位相制御ループと併用して外乱抑圧ループが
構成される。また、上記外乱オブザーバはモータに加わ
る外乱、例えば軸摩擦、モータトルクリップル、外部振
動、走行負荷、テンション変動による負荷変動等の外乱
をリアルタイムで推定し、フィードフォワードで外乱を
抑圧することができる。これにより、位置決め精度や速
度精度が改善される。
コンベアや包装機械等の位置・速度制御装置に、速度制
御ループ、位相制御ループと併用して外乱抑圧ループが
構成される。また、上記外乱オブザーバはモータに加わ
る外乱、例えば軸摩擦、モータトルクリップル、外部振
動、走行負荷、テンション変動による負荷変動等の外乱
をリアルタイムで推定し、フィードフォワードで外乱を
抑圧することができる。これにより、位置決め精度や速
度精度が改善される。
【0011】図13における制御理論の伝達関数で表現
される外乱オブザーバのブロック図は、アナログ回路で
あればオペレータアンプ等による増幅器、加算器、積分
器、減算器により容易に構成できる。しかし、アナログ
の演算回数が増加するするに従い、回路オフセットやド
リフトの問題が生じるため、上記アナログ演算をマイク
ロコンピュータ等からなるデジタルフィルタによるデジ
タル演算で行なう方が望ましい。
される外乱オブザーバのブロック図は、アナログ回路で
あればオペレータアンプ等による増幅器、加算器、積分
器、減算器により容易に構成できる。しかし、アナログ
の演算回数が増加するするに従い、回路オフセットやド
リフトの問題が生じるため、上記アナログ演算をマイク
ロコンピュータ等からなるデジタルフィルタによるデジ
タル演算で行なう方が望ましい。
【0012】
【発明が解決しようとする課題】外乱オブザーバを用い
た従来の外乱抑圧制御システムは、以上のように構成さ
れているが、g rad/sec 以上の周波数においてオブザー
バによる外乱抑圧効果がない他、g rad/sec 付近におい
ても大きな抑圧効果は期待できない。また、係数gを無
理に大きく取ろうとすると、外乱抑圧ループが不安定に
なり発振する等の問題点があった。
た従来の外乱抑圧制御システムは、以上のように構成さ
れているが、g rad/sec 以上の周波数においてオブザー
バによる外乱抑圧効果がない他、g rad/sec 付近におい
ても大きな抑圧効果は期待できない。また、係数gを無
理に大きく取ろうとすると、外乱抑圧ループが不安定に
なり発振する等の問題点があった。
【0013】そこで、上記の問題を解決するために、例
えば特許第2566033号(外乱抑圧制御システム)
に示されているような繰り返し制御を用いていた。すな
わち、図6のブロック図に示すように、外乱抑圧ループ
の周期性を考慮し、周期的な外乱に対する外乱抑圧度を
改善する外乱繰り返し制御方式を用いている。同図にお
いて、8はモータトルク定数Ktの逆数を表したもの、
9は外乱オブザーバ、20は速度制御ゲイン部(AF
C)、21はモータ、22は繰り返し制御部で、e-LS
は記憶時間がLのメモリ、q(s)は繰り返し制御の安
定性を保つために挿入されるアッテネータ(減衰器)及
びフィルタを表す。
えば特許第2566033号(外乱抑圧制御システム)
に示されているような繰り返し制御を用いていた。すな
わち、図6のブロック図に示すように、外乱抑圧ループ
の周期性を考慮し、周期的な外乱に対する外乱抑圧度を
改善する外乱繰り返し制御方式を用いている。同図にお
いて、8はモータトルク定数Ktの逆数を表したもの、
9は外乱オブザーバ、20は速度制御ゲイン部(AF
C)、21はモータ、22は繰り返し制御部で、e-LS
は記憶時間がLのメモリ、q(s)は繰り返し制御の安
定性を保つために挿入されるアッテネータ(減衰器)及
びフィルタを表す。
【0014】また、図7は、速度制御ループと外乱抑圧
ループの両方の周期性を考慮し、周期的な外乱抑圧度や
速度変動を改善する速度・外乱繰り返し制御方式のブロ
ック図である。すなわち、速度制御ゲイン部20の前段
に繰り返し制御部22を設け、外乱オブザーバ9にて推
定した外乱推定量をのゲイン変換部23で速度制御ゲイ
ン分の1にした後、外乱補正ゲイン部8でモータトルク
定数分の1にしてフィードフォワードで戻し、速度誤差
信号に加算して繰り返し制御部22に入力している。
ループの両方の周期性を考慮し、周期的な外乱抑圧度や
速度変動を改善する速度・外乱繰り返し制御方式のブロ
ック図である。すなわち、速度制御ゲイン部20の前段
に繰り返し制御部22を設け、外乱オブザーバ9にて推
定した外乱推定量をのゲイン変換部23で速度制御ゲイ
ン分の1にした後、外乱補正ゲイン部8でモータトルク
定数分の1にしてフィードフォワードで戻し、速度誤差
信号に加算して繰り返し制御部22に入力している。
【0015】図8は、速度制御ループの周期性を考慮す
る速度繰り返し制御に外乱オブザーバ9による外乱抑圧
制御を加えた方式のブロック図である。図10は、図8
における速度繰り返し制御に外乱抑圧制御を加えた方式
において、制御系における速度変動の周期性の強弱によ
り繰り返し制御の繰り返し度と外乱抑圧ループの抑圧ゲ
インを適応的に変化させるようにしたシステムのブロッ
ク図である。同図において、22aは適応繰り返し制御
部で、24は後述の積分器26の出力に反比例してゲイ
ンが可変され繰り返し度合いを決定する繰り返しゲイン
部、25は速度変動の周期性の強弱を検出する周期性検
出部で、26は1次あるいは数次の積分器の出力の絶対
値を取った値を出力する積分器、27は積分器26の出
力に比例してゲインが可変され外乱抑圧を決める外乱抑
圧ゲイン部である。図9は、図10における外乱抑圧制
御がない場合の適応繰り返し制御部のみを持つシステム
のブロック図である。
る速度繰り返し制御に外乱オブザーバ9による外乱抑圧
制御を加えた方式のブロック図である。図10は、図8
における速度繰り返し制御に外乱抑圧制御を加えた方式
において、制御系における速度変動の周期性の強弱によ
り繰り返し制御の繰り返し度と外乱抑圧ループの抑圧ゲ
インを適応的に変化させるようにしたシステムのブロッ
ク図である。同図において、22aは適応繰り返し制御
部で、24は後述の積分器26の出力に反比例してゲイ
ンが可変され繰り返し度合いを決定する繰り返しゲイン
部、25は速度変動の周期性の強弱を検出する周期性検
出部で、26は1次あるいは数次の積分器の出力の絶対
値を取った値を出力する積分器、27は積分器26の出
力に比例してゲインが可変され外乱抑圧を決める外乱抑
圧ゲイン部である。図9は、図10における外乱抑圧制
御がない場合の適応繰り返し制御部のみを持つシステム
のブロック図である。
【0016】上記のような構成の場合、周期という時間
を基準に装置を構成しているため、ベルトコンベアや包
装機械の運転速度を変更した場合、機械系が変わらない
にも関わらず周期を再設定するために制御装置を調整す
る必要があった。運転速度の変更は、装置の稼働状況に
よりしばしば実施されるため、無調整で同様の効果を得
る制御装置が望まれていた。
を基準に装置を構成しているため、ベルトコンベアや包
装機械の運転速度を変更した場合、機械系が変わらない
にも関わらず周期を再設定するために制御装置を調整す
る必要があった。運転速度の変更は、装置の稼働状況に
よりしばしば実施されるため、無調整で同様の効果を得
る制御装置が望まれていた。
【0017】本発明は上記の課題を解決するためになさ
れたもので、位置に依存した周期的な制御誤差や外乱を
高精度で抑えることができ、周期が変わっても制御装置
の調整を必要としない外乱補償制御装置を提供すること
を目的とする。
れたもので、位置に依存した周期的な制御誤差や外乱を
高精度で抑えることができ、周期が変わっても制御装置
の調整を必要としない外乱補償制御装置を提供すること
を目的とする。
【0018】
【課題を解決するための手段】第1の発明に係る外乱補
償制御装置は、追従目標と制御対象の出力情報との間の
制御誤差に基づいて上記制御対象を制御する制御ループ
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記制御ル
ープに入力する外乱抑圧手段と、上記制御対象の現在位
置における上記推定された外乱量をメモリに順次記憶
し、該メモリに各位置毎に記憶された情報を周期成分が
抑圧されるように上記制御ループに入力する繰り返し制
御手段とを具備したことを特徴とする。
償制御装置は、追従目標と制御対象の出力情報との間の
制御誤差に基づいて上記制御対象を制御する制御ループ
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記制御ル
ープに入力する外乱抑圧手段と、上記制御対象の現在位
置における上記推定された外乱量をメモリに順次記憶
し、該メモリに各位置毎に記憶された情報を周期成分が
抑圧されるように上記制御ループに入力する繰り返し制
御手段とを具備したことを特徴とする。
【0019】第2の発明に係る外乱補償制御装置は、追
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記繰り返
し制御手段を含む上記制御ループに入力する外乱抑圧手
段とを具備したことを特徴とする。
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記繰り返
し制御手段を含む上記制御ループに入力する外乱抑圧手
段とを具備したことを特徴とする。
【0020】第3の発明に係る外乱補償制御装置は、追
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記制御ル
ープ内の上記繰り返し制御手段を含まない位置に入力す
る外乱抑圧手段とを具備したことを特徴とする。
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記制御ル
ープ内の上記繰り返し制御手段を含まない位置に入力す
る外乱抑圧手段とを具備したことを特徴とする。
【0021】第4の発明に係る外乱補償制御装置は、追
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記メモリの記憶情報から周期的な位置依存性の強
弱を検出し、その強弱に応じて上記繰り返し制御手段に
よる補正ゲインを調整する手段とを具備したことを特徴
とする。
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記メモリの記憶情報から周期的な位置依存性の強
弱を検出し、その強弱に応じて上記繰り返し制御手段に
よる補正ゲインを調整する手段とを具備したことを特徴
とする。
【0022】第5の発明に係る外乱補償制御装置は、追
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記制御ル
ープ内の上記繰り返し制御手段を含まない位置に入力す
る外乱抑圧手段と、上記メモリの記憶情報から周期的な
位置依存性の強弱を検出し、その強弱に応じて上記繰り
返し制御手段による補正ゲインと上記外乱抑圧手段の推
定による補正ゲインを調整する調整手段とを具備したこ
とを特徴とする。
従目標と制御対象の出力情報との間の制御誤差に基づい
て上記制御対象を制御する制御ループと、上記制御対象
の現在位置における上記制御誤差をメモリに記憶し、該
メモリに各位置毎に記憶された情報を周期成分が抑圧さ
れるように上記制御ループに入力する繰り返し制御手段
と、上記制御対象に加わる外乱量を推定し、上記外乱量
が抑圧されるように上記推定された外乱量を上記制御ル
ープ内の上記繰り返し制御手段を含まない位置に入力す
る外乱抑圧手段と、上記メモリの記憶情報から周期的な
位置依存性の強弱を検出し、その強弱に応じて上記繰り
返し制御手段による補正ゲインと上記外乱抑圧手段の推
定による補正ゲインを調整する調整手段とを具備したこ
とを特徴とする。
【0023】
【発明の実施の形態】以下、図面を参照して本発明の実
施形態を説明する。 (第1実施形態)図1は、本発明の第1実施形態に係る
外乱補償制御装置を示すもので、外乱抑圧ループの位置
依存性を考慮し、周期的な位置に依存した外乱に対する
外乱抑圧度を改善する外乱繰り返し制御方式の構成例を
示したものである。図1において、8はモータトルク定
数Ktの逆数を表したもの、9は外乱オブザーバ、20
は速度制御ゲイン部、21はモータである。また、31
は繰り返し制御部で、積分器32及び位置アドレスに割
り付けたメモリθ0 〜θn を備え、このメモリθ0〜θ
n 内に繰り返し制御の安定性を保つために挿入される
アッテネータ(減衰器)及びフィルタ処理を受けたもの
を格納している。積分器32は、制御対象の出力速度を
積分して現在位置を求め、その現在位置に対する外乱推
定量をメモリθ0 〜θn に順次記憶する。なお、制御対
象の位置情報を直接繰り返し制御部31に入力するよう
にしても良く、この場合には積分器32が不要となる。
施形態を説明する。 (第1実施形態)図1は、本発明の第1実施形態に係る
外乱補償制御装置を示すもので、外乱抑圧ループの位置
依存性を考慮し、周期的な位置に依存した外乱に対する
外乱抑圧度を改善する外乱繰り返し制御方式の構成例を
示したものである。図1において、8はモータトルク定
数Ktの逆数を表したもの、9は外乱オブザーバ、20
は速度制御ゲイン部、21はモータである。また、31
は繰り返し制御部で、積分器32及び位置アドレスに割
り付けたメモリθ0 〜θn を備え、このメモリθ0〜θ
n 内に繰り返し制御の安定性を保つために挿入される
アッテネータ(減衰器)及びフィルタ処理を受けたもの
を格納している。積分器32は、制御対象の出力速度を
積分して現在位置を求め、その現在位置に対する外乱推
定量をメモリθ0 〜θn に順次記憶する。なお、制御対
象の位置情報を直接繰り返し制御部31に入力するよう
にしても良く、この場合には積分器32が不要となる。
【0024】上記図1において、速度制御ゲイン部20
及び制御対象を駆動するモータ21と、そのフィードバ
ック回路により制御ループを構成している。この制御ル
ープは、追従目標と制御対象の出力情報との間の制御誤
差に基づいてモータ21を制御する。また、外乱オブザ
ーバ9は、モータ21に加わる外乱量を推定し、上記外
乱量が抑圧されるように上記推定された外乱量を上記制
御ループに入力する。更に、繰り返し制御部31は、制
御対象の現在位置における上記推定された外乱量とメモ
リθ0 〜θn に記憶し、上記周期成分が抑圧されるよう
に上記位置毎に記憶された情報を上記制御ループに入力
する。
及び制御対象を駆動するモータ21と、そのフィードバ
ック回路により制御ループを構成している。この制御ル
ープは、追従目標と制御対象の出力情報との間の制御誤
差に基づいてモータ21を制御する。また、外乱オブザ
ーバ9は、モータ21に加わる外乱量を推定し、上記外
乱量が抑圧されるように上記推定された外乱量を上記制
御ループに入力する。更に、繰り返し制御部31は、制
御対象の現在位置における上記推定された外乱量とメモ
リθ0 〜θn に記憶し、上記周期成分が抑圧されるよう
に上記位置毎に記憶された情報を上記制御ループに入力
する。
【0025】外乱抑圧制御は、前記図13のような形で
実現できるが、モータに加わる外乱には、一般的に周期
的な外乱が入力されている場合が多い。これはモータの
軸摩擦変動やモータトルクリップル、回転部重心の軸中
心からのずれ、母機の機械系の周期的動作による負荷変
動等によって起因される外乱がモータの回転周期に対し
同期しているためである。そこで、これらの周期的な外
乱によって発生する周期的な位置に依存した速度変動を
抑圧するため、周期性外乱量や速度変動を繰り返し、こ
の繰り返した値を次の周期にフィードフォワードで加算
する。いわゆる繰り返し制御を応用することにより、周
期的な位置に依存した外乱入力による速度変動を従来の
外乱抑圧制御の場合より改善できる。
実現できるが、モータに加わる外乱には、一般的に周期
的な外乱が入力されている場合が多い。これはモータの
軸摩擦変動やモータトルクリップル、回転部重心の軸中
心からのずれ、母機の機械系の周期的動作による負荷変
動等によって起因される外乱がモータの回転周期に対し
同期しているためである。そこで、これらの周期的な外
乱によって発生する周期的な位置に依存した速度変動を
抑圧するため、周期性外乱量や速度変動を繰り返し、こ
の繰り返した値を次の周期にフィードフォワードで加算
する。いわゆる繰り返し制御を応用することにより、周
期的な位置に依存した外乱入力による速度変動を従来の
外乱抑圧制御の場合より改善できる。
【0026】図1に示した外乱補償制御装置は、上記し
たように外乱抑圧制御における外乱抑圧ループに繰り返
し制御部31を導入した場合である。時間基準ではなく
位置基準で繰り返し制御を行なっているので、母機の運
転速度を変更した場合も外乱抑圧効果を得るために周期
を変更する必要がない。一般的に繰り返し制御部におい
ては、繰り返し制御を導入した場合の制御系全体が安定
となるため、メモリの前後にフィルタ(遅れフィルタ)
やアッテネータを挿入するのが一般的で、この実施形態
における繰り返し制御部31では、これらをまとめてθ
0 〜θn としている。これらフィルタやアッテネータの
挿入により繰り返し制御を導入した制御系全体が安定化
されることは、前記特許第2566033号特許公報に
記載されているように理論的にも証明されている。しか
し、この繰り返し制御を図1のように外乱抑圧ループの
中に挿入する場合は、この外乱抑圧ループの安定性を考
えなくてはならない。
たように外乱抑圧制御における外乱抑圧ループに繰り返
し制御部31を導入した場合である。時間基準ではなく
位置基準で繰り返し制御を行なっているので、母機の運
転速度を変更した場合も外乱抑圧効果を得るために周期
を変更する必要がない。一般的に繰り返し制御部におい
ては、繰り返し制御を導入した場合の制御系全体が安定
となるため、メモリの前後にフィルタ(遅れフィルタ)
やアッテネータを挿入するのが一般的で、この実施形態
における繰り返し制御部31では、これらをまとめてθ
0 〜θn としている。これらフィルタやアッテネータの
挿入により繰り返し制御を導入した制御系全体が安定化
されることは、前記特許第2566033号特許公報に
記載されているように理論的にも証明されている。しか
し、この繰り返し制御を図1のように外乱抑圧ループの
中に挿入する場合は、この外乱抑圧ループの安定性を考
えなくてはならない。
【0027】ここにおいて、繰り返し制御部31がない
場合の外乱抑圧ループの安定性は以下のように考えられ
る。上記したように外乱オブザーバの帯域g rad/sec を
大きくすることが外乱抑圧性能を向上させるための方策
であることは言うまでもない。しかし、図13、図1に
おける外乱オブザーバシステムは、外部抑圧ループがフ
ィードフォワードで制御入力に戻っているため、正帰還
のループである。この正帰還のループが安定となるため
には、全ての周波数においてゲインが1以下でなければ
ならない。
場合の外乱抑圧ループの安定性は以下のように考えられ
る。上記したように外乱オブザーバの帯域g rad/sec を
大きくすることが外乱抑圧性能を向上させるための方策
であることは言うまでもない。しかし、図13、図1に
おける外乱オブザーバシステムは、外部抑圧ループがフ
ィードフォワードで制御入力に戻っているため、正帰還
のループである。この正帰還のループが安定となるため
には、全ての周波数においてゲインが1以下でなければ
ならない。
【0028】外乱抑圧能力を向上させる外乱オブザーバ
の性能を向上するには、 (1)外乱オブザーバの帯域を上げる。 (2)入力速度情報のノイズを下げる。 ことが考えられる。
の性能を向上するには、 (1)外乱オブザーバの帯域を上げる。 (2)入力速度情報のノイズを下げる。 ことが考えられる。
【0029】しかし、機械的部品で構成される速度検出
器のノイズや無駄時間を機械的な精度向上(歯数の増
大)で改善するのは大変難しく、コストアップや大きな
モータを必要とするため、電気的な方法により速度検出
器のノイズや無駄時間を除去する。
器のノイズや無駄時間を機械的な精度向上(歯数の増
大)で改善するのは大変難しく、コストアップや大きな
モータを必要とするため、電気的な方法により速度検出
器のノイズや無駄時間を除去する。
【0030】図1にように外乱抑圧ループに繰り返し制
御を導入する場合は、元々繰り返し制御がない場合の外
乱抑圧ループのオープンループ特性において、オープン
ループゲインが0dBよりも充分小さい周波数領域のみ
にフィルタで帯域制限するか、アッテネータで低域ゲイ
ンが1より小さくなるようにして、繰り返し制御部31
を導入後の外乱抑圧ループのオープンループゲインが全
ての周波数において0dBを越えないようにしなければ
ならない。
御を導入する場合は、元々繰り返し制御がない場合の外
乱抑圧ループのオープンループ特性において、オープン
ループゲインが0dBよりも充分小さい周波数領域のみ
にフィルタで帯域制限するか、アッテネータで低域ゲイ
ンが1より小さくなるようにして、繰り返し制御部31
を導入後の外乱抑圧ループのオープンループゲインが全
ての周波数において0dBを越えないようにしなければ
ならない。
【0031】なお、上記周波数的外乱に対する改善効果
は、繰り返し制御部31の中に挿入されたフィルタのカ
ットオフ周波数以下に限定され、また、アッテネータの
ゲインが1に近ければ近いほど改善効果は大きくなる
が、外乱抑圧ループの安定性が悪くなることは上述した
通りである。
は、繰り返し制御部31の中に挿入されたフィルタのカ
ットオフ周波数以下に限定され、また、アッテネータの
ゲインが1に近ければ近いほど改善効果は大きくなる
が、外乱抑圧ループの安定性が悪くなることは上述した
通りである。
【0032】上記第1実施形態によれば、位置に依存し
た周期的な制御誤差や外乱を高精度で抑えることがで
き、周期が変わっても制御装置の調整を必要としない外
乱補償制御装置を提供できる。
た周期的な制御誤差や外乱を高精度で抑えることがで
き、周期が変わっても制御装置の調整を必要としない外
乱補償制御装置を提供できる。
【0033】(第2実施形態)次に本発明の第2実施形
態について説明する。図2は、速度制御ループと外乱抑
圧ループの両方の周期的な位置依存性を考慮し、周期的
な外乱抑圧度や速度変動を改善する速度・外乱繰り返し
制御方式のブロック図で、前記第1実施形態の変形例を
示したものである。この第2実施形態では、速度制御ゲ
イン部20の前段に繰り返し制御部31を設け、この繰
り返し制御部31に速度誤差信号を入力している。そし
て、外乱オブザーバ9にて推定した外乱推定量をのゲイ
ン変換部23で速度制御ゲイン分の1にした後、外乱補
正ゲイン部8でモータトルク定数分の1にしてフィード
フォワードで戻し、速度誤差信号に加算して繰り返し制
御部31に入力している。
態について説明する。図2は、速度制御ループと外乱抑
圧ループの両方の周期的な位置依存性を考慮し、周期的
な外乱抑圧度や速度変動を改善する速度・外乱繰り返し
制御方式のブロック図で、前記第1実施形態の変形例を
示したものである。この第2実施形態では、速度制御ゲ
イン部20の前段に繰り返し制御部31を設け、この繰
り返し制御部31に速度誤差信号を入力している。そし
て、外乱オブザーバ9にて推定した外乱推定量をのゲイ
ン変換部23で速度制御ゲイン分の1にした後、外乱補
正ゲイン部8でモータトルク定数分の1にしてフィード
フォワードで戻し、速度誤差信号に加算して繰り返し制
御部31に入力している。
【0034】この第2実施形態においても、注意点、改
善効果等は、前記第1実施形態と同様であるので、その
詳細な説明は省略する。 (第3実施形態)次に本発明の第3実施形態について説
明する。
善効果等は、前記第1実施形態と同様であるので、その
詳細な説明は省略する。 (第3実施形態)次に本発明の第3実施形態について説
明する。
【0035】この第3実施形態は、速度制御ループの周
期的な位置依存性を考慮した速度繰り返し制御に外乱オ
ブザーバ9による外乱抑圧制御を加えた方式で、前記第
1実施形態の変形例を示したものである。
期的な位置依存性を考慮した速度繰り返し制御に外乱オ
ブザーバ9による外乱抑圧制御を加えた方式で、前記第
1実施形態の変形例を示したものである。
【0036】この第3実施形態では、速度制御ゲイン部
20の前段に繰り返し制御部31を設け、外乱オブザー
バ9にて推定した外乱推定量を外乱補正ゲイン部8でモ
ータトルク定数分の1にし、速度制御ゲイン部20の出
力に加算するように構成したものである。
20の前段に繰り返し制御部31を設け、外乱オブザー
バ9にて推定した外乱推定量を外乱補正ゲイン部8でモ
ータトルク定数分の1にし、速度制御ゲイン部20の出
力に加算するように構成したものである。
【0037】前記第1及び第2実施形態の場合は、外乱
抑圧ループ内に繰り返し制御部31を挿入したため外乱
抑圧ループの安定条件を満足する必要があったが、この
第3実施形態のように繰り返し制御部31が速度誤差情
報のみを考慮するように外乱抑圧ループの外に構成する
ことにより、外乱抑圧ループの安定条件を満足する必要
がない。ただし、外乱抑圧ループにおける推定外乱量を
考慮しているわけではないので、周期的な速度誤差が改
善されるシステムとなる。このように第3実施形態にお
ける繰り返し制御部31も、ローパスフィルタやアッテ
ネータとなるような構成として制御系全体を安定化させ
る。
抑圧ループ内に繰り返し制御部31を挿入したため外乱
抑圧ループの安定条件を満足する必要があったが、この
第3実施形態のように繰り返し制御部31が速度誤差情
報のみを考慮するように外乱抑圧ループの外に構成する
ことにより、外乱抑圧ループの安定条件を満足する必要
がない。ただし、外乱抑圧ループにおける推定外乱量を
考慮しているわけではないので、周期的な速度誤差が改
善されるシステムとなる。このように第3実施形態にお
ける繰り返し制御部31も、ローパスフィルタやアッテ
ネータとなるような構成として制御系全体を安定化させ
る。
【0038】上記外乱システムを採用することにより、
位置に依存した周期的な制御誤差や外乱を高精度で抑え
ることができ、周期が変わっても制御装置の調整を必要
としない外乱補償制御装置を提供できる。従って、ベル
トコンベアや包装機械のみならず、モータ自身のコギン
グトルクによる回転ムラをも大幅に除去することができ
る。
位置に依存した周期的な制御誤差や外乱を高精度で抑え
ることができ、周期が変わっても制御装置の調整を必要
としない外乱補償制御装置を提供できる。従って、ベル
トコンベアや包装機械のみならず、モータ自身のコギン
グトルクによる回転ムラをも大幅に除去することができ
る。
【0039】(第4実施形態)次に本発明の第4実施形
態について説明する。図4は、図3における速度繰り返
し制御において、制御系における速度変動の周期的な位
置依存性の強弱により、繰り返し度を適応的に変化させ
るようにしたものである。
態について説明する。図4は、図3における速度繰り返
し制御において、制御系における速度変動の周期的な位
置依存性の強弱により、繰り返し度を適応的に変化させ
るようにしたものである。
【0040】図4に示す実施形態では、追従目標と制御
対象の出力情報との間の制御誤差を適応繰り返し制御部
31aに入力し、この適応繰り返し制御部31aの出力
信号を速度制御ゲイン部20を介して取出し、モータ2
1を駆動している。
対象の出力情報との間の制御誤差を適応繰り返し制御部
31aに入力し、この適応繰り返し制御部31aの出力
信号を速度制御ゲイン部20を介して取出し、モータ2
1を駆動している。
【0041】また、上記適応繰り返し制御部31aは、
繰り返しゲイン部24を備えると共に、周期性検出部2
5が接続される。上記繰り返しゲイン部24は、後述す
る積分器26の出力に反比例してゲインが可変され繰り
返し度合を決定する。また、周期性検出部25は、速度
変動の周期的な位置依存性の強弱を検出するもので、1
次あるいは数次の積分器の出力の絶対値を取った値を出
力する積分器26を備えており、その検出信号を繰り返
しゲイン部24に出力する。
繰り返しゲイン部24を備えると共に、周期性検出部2
5が接続される。上記繰り返しゲイン部24は、後述す
る積分器26の出力に反比例してゲインが可変され繰り
返し度合を決定する。また、周期性検出部25は、速度
変動の周期的な位置依存性の強弱を検出するもので、1
次あるいは数次の積分器の出力の絶対値を取った値を出
力する積分器26を備えており、その検出信号を繰り返
しゲイン部24に出力する。
【0042】上記の構成において、ある時間から周期的
な位置依存型の外乱が無周期性になると、逆に適応繰り
返し制御部31aが誤差発生原因となる可能性が生じ
る。このため、この実施形態では、適応的に繰り返しゲ
インを変化させる繰り返しゲイン部24により周期性が
弱いときにゲインを下げて繰り返し周期が働かなくする
ことにより、周期性を外れても制御性能を低下させるこ
とがなくなる。
な位置依存型の外乱が無周期性になると、逆に適応繰り
返し制御部31aが誤差発生原因となる可能性が生じ
る。このため、この実施形態では、適応的に繰り返しゲ
インを変化させる繰り返しゲイン部24により周期性が
弱いときにゲインを下げて繰り返し周期が働かなくする
ことにより、周期性を外れても制御性能を低下させるこ
とがなくなる。
【0043】(第5実施形態)次に本発明の第5実施形
態について説明する。図5は、図3における速度繰り返
し制御に外乱抑圧制御を加えた方式において、制御系に
おける速度変動の周期的な位置依存性の強弱により、繰
り返し制御の繰り返し度と外乱抑圧ループの抑圧ゲイン
を適応的に変化させるようにしたものである。
態について説明する。図5は、図3における速度繰り返
し制御に外乱抑圧制御を加えた方式において、制御系に
おける速度変動の周期的な位置依存性の強弱により、繰
り返し制御の繰り返し度と外乱抑圧ループの抑圧ゲイン
を適応的に変化させるようにしたものである。
【0044】図5に示す実施形態では、追従目標と制御
対象の出力情報との間の制御誤差を適応繰り返し制御部
31aに入力し、この適応繰り返し制御部31aの出力
信号を速度制御ゲイン部20を介してモータ21に入力
している。そして、外乱オブザーバ9にて推定した外乱
推定量を外乱抑圧ゲイン部27を介して速度制御ゲイン
部20の出力に加算し、その加算出力をモータ21及び
外乱オブザーバ9に入力している。
対象の出力情報との間の制御誤差を適応繰り返し制御部
31aに入力し、この適応繰り返し制御部31aの出力
信号を速度制御ゲイン部20を介してモータ21に入力
している。そして、外乱オブザーバ9にて推定した外乱
推定量を外乱抑圧ゲイン部27を介して速度制御ゲイン
部20の出力に加算し、その加算出力をモータ21及び
外乱オブザーバ9に入力している。
【0045】上記適応繰り返し制御部31aは、繰り返
しゲイン部24を備えると共に、周期性検出部25が接
続される。上記繰り返しゲイン部24は、後述する積分
器26の出力に反比例してゲインが可変され繰り返し度
合を決定する。また、周期性検出部25は、速度変動の
周期的な位置依存性の強弱を検出するもので、1次ある
いは数次の積分器の出力の絶対値を取った値を出力する
積分器26を備えており、その検出信号を繰り返しゲイ
ン部24に出力する。また、外乱抑圧ゲイン部27は、
上記積分器26の出力に比例してゲインが可変され、外
乱抑圧度を決定する。
しゲイン部24を備えると共に、周期性検出部25が接
続される。上記繰り返しゲイン部24は、後述する積分
器26の出力に反比例してゲインが可変され繰り返し度
合を決定する。また、周期性検出部25は、速度変動の
周期的な位置依存性の強弱を検出するもので、1次ある
いは数次の積分器の出力の絶対値を取った値を出力する
積分器26を備えており、その検出信号を繰り返しゲイ
ン部24に出力する。また、外乱抑圧ゲイン部27は、
上記積分器26の出力に比例してゲインが可変され、外
乱抑圧度を決定する。
【0046】上記の構成において、周期性外乱入力時は
繰り返し制御により速度誤差がほぼ完全に抑圧され、無
周期性外乱入力時には外乱オブザーバ9によりある程度
抑圧されるため、ほぼ理想的なシステムを実現できる。
すなわち、繰り返し制御は、周期成分を高精度で抑える
ことができるが、無周期性分が多い場合には、この無周
期成分を記憶し、かえって制御誤差が増加してしまう。
つまり、周期性が高い場合には極めて効果的な反面、無
周期性が強くなると逆効果になる。一方、外乱オブザー
バ9による外乱抑圧制御は、繰り返し制御ほど抑圧効果
が高くない反面、周期性、無周期性に関係なく抑圧制御
が行なえる。従って、この2つの制御を適応的に用いる
ことにより、どのような制御システムにおいても最適な
外乱抑圧制御が行なえる外乱抑圧システムを実現でき
る。
繰り返し制御により速度誤差がほぼ完全に抑圧され、無
周期性外乱入力時には外乱オブザーバ9によりある程度
抑圧されるため、ほぼ理想的なシステムを実現できる。
すなわち、繰り返し制御は、周期成分を高精度で抑える
ことができるが、無周期性分が多い場合には、この無周
期成分を記憶し、かえって制御誤差が増加してしまう。
つまり、周期性が高い場合には極めて効果的な反面、無
周期性が強くなると逆効果になる。一方、外乱オブザー
バ9による外乱抑圧制御は、繰り返し制御ほど抑圧効果
が高くない反面、周期性、無周期性に関係なく抑圧制御
が行なえる。従って、この2つの制御を適応的に用いる
ことにより、どのような制御システムにおいても最適な
外乱抑圧制御が行なえる外乱抑圧システムを実現でき
る。
【0047】以上のような適応システムは、制御系がソ
フトウェア等のアルゴリズムにて構成されている場合、
ゲイン量が可変な繰り返しゲイン部24、外乱抑圧ゲイ
ン部27等も簡単に実現することができる。
フトウェア等のアルゴリズムにて構成されている場合、
ゲイン量が可変な繰り返しゲイン部24、外乱抑圧ゲイ
ン部27等も簡単に実現することができる。
【0048】この第5実施形態では、速度繰り返し制御
に外乱抑圧制御を加えた方式において、制御系の速度変
動の周期的な位置依存性の強弱により、繰り返し制御の
繰り返し度と外乱抑圧ループの抑圧ゲインを適応的に変
化させるようにしたので、どのような制御システムにお
いても最適な外乱抑圧制御が行な外乱抑圧システムを実
現でき、位置に依存した周期的な制御誤差や外乱を高精
度で抑えることができ、周期が変わっても制御装置の調
整を必要とせず、常に高い安定性を得ることができる。
に外乱抑圧制御を加えた方式において、制御系の速度変
動の周期的な位置依存性の強弱により、繰り返し制御の
繰り返し度と外乱抑圧ループの抑圧ゲインを適応的に変
化させるようにしたので、どのような制御システムにお
いても最適な外乱抑圧制御が行な外乱抑圧システムを実
現でき、位置に依存した周期的な制御誤差や外乱を高精
度で抑えることができ、周期が変わっても制御装置の調
整を必要とせず、常に高い安定性を得ることができる。
【0049】
【発明の効果】以上詳記したように本発明によれば、時
間基準でなく、位置基準で繰り返し制御を行なっている
ので、位置に依存した周期的な制御誤差や外乱を高精度
で抑えることができ、周期が変わっても制御装置の調整
を必要としない外乱補償制御装置を提供できる。従っ
て、ベルトコンベアや包装機械のみならず、モータ自身
のコギングトルクによる回転ムラをも大幅に除去するこ
とができる。
間基準でなく、位置基準で繰り返し制御を行なっている
ので、位置に依存した周期的な制御誤差や外乱を高精度
で抑えることができ、周期が変わっても制御装置の調整
を必要としない外乱補償制御装置を提供できる。従っ
て、ベルトコンベアや包装機械のみならず、モータ自身
のコギングトルクによる回転ムラをも大幅に除去するこ
とができる。
【図1】本発明の第1実施形態に係る外乱補償制御装置
の構成を示すブロック図。
の構成を示すブロック図。
【図2】本発明の第2実施形態に係る外乱補償制御装置
の構成を示すブロック図。
の構成を示すブロック図。
【図3】本発明の第3実施形態に係る外乱補償制御装置
の構成を示すブロック図。
の構成を示すブロック図。
【図4】本発明の第4実施形態に係る外乱補償制御装置
の構成を示すブロック図。
の構成を示すブロック図。
【図5】本発明の第5実施形態に係る外乱補償制御装置
の構成を示すブロック図。
の構成を示すブロック図。
【図6】従来の外乱量繰り返し型の外乱補償制御装置の
構成を示すブロック図。
構成を示すブロック図。
【図7】従来の速度誤差、外乱量繰り返し型の外乱補償
制御装置の構成を示すブロック図。
制御装置の構成を示すブロック図。
【図8】従来の速度誤差繰り返し制御に外乱抑圧制御を
組み合わせてなる外乱補償制御装置の構成を示すブロッ
ク図。
組み合わせてなる外乱補償制御装置の構成を示すブロッ
ク図。
【図9】従来の適応型繰り返し制御による外乱補償制御
装置の構成を示すブロック図。
装置の構成を示すブロック図。
【図10】従来の適応型繰り返し制御による外乱補償制
御装置の他の構成例を示すブロック図。
御装置の他の構成例を示すブロック図。
【図11】従来の外乱オブザーバの一般的表現となる最
小次元オブザーバを示すブロック図。
小次元オブザーバを示すブロック図。
【図12】従来の外乱補償制御装置の原理を示すブロッ
ク図。
ク図。
【図13】従来の外乱オブザーバによる外乱補償制御装
置を示すブロック図。
置を示すブロック図。
8 外乱補正ゲイン部 9 外乱オブザーバ 20 速度制御ゲイン部 21 モータ 23 ゲイン変換部 24 繰り返しゲイン部 25 周期性検出部 26 積分器 31 繰り返し制御部 31a 適応繰り返し制御部 32 積分器 θ0 〜θn メモリ
フロントページの続き (72)発明者 前川 明寛 兵庫県高砂市荒井町新浜2丁目1番1号 三菱重工業株式会社高砂研究所内
Claims (5)
- 【請求項1】 追従目標と制御対象の出力情報との間の
制御誤差に基づいて上記制御対象を制御する制御ループ
と、 上記制御対象に加わる外乱量を推定し、上記外乱量が抑
圧されるように上記推定された外乱量を上記制御ループ
に入力する外乱抑圧手段と、 上記制御対象の現在位置における上記推定された外乱量
をメモリに順次記憶し、該メモリに各位置毎に記憶され
た情報を周期成分が抑圧されるように上記制御ループに
入力する繰り返し制御手段とを具備したことを特徴とす
る外乱補償制御装置。 - 【請求項2】追従目標と制御対象の出力情報との間の制
御誤差に基づいて上記制御対象を制御する制御ループ
と、 上記制御対象の現在位置における上記制御誤差をメモリ
に記憶し、該メモリに各位置毎に記憶された情報を周期
成分が抑圧されるように上記制御ループに入力する繰り
返し制御手段と、 上記制御対象に加わる外乱量を推定し、上記外乱量が抑
圧されるように上記推定された外乱量を上記繰り返し制
御手段を含む上記制御ループに入力する外乱抑圧手段と
を具備したことを特徴とする外乱補償制御装置。 - 【請求項3】追従目標と制御対象の出力情報との間の制
御誤差に基づいて上記制御対象を制御する制御ループ
と、 上記制御対象の現在位置における上記制御誤差をメモリ
に記憶し、該メモリに各位置毎に記憶された情報を周期
成分が抑圧されるように上記制御ループに入力する繰り
返し制御手段と、 上記制御対象に加わる外乱量を推定し、上記外乱量が抑
圧されるように上記推定された外乱量を上記制御ループ
内の上記繰り返し制御手段を含まない位置に入力する外
乱抑圧手段とを具備したことを特徴とする外乱補償制御
装置。 - 【請求項4】追従目標と制御対象の出力情報との間の制
御誤差に基づいて上記制御対象を制御する制御ループ
と、 上記制御対象の現在位置における上記制御誤差をメモリ
に記憶し、該メモリに各位置毎に記憶された情報を周期
成分が抑圧されるように上記制御ループに入力する繰り
返し制御手段と、 上記メモリの記憶情報から周期的な位置依存性の強弱を
検出し、その強弱に応じて上記繰り返し制御手段による
補正ゲインを調整する手段とを具備したことを特徴とす
る外乱補償制御装置。 - 【請求項5】追従目標と制御対象の出力情報との間の制
御誤差に基づいて上記制御対象を制御する制御ループ
と、 上記制御対象の現在位置における上記制御誤差をメモリ
に記憶し、該メモリに各位置毎に記憶された情報を周期
成分が抑圧されるように上記制御ループに入力する繰り
返し制御手段と、 上記制御対象に加わる外乱量を推定し、上記外乱量が抑
圧されるように上記推定された外乱量を上記制御ループ
内の上記繰り返し制御手段を含まない位置に入力する外
乱抑圧手段と、 上記メモリの記憶情報から周期的な位置依存性の強弱を
検出し、その強弱に応じて上記繰り返し制御手段による
補正ゲインと上記外乱抑圧手段の推定による補正ゲイン
を調整する調整手段とを具備したことを特徴とする外乱
補償制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10081498A JPH11285283A (ja) | 1998-03-27 | 1998-03-27 | 外乱補償制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10081498A JPH11285283A (ja) | 1998-03-27 | 1998-03-27 | 外乱補償制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH11285283A true JPH11285283A (ja) | 1999-10-15 |
Family
ID=13748052
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP10081498A Withdrawn JPH11285283A (ja) | 1998-03-27 | 1998-03-27 | 外乱補償制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH11285283A (ja) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2002038332A1 (en) * | 2000-11-01 | 2002-05-16 | Mitsubishi Denki Kabushiki Kaisha | Servocontrol device |
JP2002199767A (ja) * | 2000-12-27 | 2002-07-12 | Aisin Seiki Co Ltd | 外乱補償制御装置 |
US7068001B2 (en) | 2004-07-29 | 2006-06-27 | Japan Servo Co., Ltd. | Motor control system |
JP2008137449A (ja) * | 2006-11-30 | 2008-06-19 | Nsk Ltd | 電動式ステアリング装置 |
JP2008137450A (ja) * | 2006-11-30 | 2008-06-19 | Nsk Ltd | 電動式ステアリング装置 |
JP2011234603A (ja) * | 2010-04-09 | 2011-11-17 | Canon Inc | 振動型アクチュエータの制御回路 |
WO2014088054A1 (ja) * | 2012-12-07 | 2014-06-12 | 株式会社明電舎 | 周期外乱自動抑制装置 |
WO2015115623A1 (ja) * | 2014-01-30 | 2015-08-06 | 株式会社明電舎 | 周期性外乱抑制制御装置 |
JP2016163370A (ja) * | 2015-02-26 | 2016-09-05 | 山洋電気株式会社 | モータ制御装置 |
WO2017126095A1 (ja) * | 2016-01-22 | 2017-07-27 | 東芝三菱電機産業システム株式会社 | 電動機の速度制御装置 |
CN110134010A (zh) * | 2019-04-17 | 2019-08-16 | 浙江工业大学 | 一种采用等效扰动补偿伺服***的幂次吸引重复控制方法 |
CN110716430A (zh) * | 2019-09-27 | 2020-01-21 | 浙江工业大学 | 一种采用等效扰动补偿的伺服***快速吸引重复控制方法 |
-
1998
- 1998-03-27 JP JP10081498A patent/JPH11285283A/ja not_active Withdrawn
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2002038332A1 (en) * | 2000-11-01 | 2002-05-16 | Mitsubishi Denki Kabushiki Kaisha | Servocontrol device |
GB2374683A (en) * | 2000-11-01 | 2002-10-23 | Mitsubishi Electric Corp | Servocontrol device |
GB2374683B (en) * | 2000-11-01 | 2004-08-11 | Mitsubishi Electric Corp | Servo control apparatus |
JP2002199767A (ja) * | 2000-12-27 | 2002-07-12 | Aisin Seiki Co Ltd | 外乱補償制御装置 |
US7068001B2 (en) | 2004-07-29 | 2006-06-27 | Japan Servo Co., Ltd. | Motor control system |
JP2008137449A (ja) * | 2006-11-30 | 2008-06-19 | Nsk Ltd | 電動式ステアリング装置 |
JP2008137450A (ja) * | 2006-11-30 | 2008-06-19 | Nsk Ltd | 電動式ステアリング装置 |
JP2011234603A (ja) * | 2010-04-09 | 2011-11-17 | Canon Inc | 振動型アクチュエータの制御回路 |
WO2014088054A1 (ja) * | 2012-12-07 | 2014-06-12 | 株式会社明電舎 | 周期外乱自動抑制装置 |
JP2014115746A (ja) * | 2012-12-07 | 2014-06-26 | Meidensha Corp | 周期外乱自動抑制装置 |
CN104838322A (zh) * | 2012-12-07 | 2015-08-12 | 株式会社明电舍 | 周期性扰动自动抑制设备 |
US9614474B2 (en) | 2012-12-07 | 2017-04-04 | Meidensha Corporation | Periodic disturbance automatic suppression device |
WO2015115623A1 (ja) * | 2014-01-30 | 2015-08-06 | 株式会社明電舎 | 周期性外乱抑制制御装置 |
CN105940353B (zh) * | 2014-01-30 | 2019-01-04 | 株式会社明电舍 | 周期性外部干扰抑制控制装置 |
CN105940353A (zh) * | 2014-01-30 | 2016-09-14 | 株式会社明电舍 | 周期性外部干扰抑制控制装置 |
JPWO2015115623A1 (ja) * | 2014-01-30 | 2017-03-23 | 株式会社明電舎 | 周期性外乱抑制制御装置 |
US10331094B2 (en) | 2014-01-30 | 2019-06-25 | Meidensha Corporation | Periodic external disturbance suppression control device |
JP2016163370A (ja) * | 2015-02-26 | 2016-09-05 | 山洋電気株式会社 | モータ制御装置 |
TWI626825B (zh) * | 2016-01-22 | 2018-06-11 | 日商東芝三菱電機產業系統股份有限公司 | 電動機的速度控制裝置 |
JPWO2017126095A1 (ja) * | 2016-01-22 | 2018-05-31 | 東芝三菱電機産業システム株式会社 | 電動機の速度制御装置 |
WO2017126095A1 (ja) * | 2016-01-22 | 2017-07-27 | 東芝三菱電機産業システム株式会社 | 電動機の速度制御装置 |
CN110134010A (zh) * | 2019-04-17 | 2019-08-16 | 浙江工业大学 | 一种采用等效扰动补偿伺服***的幂次吸引重复控制方法 |
CN110134010B (zh) * | 2019-04-17 | 2022-05-03 | 浙江工业大学 | 一种采用等效扰动补偿伺服***的幂次吸引重复控制方法 |
CN110716430A (zh) * | 2019-09-27 | 2020-01-21 | 浙江工业大学 | 一种采用等效扰动补偿的伺服***快速吸引重复控制方法 |
CN110716430B (zh) * | 2019-09-27 | 2022-05-03 | 浙江工业大学 | 一种采用等效扰动补偿的伺服***快速吸引重复控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101115698B1 (ko) | 전동기 제어 장치 | |
KR100645496B1 (ko) | 전동기의 위치제어장치 | |
US10985684B2 (en) | Motor control device | |
JPH11285283A (ja) | 外乱補償制御装置 | |
WO2007096993A1 (ja) | モータ制御装置 | |
KR100223393B1 (ko) | 모터속도제어장치 | |
EP0709952B1 (en) | Motor speed control apparatus | |
JPH05184178A (ja) | アクチュエータ制御装置 | |
KR20000048977A (ko) | 수치 제어되는 탄성 다중 매스 시스템의 모우먼트를 제어하기 위한 방법 및 제어 장치 | |
JP3970699B2 (ja) | モータ制御装置 | |
JP2566033B2 (ja) | 外乱抑圧制御システム | |
WO2005064781A1 (ja) | モータの制御装置 | |
JPH08336294A (ja) | サーボ制御装置 | |
JP2888595B2 (ja) | モータ制御装置 | |
JP3818237B2 (ja) | 同期電動機の制御装置 | |
JP2002325473A (ja) | 振動抑制装置 | |
JP3864305B2 (ja) | 位置制御装置 | |
JP3454942B2 (ja) | 位置制御装置 | |
JP3975537B2 (ja) | 制御装置と制御方法 | |
JP2001325006A (ja) | 位置決め時の騒音を低減する位置決め装置 | |
JP4078184B2 (ja) | ディスク装置およびその制御方法 | |
KR100794893B1 (ko) | 모터 제어 장치 | |
JP3266391B2 (ja) | 制御装置 | |
JP2001157478A (ja) | モータ制御装置 | |
JP2000311454A (ja) | ディスク装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20050607 |