JP2000148207A - 位置制御装置 - Google Patents
位置制御装置Info
- Publication number
- JP2000148207A JP2000148207A JP10323103A JP32310398A JP2000148207A JP 2000148207 A JP2000148207 A JP 2000148207A JP 10323103 A JP10323103 A JP 10323103A JP 32310398 A JP32310398 A JP 32310398A JP 2000148207 A JP2000148207 A JP 2000148207A
- Authority
- JP
- Japan
- Prior art keywords
- value
- speed
- controller
- disturbance
- estimated
- 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
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
を推定し補償することで、機構の速度変動及び位置変動
を抑制できるようにする。 【解決手段】 位置検出器6からの検出値のフィードバ
ックループに離散系カルマンフィルタ12と外乱推定器
13とを付加する。離散系カルマンフィルタは、前記検
出値から負荷5の位置及び速度を推定して位置推定値及
び速度推定値を出力する。外乱推定器は、トルク指令値
と速度推定値とから負荷に加わる外乱を推定する。位置
推定値を位置制御器1にフィードバックすると共に、速
度推定値を速度制御器2にフィードバックし、更に前記
速度制御器からのトルク目標値と前記推定された外乱と
の偏差を前記トルク指令値として出力する。
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の発生する微
分ノイズが大きい。
おいて機構に働く外乱トルクを推定し補償することで、
機構の速度変動及び位置変動を抑制できるようにするこ
とにある。
イズを除去し、高い周波数領域での外乱抑制特性の劣化
を防止することにある。
ル制御系におけるサンプリング周波数帯の観測ノイズ、
微分ノイズの影響を低減することにある。
駆動される被駆動体の位置を検出するための位置検出器
を備え、該位置検出器の検出値と該検出値から算出され
る速度値とをそれぞれ位置制御器と速度制御器にフィー
ドバックして、前記被駆動体の移動、位置決めを行うよ
うに、前記モータのフィードバック制御を行うフィード
バック制御系を備えた位置制御装置において、前記検出
値のフィードバックループに離散系カルマンフィルタと
外乱推定器とを付加し、前記離散系カルマンフィルタ
は、前記検出値から前記被駆動体の位置及び速度を推定
して位置推定値及び速度推定値を出力し、前記外乱推定
器は、トルク指令値と前記速度推定値とから前記被駆動
体に加わる外乱を推定し、前記位置推定値を前記位置制
御器にフィードバックすると共に、前記速度推定値を前
記速度制御器にフィードバックし、更に前記速度制御器
からのトルク目標値と前記推定された外乱との偏差を前
記トルク指令値として出力するようにしたことを特徴と
する。
記位置推定値との偏差を受けて速度指令値を出力し、前
記速度制御器は、前記速度指令値と前記速度推定値との
偏差を受けて前記トルク目標値を出力する。
実施の形態を説明する。図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で表される。
−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は次の数1で
表される。
の検出位置、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】 モータにより駆動される被駆動体の位置
を検出するための位置検出器を備え、該位置検出器の検
出値と該検出値から算出される速度値とをそれぞれ位置
制御器と速度制御器にフィードバックして、前記被駆動
体の移動、位置決めを行うように、前記モータのフィー
ドバック制御を行うフィードバック制御系を備えた位置
制御装置において、 前記検出値のフィードバックループに離散系カルマンフ
ィルタと外乱推定器とを付加し、 前記離散系カルマンフィルタは、前記検出値から前記被
駆動体の位置及び速度を推定して位置推定値及び速度推
定値を出力し、 前記外乱推定器は、トルク指令値と前記速度推定値とか
ら前記被駆動体に加わる外乱を推定し、 前記位置推定値を前記位置制御器にフィードバックする
と共に、前記速度推定値を前記速度制御器にフィードバ
ックし、更に前記速度制御器からのトルク目標値と前記
推定された外乱との偏差を前記トルク指令値として出力
するようにしたことを特徴とする位置制御装置。 - 【請求項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 true JP2000148207A (ja) | 2000-05-26 |
JP3292951B2 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 (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003189658A (ja) * | 2001-12-12 | 2003-07-04 | Yaskawa Electric Corp | 遅れ補償電動機制御装置 |
US6668202B2 (en) | 2001-11-21 | 2003-12-23 | Sumitomo Heavy Industries, Ltd. | Position control system and velocity control system for stage driving mechanism |
JP2004152008A (ja) * | 2002-10-30 | 2004-05-27 | Sodick Co Ltd | 状態観測器を備えた位置決め装置 |
WO2005026859A1 (ja) * | 2003-09-12 | 2005-03-24 | Kabushiki Kaisha Yaskawa Denki | 振動抑制フィルタの自動設定方法 |
JP2005174011A (ja) * | 2003-12-11 | 2005-06-30 | Ricoh Co Ltd | 捩り振動系制御装置 |
WO2014091840A1 (ja) * | 2012-12-11 | 2014-06-19 | 三菱電機株式会社 | サーボ制御装置 |
JPWO2013088533A1 (ja) * | 2011-12-14 | 2015-04-27 | 株式会社安川電機 | モータ制御装置及びモータシステム |
JP2017041248A (ja) * | 2015-08-20 | 2017-02-23 | 三菱電機株式会社 | サーボ制御装置 |
JP2018041149A (ja) * | 2016-09-05 | 2018-03-15 | オムロン株式会社 | モデル予測制御装置、モデル予測制御装置の制御方法、情報処理プログラム、および記録媒体 |
JP2021027744A (ja) * | 2019-08-07 | 2021-02-22 | 日本精工株式会社 | モータ制御装置、モータ制御方法および電動パワーステアリング装置 |
CN113460709A (zh) * | 2020-03-30 | 2021-10-01 | 住友重机械工业株式会社 | 线性马达输送系统及其运用方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109188908B (zh) * | 2018-09-25 | 2021-02-26 | 浙江工业大学 | 基于指数型无切换吸引律的数字控制器设计方法 |
-
1998
- 1998-11-13 JP JP32310398A patent/JP3292951B2/ja not_active Expired - Fee Related
Cited By (14)
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 | 状態観測器を備えた位置決め装置 |
WO2005026859A1 (ja) * | 2003-09-12 | 2005-03-24 | Kabushiki Kaisha Yaskawa Denki | 振動抑制フィルタの自動設定方法 |
US7532951B2 (en) | 2003-09-12 | 2009-05-12 | Kabushiki Kaisha Yaskawa Denki | Method of automatically setting vibration suppression filter |
JP2005174011A (ja) * | 2003-12-11 | 2005-06-30 | Ricoh Co Ltd | 捩り振動系制御装置 |
JPWO2013088533A1 (ja) * | 2011-12-14 | 2015-04-27 | 株式会社安川電機 | モータ制御装置及びモータシステム |
WO2014091840A1 (ja) * | 2012-12-11 | 2014-06-19 | 三菱電機株式会社 | サーボ制御装置 |
JPWO2014091840A1 (ja) * | 2012-12-11 | 2017-01-05 | 三菱電機株式会社 | サーボ制御装置 |
JP2017041248A (ja) * | 2015-08-20 | 2017-02-23 | 三菱電機株式会社 | サーボ制御装置 |
JP2018041149A (ja) * | 2016-09-05 | 2018-03-15 | オムロン株式会社 | モデル予測制御装置、モデル予測制御装置の制御方法、情報処理プログラム、および記録媒体 |
JP2021027744A (ja) * | 2019-08-07 | 2021-02-22 | 日本精工株式会社 | モータ制御装置、モータ制御方法および電動パワーステアリング装置 |
JP7363176B2 (ja) | 2019-08-07 | 2023-10-18 | 日本精工株式会社 | モータ制御装置、モータ制御方法および電動パワーステアリング装置 |
CN113460709A (zh) * | 2020-03-30 | 2021-10-01 | 住友重机械工业株式会社 | 线性马达输送系统及其运用方法 |
Also Published As
Publication number | Publication date |
---|---|
JP3292951B2 (ja) | 2002-06-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6668202B2 (en) | Position control system and velocity control system for stage driving mechanism | |
US6564110B1 (en) | Position controlling apparatus capable of reducing the effect of disturbance | |
JP3302235B2 (ja) | 電動機の位置制御装置 | |
US6274994B2 (en) | Servo control apparatus | |
US8040098B2 (en) | Position controller | |
JP3796261B1 (ja) | モータの負荷イナーシャ推定方法 | |
JP4767315B2 (ja) | 電動パワーステアリング制御装置 | |
EP2157489B1 (en) | Motor Control System | |
JP3292951B2 (ja) | 位置制御装置 | |
JP4685071B2 (ja) | モータ制御装置及びモータ制御方法 | |
EP1560325A1 (en) | Position controller of motor | |
JP3298069B2 (ja) | ステージの位置制御装置及び速度制御装置 | |
JP2008091856A (ja) | 電子部品搭載装置 | |
JP2006215626A (ja) | 位置制御装置 | |
WO2006011203A1 (ja) | 位置制御装置及びその制御方法 | |
JPH09282008A (ja) | サーボ制御装置 | |
CN111587530A (zh) | 电动机的控制装置 | |
JPH1131014A (ja) | 位置制御方式及び速度制御方式 | |
JP3511942B2 (ja) | モータの制御装置 | |
EP3739748A1 (en) | Control device for electric motor | |
JPH05252779A (ja) | ロボットのサーボ制御装置 | |
JP3247295B2 (ja) | サーボ装置 | |
JP2004288012A (ja) | モータの位置制御装置 | |
JP2959270B2 (ja) | 外乱推定補償器 | |
JP2003271246A (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 |