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
Application number
JP32310398A
Other languages
English (en)
Other versions
JP2000148207A (ja
Inventor
健一 牧野
英彦 森
良幸 冨田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sumitomo Heavy Industries Ltd
Original Assignee
Sumitomo Heavy Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Sumitomo Heavy Industries Ltd filed Critical Sumitomo Heavy Industries Ltd
Priority to JP32310398A priority Critical patent/JP3292951B2/ja
Publication of JP2000148207A publication Critical patent/JP2000148207A/ja
Application granted granted Critical
Publication of JP3292951B2 publication Critical patent/JP3292951B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、対象物を移動及び
位置決めする装置の速度制御及び位置制御に適した位置
制御装置に関する。
【0002】
【従来の技術】一般的な位置制御装置について、図3を
参照して説明する。この位置制御装置は、位置制御器
1、速度制御器2、モータドライバ3、制御対象である
負荷5を駆動するためのモータ4、パルスエンコーダの
ような位置検出器6、速度演算器7、減算器8及び9を
含んでいる。負荷5は、例えば被加工物をX−Y方向に
移動させるためのX−Yテーブルであり、この場合、モ
ータ4はサーボモータが適している。
【0003】作用について説明すると、制御対象の変位
が位置検出器6で計測される。速度演算器7は位置検出
値から速度検出値を演算する。減算器8は位置指令値か
ら位置検出値を減じ位置偏差を演算する。位置制御器1
は、位置偏差を増幅し速度指令値を算出する。減算器9
は速度指令値から速度検出値を減じ速度偏差を演算す
る。速度制御器2は、速度偏差を増幅しトルク指令値を
算出する。算出されたトルク指令値は、モータドライバ
3へ入力されモータ4を駆動する。
【0004】図4は、図3のブロック線図を示す。図4
中の記号GP (z)は位置制御器1の伝達関数であり、
v (z)は速度制御器2の伝達関数、Kt はモータ4
のトルク定数、(1/Js 2 )は制御対象の伝達関数、
(1−z-1)は速度演算器7の伝達関数である。
【0005】
【発明が解決しようとする課題】制御対象はモータトル
クτm と外乱トルクdの和によって駆動されるため、位
置決め時に誤差を生じる原因となる。このような外乱に
よる誤差を低減するには、位置制御器1及び速度制御器
2を調整する以外の手段がない。このため、目的とする
外乱抑制効果を得るため位置制御器1及び速度制御器2
のゲインを高くすると、制御対象の持つ機械的振動ある
いは位置制御器1及び速度制御器2の演算時間による位
相遅れにより制御システムが不安定になりやすい。
【0006】また、制御対象の位置検出値には観測ノイ
ズが含まれる。この観測ノイズ自体によって位置決め時
に誤差を生じる原因となる。更に、位置制御器1及び速
度制御器2のゲインを高くした場合のシステム不安定化
の原因になる。特に、ディジタル制御系ではサンプリン
グ周波数帯の量子化ノイズ、速度演算器7の発生する微
分ノイズが大きい。
【0007】そこで、本発明の課題は、位置制御装置に
おいて機構に働く外乱トルクを推定し補償することで、
機構の速度変動及び位置変動を抑制できるようにするこ
とにある。
【0008】本発明の他の課題は、位置検出時の観測ノ
イズを除去し、高い周波数領域での外乱抑制特性の劣化
を防止することにある。
【0009】本発明の更に他の課題は、特に、ディジタ
ル制御系におけるサンプリング周波数帯の観測ノイズ、
微分ノイズの影響を低減することにある。
【0010】
【課題を解決するための手段】本発明は、モータにより
駆動される被駆動体の位置を検出するための位置検出器
を備え、該位置検出器の位置検出値と該位置検出値から
算出される速度値とをそれぞれ位置制御器と速度制御器
にフィードバックして、前記被駆動体の移動、位置決め
を行うように、前記モータのフィードバック制御を行う
フィードバック制御系を備えた位置制御装置において、
前記位置検出値のフィードバックループに離散系カルマ
ンフィルタと外乱推定器とを付加し、前記離散系カルマ
ンフィルタは、以下の数2に基づいて前記位置検出値
から前記被駆動体の位置及び速度を推定して位置推定
値及び速度推定値を出力し、
【数2】 但し、x m (k)はサンプリングk番目の検出位置、x
ep (k)はサンプリングk番目の位置推定値、x
ev (k)はサンプリングk番目の速度推定値であり、
記外乱推定器は、[K t -1 0 (1+z -1 )/(D 0
−D 1 -1 )]で規定されるモータトルクモデルのフィ
ルタと、[J n s 0 (1−z -1 )/2(D 0 −D 1
-1 )]で規定される制御対象逆モデルのフィルタと、
(1/K t )で規定されるモータトルク逆モデルと、減
算器とを含んで、前記速度推定値x ev に前記制御対象逆
モデルを乗算することにより制御対象に加わる推定外力
を算出すると共に、モータトルク指令値に前記モータト
ルクモデルを乗算することによりモータトルク推定値を
算出し、続いて前記減算器により前記推定外力と前記モ
ータトルク推定値との差を算出して推定外乱トルクを算
出した後、該推定外乱トルクに前記モータトルク逆モデ
ルを乗算して推定トルクを算出し、前記位置推定値を前
記位置制御器にフィードバックすると共に、前記速度推
定値を前記速度制御器にフィードバックし、更に前記速
度制御器からのトルク目標値と前記推定トルクとの偏差
を前記トルク指令値として出力するようにしたことを特
徴とする。
【0011】なお、前記位置制御器は、位置指令値と前
記位置推定値との偏差を受けて速度指令値を出力し、前
記速度制御器は、前記速度指令値と前記速度推定値との
偏差を受けて前記トルク目標値を出力する。
【0012】
【発明の実施の形態】図1、図2を参照して、本発明の
実施の形態を説明する。図1において、図3と同じ部分
には同一番号を付して説明は省略する。本形態において
は、位置検出値のフィードバックラインに離散系カルマ
ンフィルタ12と外乱推定器13及び減算器14を設け
た点に特徴を有する。
【0013】カルマンフィルタ12は、位置検出値より
位置推定値xep及び速度推定値xevを算出する。減算器
8は、位置指令値から位置推定値を減じ位置偏差を演算
する。位置制御器1は、位置偏差を増幅し速度指令値を
算出する。減算器9は速度指令値から速度推定値を減じ
速度偏差を演算する。速度制御器2は、速度偏差を増幅
しトルク目標値を算出する。
【0014】外乱推定器13は、トルク指令値と速度推
定値xevより制御対象へ加わる外乱を推定する。減算器
14はトルク目標値から外乱推定値iedを減じトルク指
令値を算出する。算出されたトルク指令値τc はモータ
ドライバ3へ入力され、モータ4を駆動する。
【0015】図2は、図1のブロック線図を示す。図2
において、カルマンフィルタ12は、z-1で規定される
1サンプル遅れ要素15、16、Ts で規定されるサン
プル時間17、加算器18、19、K1 、K2 で規定さ
れるカルマンフィルタゲイン20、21で表される。
【0016】また、外乱推定器13は、[Kt -1 0
( 1-1) ]/(D0 −D1 -1)で規定されるモー
タトルクモデルフィルタ23、[Jn s 0 ( 1
-1) ]/2(D0 −D1 -1)で規定される制御対象逆
モデルフィルタ24、(1/Kt )で規定されるモータ
トルク逆モデル25、減算器26で表される。
【0017】制御対象に加わる外乱力と位置検出値に含
まれる観測ノイズは、互いに独立な正規分布に従う白色
ノイズであると考えられる。このような場合の制御対象
の状態量(位置及び速度)は、カルマンフィルタ12に
よって推定できる。カルマンフィルタ12は次の数
表される。
【0018】
【数3】
【0019】ここで、xm (k)はサンプリングk番目
の検出位置、xep(k)はサンプリングk番目の推定位
置、xev(k)はサンプリングk番目の推定速度、Ts
はサンプリング時間である。カルマンフィルタ12は検
出位置と推定位置を比較し、その結果である推定誤差を
フィードバックすることで、制御対象の真の位置と推定
位置との誤差を小さくするように働く。カルマンフィル
タゲインK1 (20)及びカルマンフィルタゲインK2
(21)は、制御対象の真の位置と推定位置との誤差の
2乗平均値が最小になるように決定する。ディジタル制
御系における量子化ノイズ及び微分ノイズはサンプリン
グ周波数及びその高調波で生じるが、カルマンフィルタ
12はこれら観測ノイズを除去し制御対象の位置及び速
度を推定する。
【0020】次に、外乱推定器13は次のように機能す
る。カルマンフィルタ12によって推定された制御対象
速度推定値xevは、制御対象にモータトルクτm と外乱
トルクdが加わった場合の推定状態量である。この速度
推定値xevに制御対象逆モデル(24)を乗じると、制
御対象に加わる推定外力(τem+de )が算出される。
また、モータトルク指令値ic にモータトルクモデル
(23)を乗じるとモータトルク推定値τemが推定され
る。減算器26によって両者の差分をとり、外乱トルク
e を推定する。このとき、外乱力推定帯域を制限する
ため、制御対象逆モデル(24)及びモータトルクモデ
ル(23)には、ローパスフィルタ特性を持たせる。推
定外乱トルクde にモータトルク逆モデル(25)を乗
じて推定トルクiedを算出し、この値を減算器14にお
いてモータトルク目標値ir から減じて外乱トルク分を
キャンセルし、モータトルク指令値ic とする。
【0021】以上の動作は、以下の数で表される。
【0022】
【数4】
【0023】なお、本発明は、X−Yテーブルのような
直線運動制御系の位置制御装置に適しているが、回転運
動系の位置制御装置にも適用できることは言うまでもな
い。
【0024】
【発明の効果】以上の説明で明らかなように、カルマン
フィルタにより得られた速度推定値を用いて外乱推定器
による外乱オブザーバによって演算した推定外乱トルク
をトルク目標値から減算することによって外乱をキャン
セルし、トルク指令値を算出する。このトルク指令値に
よって制御対象を駆動するので外乱の影響を小さくでき
る。
【0025】また、外乱オブザーバは位置制御器及び速
度制御器と独立に構成されているので、位置制御器及び
速度制御器のゲイン設定を変更せずに外乱抑圧のみが行
え、全体制御系を不安定化しない。
【0026】更に、位置制御器及び速度制御器への各フ
ィードバック量としてカルマンフィルタによって観測ノ
イズを除去した位置推定値及び速度推定値を用いるた
め、位置制御器及び速度制御器のゲインを高くしたり、
あるいは外乱オブザーバの応答帯域を高くしても制御シ
ステムが不安定になりにくい。
【図面の簡単な説明】
【図1】本発明による位置制御器の実施の形態の構成を
示したブロック図である。
【図2】図1のブロック線図である。
【図3】従来の位置制御器の実施の形態の構成を示した
ブロック図である。
【図4】図3のブロック線図である。
【符号の説明】
1 位置制御器 2 速度制御器 3 モータドライバ 4 モータ 5 負荷 6 位置検出器 7 速度演算器 8、9、14 減算器 10 加算器 12 離散系カルマンフィルタ 13 外乱推定器
───────────────────────────────────────────────────── フロントページの続き (56)参考文献 特開 平9−282008(JP,A) 特開 平5−315894(JP,A) 特開 平1−137305(JP,A) (58)調査した分野(Int.Cl.7,DB名) G05B 13/02 G05D 3/12 305

Claims (2)

    (57)【特許請求の範囲】
  1. 【請求項1】 モータにより駆動される被駆動体の位置
    を検出するための位置検出器を備え、該位置検出器の
    検出値と該位置検出値から算出される速度値とをそれ
    ぞれ位置制御器と速度制御器にフィードバックして、前
    記被駆動体の移動、位置決めを行うように、前記モータ
    のフィードバック制御を行うフィードバック制御系を備
    えた位置制御装置において、 前記位置検出値のフィードバックループに離散系カルマ
    ンフィルタと外乱推定器とを付加し、 前記離散系カルマンフィルタは、以下の数1に基づいて
    前記位置検出値のみから前記被駆動体の位置及び速度を
    推定して位置推定値及び速度推定値を出力し、 【数1】 但し、x m (k)はサンプリングk番目の検出位置、x
    ep (k)はサンプリングk番目の位置推定値、x
    ev (k)はサンプリングk番目の速度推定値であり、 前記外乱推定器は、[K t -1 0 (1+z -1 )/(D
    0 −D 1 -1 )]で規定されるモータトルクモデルのフ
    ィルタと、[J n s 0 (1−z -1 )/2(D 0 −D
    1 -1 )]で規定される制御対象逆モデルのフィルタ
    と、(1/K t )で規定されるモータトルク逆モデル
    と、減算器とを含んで、前記速度推定値x ev に前記制御
    対象逆モデルを乗算することにより制御対象に加わる推
    定外力を算出すると共に、モータトルク指令値に前記モ
    ータトルクモデルを乗算することによりモータトルク推
    定値を算出し、続いて前記減算器により前記推定外力と
    前記モータトルク推定値との差を算出して推定外乱トル
    クを算出した後、該推定外乱トルクに前記モータトルク
    逆モデルを乗算して推定トルクを算出し、 前記位置推定値を前記位置制御器にフィードバックする
    と共に、前記速度推定値を前記速度制御器にフィードバ
    ックし、更に前記速度制御器からのトルク目標値と前記
    推定トルクとの偏差を前記トルク指令値として出力する
    ようにしたことを特徴とする位置制御装置。
  2. 【請求項2】 請求項1記載の位置制御装置において、
    前記位置制御器は、位置指令値と前記位置推定値との偏
    差を受けて速度指令値を出力し、前記速度制御器は、前
    記速度指令値と前記速度推定値との偏差を受けて前記ト
    ルク目標値を出力することを特徴とする位置制御装置。
JP32310398A 1998-11-13 1998-11-13 位置制御装置 Expired - Fee Related JP3292951B2 (ja)

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)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109188908A (zh) * 2018-09-25 2019-01-11 浙江工业大学 基于指数型无切换吸引律的数字控制器设计方法

Families Citing this family (11)

* Cited by examiner, † Cited by third party
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 株式会社リコー 捩り振動系制御装置
JP5780473B2 (ja) * 2011-12-14 2015-09-16 株式会社安川電機 モータ制御装置及びモータシステム
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 住友重机械工业株式会社 线性马达输送***及其运用方法

Cited By (2)

* Cited by examiner, † Cited by third party
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
EP0311127B1 (en) Control device for servo motor
EP0922562A1 (en) Motor torque control method for press machine and press machine
JP3298069B2 (ja) ステージの位置制御装置及び速度制御装置
US20040239280A1 (en) Speed control device
JPH09282008A (ja) サーボ制御装置
JP3196311B2 (ja) 電動機の速度推定オブザーバ
JPH06217578A (ja) 2慣性ねじり振動系の速度制御におけるイナーシャ推定方法
JP3511942B2 (ja) モータの制御装置
JPH05252779A (ja) ロボットのサーボ制御装置
CN111566928A (zh) 电动机的控制装置
JPH08278821A (ja) サーボ制御系の制振方法
JP3220589B2 (ja) メカニカルシステムの制御装置
JP2000353002A (ja) 制御方法およびその装置
JP3235112B2 (ja) モータ制御装置
JP3247295B2 (ja) サーボ装置
JP2798217B2 (ja) 高速位置決め制御方法
JP2959270B2 (ja) 外乱推定補償器
JP3348240B2 (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