JP3292951B2 - 位置制御装置 - Google Patents
位置制御装置Info
- Publication number
- JP3292951B2 JP3292951B2 JP32310398A JP32310398A JP3292951B2 JP 3292951 B2 JP3292951 B2 JP 3292951B2 JP 32310398 A JP32310398 A JP 32310398A JP 32310398 A JP32310398 A JP 32310398A JP 3292951 B2 JP3292951 B2 JP 3292951B2
- Authority
- JP
- Japan
- Prior art keywords
- value
- torque
- speed
- estimated
- controller
- 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.)
- Expired - Fee Related
Links
Landscapes
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Description
位置決めする装置の速度制御及び位置制御に適した位置
制御装置に関する。
参照して説明する。この位置制御装置は、位置制御器
1、速度制御器2、モータドライバ3、制御対象である
負荷5を駆動するためのモータ4、パルスエンコーダの
ような位置検出器6、速度演算器7、減算器8及び9を
含んでいる。負荷5は、例えば被加工物をX−Y方向に
移動させるためのX−Yテーブルであり、この場合、モ
ータ4はサーボモータが適している。
が位置検出器6で計測される。速度演算器7は位置検出
値から速度検出値を演算する。減算器8は位置指令値か
ら位置検出値を減じ位置偏差を演算する。位置制御器1
は、位置偏差を増幅し速度指令値を算出する。減算器9
は速度指令値から速度検出値を減じ速度偏差を演算す
る。速度制御器2は、速度偏差を増幅しトルク指令値を
算出する。算出されたトルク指令値は、モータドライバ
3へ入力されモータ4を駆動する。
中の記号GP (z)は位置制御器1の伝達関数であり、
Gv (z)は速度制御器2の伝達関数、Kt はモータ4
のトルク定数、(1/Js 2 )は制御対象の伝達関数、
(1−z-1)は速度演算器7の伝達関数である。
クτm と外乱トルクdの和によって駆動されるため、位
置決め時に誤差を生じる原因となる。このような外乱に
よる誤差を低減するには、位置制御器1及び速度制御器
2を調整する以外の手段がない。このため、目的とする
外乱抑制効果を得るため位置制御器1及び速度制御器2
のゲインを高くすると、制御対象の持つ機械的振動ある
いは位置制御器1及び速度制御器2の演算時間による位
相遅れにより制御システムが不安定になりやすい。
ズが含まれる。この観測ノイズ自体によって位置決め時
に誤差を生じる原因となる。更に、位置制御器1及び速
度制御器2のゲインを高くした場合のシステム不安定化
の原因になる。特に、ディジタル制御系ではサンプリン
グ周波数帯の量子化ノイズ、速度演算器7の発生する微
分ノイズが大きい。
おいて機構に働く外乱トルクを推定し補償することで、
機構の速度変動及び位置変動を抑制できるようにするこ
とにある。
イズを除去し、高い周波数領域での外乱抑制特性の劣化
を防止することにある。
ル制御系におけるサンプリング周波数帯の観測ノイズ、
微分ノイズの影響を低減することにある。
駆動される被駆動体の位置を検出するための位置検出器
を備え、該位置検出器の位置検出値と該位置検出値から
算出される速度値とをそれぞれ位置制御器と速度制御器
にフィードバックして、前記被駆動体の移動、位置決め
を行うように、前記モータのフィードバック制御を行う
フィードバック制御系を備えた位置制御装置において、
前記位置検出値のフィードバックループに離散系カルマ
ンフィルタと外乱推定器とを付加し、前記離散系カルマ
ンフィルタは、以下の数2に基づいて前記位置検出値の
みから前記被駆動体の位置及び速度を推定して位置推定
値及び速度推定値を出力し、
ep (k)はサンプリングk番目の位置推定値、x
ev (k)はサンプリングk番目の速度推定値であり、 前
記外乱推定器は、[K t z -1 N 0 (1+z -1 )/(D 0
−D 1 z -1 )]で規定されるモータトルクモデルのフィ
ルタと、[J n T s N 0 (1−z -1 )/2(D 0 −D 1
z -1 )]で規定される制御対象逆モデルのフィルタと、
(1/K t )で規定されるモータトルク逆モデルと、減
算器とを含んで、前記速度推定値x ev に前記制御対象逆
モデルを乗算することにより制御対象に加わる推定外力
を算出すると共に、モータトルク指令値に前記モータト
ルクモデルを乗算することによりモータトルク推定値を
算出し、続いて前記減算器により前記推定外力と前記モ
ータトルク推定値との差を算出して推定外乱トルクを算
出した後、該推定外乱トルクに前記モータトルク逆モデ
ルを乗算して推定トルクを算出し、前記位置推定値を前
記位置制御器にフィードバックすると共に、前記速度推
定値を前記速度制御器にフィードバックし、更に前記速
度制御器からのトルク目標値と前記推定トルクとの偏差
を前記トルク指令値として出力するようにしたことを特
徴とする。
記位置推定値との偏差を受けて速度指令値を出力し、前
記速度制御器は、前記速度指令値と前記速度推定値との
偏差を受けて前記トルク目標値を出力する。
実施の形態を説明する。図1において、図3と同じ部分
には同一番号を付して説明は省略する。本形態において
は、位置検出値のフィードバックラインに離散系カルマ
ンフィルタ12と外乱推定器13及び減算器14を設け
た点に特徴を有する。
位置推定値xep及び速度推定値xevを算出する。減算器
8は、位置指令値から位置推定値を減じ位置偏差を演算
する。位置制御器1は、位置偏差を増幅し速度指令値を
算出する。減算器9は速度指令値から速度推定値を減じ
速度偏差を演算する。速度制御器2は、速度偏差を増幅
しトルク目標値を算出する。
定値xevより制御対象へ加わる外乱を推定する。減算器
14はトルク目標値から外乱推定値iedを減じトルク指
令値を算出する。算出されたトルク指令値τc はモータ
ドライバ3へ入力され、モータ4を駆動する。
において、カルマンフィルタ12は、z-1で規定される
1サンプル遅れ要素15、16、Ts で規定されるサン
プル時間17、加算器18、19、K1 、K2 で規定さ
れるカルマンフィルタゲイン20、21で表される。
( 1+z-1) ]/(D0 −D1 z-1)で規定されるモー
タトルクモデルフィルタ23、[Jn Ts N0 ( 1−z
-1) ]/2(D0 −D1 z-1)で規定される制御対象逆
モデルフィルタ24、(1/Kt )で規定されるモータ
トルク逆モデル25、減算器26で表される。
まれる観測ノイズは、互いに独立な正規分布に従う白色
ノイズであると考えられる。このような場合の制御対象
の状態量(位置及び速度)は、カルマンフィルタ12に
よって推定できる。カルマンフィルタ12は次の数3で
表される。
の検出位置、xep(k)はサンプリングk番目の推定位
置、xev(k)はサンプリングk番目の推定速度、Ts
はサンプリング時間である。カルマンフィルタ12は検
出位置と推定位置を比較し、その結果である推定誤差を
フィードバックすることで、制御対象の真の位置と推定
位置との誤差を小さくするように働く。カルマンフィル
タゲインK1 (20)及びカルマンフィルタゲインK2
(21)は、制御対象の真の位置と推定位置との誤差の
2乗平均値が最小になるように決定する。ディジタル制
御系における量子化ノイズ及び微分ノイズはサンプリン
グ周波数及びその高調波で生じるが、カルマンフィルタ
12はこれら観測ノイズを除去し制御対象の位置及び速
度を推定する。
る。カルマンフィルタ12によって推定された制御対象
速度推定値xevは、制御対象にモータトルクτm と外乱
トルクdが加わった場合の推定状態量である。この速度
推定値xevに制御対象逆モデル(24)を乗じると、制
御対象に加わる推定外力(τem+de )が算出される。
また、モータトルク指令値ic にモータトルクモデル
(23)を乗じるとモータトルク推定値τemが推定され
る。減算器26によって両者の差分をとり、外乱トルク
de を推定する。このとき、外乱力推定帯域を制限する
ため、制御対象逆モデル(24)及びモータトルクモデ
ル(23)には、ローパスフィルタ特性を持たせる。推
定外乱トルクde にモータトルク逆モデル(25)を乗
じて推定トルクiedを算出し、この値を減算器14にお
いてモータトルク目標値ir から減じて外乱トルク分を
キャンセルし、モータトルク指令値ic とする。
直線運動制御系の位置制御装置に適しているが、回転運
動系の位置制御装置にも適用できることは言うまでもな
い。
フィルタにより得られた速度推定値を用いて外乱推定器
による外乱オブザーバによって演算した推定外乱トルク
をトルク目標値から減算することによって外乱をキャン
セルし、トルク指令値を算出する。このトルク指令値に
よって制御対象を駆動するので外乱の影響を小さくでき
る。
度制御器と独立に構成されているので、位置制御器及び
速度制御器のゲイン設定を変更せずに外乱抑圧のみが行
え、全体制御系を不安定化しない。
ィードバック量としてカルマンフィルタによって観測ノ
イズを除去した位置推定値及び速度推定値を用いるた
め、位置制御器及び速度制御器のゲインを高くしたり、
あるいは外乱オブザーバの応答帯域を高くしても制御シ
ステムが不安定になりにくい。
示したブロック図である。
ブロック図である。
Claims (2)
- 【請求項1】 モータにより駆動される被駆動体の位置
を検出するための位置検出器を備え、該位置検出器の位
置検出値と該位置検出値から算出される速度値とをそれ
ぞれ位置制御器と速度制御器にフィードバックして、前
記被駆動体の移動、位置決めを行うように、前記モータ
のフィードバック制御を行うフィードバック制御系を備
えた位置制御装置において、 前記位置検出値のフィードバックループに離散系カルマ
ンフィルタと外乱推定器とを付加し、 前記離散系カルマンフィルタは、以下の数1に基づいて
前記位置検出値のみから前記被駆動体の位置及び速度を
推定して位置推定値及び速度推定値を出力し、 【数1】 但し、x m (k)はサンプリングk番目の検出位置、x
ep (k)はサンプリングk番目の位置推定値、x
ev (k)はサンプリングk番目の速度推定値であり、 前記外乱推定器は、[K t z -1 N 0 (1+z -1 )/(D
0 −D 1 z -1 )]で規定されるモータトルクモデルのフ
ィルタと、[J n T s N 0 (1−z -1 )/2(D 0 −D
1 z -1 )]で規定される制御対象逆モデルのフィルタ
と、(1/K t )で規定されるモータトルク逆モデル
と、減算器とを含んで、前記速度推定値x ev に前記制御
対象逆モデルを乗算することにより制御対象に加わる推
定外力を算出すると共に、モータトルク指令値に前記モ
ータトルクモデルを乗算することによりモータトルク推
定値を算出し、続いて前記減算器により前記推定外力と
前記モータトルク推定値との差を算出して推定外乱トル
クを算出した後、該推定外乱トルクに前記モータトルク
逆モデルを乗算して推定トルクを算出し、 前記位置推定値を前記位置制御器にフィードバックする
と共に、前記速度推定値を前記速度制御器にフィードバ
ックし、更に前記速度制御器からのトルク目標値と前記
推定トルクとの偏差を前記トルク指令値として出力する
ようにしたことを特徴とする位置制御装置。 - 【請求項2】 請求項1記載の位置制御装置において、
前記位置制御器は、位置指令値と前記位置推定値との偏
差を受けて速度指令値を出力し、前記速度制御器は、前
記速度指令値と前記速度推定値との偏差を受けて前記ト
ルク目標値を出力することを特徴とする位置制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP32310398A JP3292951B2 (ja) | 1998-11-13 | 1998-11-13 | 位置制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP32310398A JP3292951B2 (ja) | 1998-11-13 | 1998-11-13 | 位置制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2000148207A JP2000148207A (ja) | 2000-05-26 |
JP3292951B2 true JP3292951B2 (ja) | 2002-06-17 |
Family
ID=18151121
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP32310398A Expired - Fee Related JP3292951B2 (ja) | 1998-11-13 | 1998-11-13 | 位置制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3292951B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109188908A (zh) * | 2018-09-25 | 2019-01-11 | 浙江工业大学 | 基于指数型无切换吸引律的数字控制器设计方法 |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6668202B2 (en) | 2001-11-21 | 2003-12-23 | Sumitomo Heavy Industries, Ltd. | Position control system and velocity control system for stage driving mechanism |
JP2003189658A (ja) * | 2001-12-12 | 2003-07-04 | Yaskawa Electric Corp | 遅れ補償電動機制御装置 |
JP2004152008A (ja) * | 2002-10-30 | 2004-05-27 | Sodick Co Ltd | 状態観測器を備えた位置決め装置 |
JP2005092297A (ja) * | 2003-09-12 | 2005-04-07 | Yaskawa Electric Corp | 振動抑制フィルタの自動設定方法 |
JP4220366B2 (ja) * | 2003-12-11 | 2009-02-04 | 株式会社リコー | 捩り振動系制御装置 |
WO2013088533A1 (ja) * | 2011-12-14 | 2013-06-20 | 株式会社安川電機 | モータ制御装置及びモータシステム |
JP6091523B2 (ja) * | 2012-12-11 | 2017-03-08 | 三菱電機株式会社 | サーボ制御装置 |
JP6931980B2 (ja) * | 2015-08-20 | 2021-09-08 | 三菱電機株式会社 | サーボ制御装置 |
JP6859633B2 (ja) * | 2016-09-05 | 2021-04-14 | オムロン株式会社 | モデル予測制御装置、モデル予測制御装置の制御方法、情報処理プログラム、および記録媒体 |
JP7363176B2 (ja) * | 2019-08-07 | 2023-10-18 | 日本精工株式会社 | モータ制御装置、モータ制御方法および電動パワーステアリング装置 |
CN113460709A (zh) * | 2020-03-30 | 2021-10-01 | 住友重机械工业株式会社 | 线性马达输送系统及其运用方法 |
-
1998
- 1998-11-13 JP JP32310398A patent/JP3292951B2/ja not_active Expired - Fee Related
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109188908A (zh) * | 2018-09-25 | 2019-01-11 | 浙江工业大学 | 基于指数型无切换吸引律的数字控制器设计方法 |
CN109188908B (zh) * | 2018-09-25 | 2021-02-26 | 浙江工业大学 | 基于指数型无切换吸引律的数字控制器设计方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2000148207A (ja) | 2000-05-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6564110B1 (en) | Position controlling apparatus capable of reducing the effect of disturbance | |
JP3292951B2 (ja) | 位置制御装置 | |
US6668202B2 (en) | Position control system and velocity control system for stage driving mechanism | |
US6274994B2 (en) | Servo control apparatus | |
JP3796261B1 (ja) | モータの負荷イナーシャ推定方法 | |
EP2157489B1 (en) | Motor Control System | |
US8040098B2 (en) | Position controller | |
US6211636B1 (en) | Pressing machine and motor torque control method in pressing machine | |
EP1560325A1 (en) | Position controller of motor | |
JP3298069B2 (ja) | ステージの位置制御装置及び速度制御装置 | |
JPH09282008A (ja) | サーボ制御装置 | |
JPH06284762A (ja) | 電動機の速度制御装置 | |
JP3511942B2 (ja) | モータの制御装置 | |
JPH05252779A (ja) | ロボットのサーボ制御装置 | |
CN111566928A (zh) | 电动机的控制装置 | |
JPH08278821A (ja) | サーボ制御系の制振方法 | |
JP3220589B2 (ja) | メカニカルシステムの制御装置 | |
JP2000353002A (ja) | 制御方法およびその装置 | |
JP3235112B2 (ja) | モータ制御装置 | |
JP3247295B2 (ja) | サーボ装置 | |
JP2798217B2 (ja) | 高速位置決め制御方法 | |
JP2959270B2 (ja) | 外乱推定補償器 | |
JP3348240B2 (ja) | デジタルフィルタと、サーボモータ制御装置 | |
JP2003271246A (ja) | 速度制御装置 | |
JPH02219485A (ja) | 電動機の回転速度制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20011003 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20020220 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080405 Year of fee payment: 6 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090405 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090405 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100405 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100405 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110405 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120405 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120405 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130405 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130405 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140405 Year of fee payment: 12 |
|
LAPS | Cancellation because of no payment of annual fees |