JPWO2008075558A1 - 位置制御装置 - Google Patents
位置制御装置 Download PDFInfo
- Publication number
- JPWO2008075558A1 JPWO2008075558A1 JP2008550087A JP2008550087A JPWO2008075558A1 JP WO2008075558 A1 JPWO2008075558 A1 JP WO2008075558A1 JP 2008550087 A JP2008550087 A JP 2008550087A JP 2008550087 A JP2008550087 A JP 2008550087A JP WO2008075558 A1 JPWO2008075558 A1 JP WO2008075558A1
- Authority
- JP
- Japan
- Prior art keywords
- speed
- command
- torque command
- gain
- phase lead
- 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
- 230000001629 suppression Effects 0.000 abstract description 10
- 238000010586 diagram Methods 0.000 description 9
- 230000010354 integration Effects 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41402—Observe speed and driving signal, estimate speed
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41437—Feedforward of speed
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42055—Pi control for speed
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Description
従来技術は、遅れ要素の位相遅れを補償できるオブザーバを用いることである(例えば、特許文献1参照)。図3は従来技術を用いた位置制御装置の構成を示すブロック図である。図において、3は制御対象であり、計算の時間遅れや電流ループやローパスフィルタやノッチフィルタなどを含む遅れ要素31と、電動機の回転子を含む機械可動部32(電磁トルクから電動機の回転速度までの伝達関数で示されている)とを含んでいる。また、1は位置制御部、2はPI制御部である。また、6はオブザーバであり、機械可動部モデル61および遅れ要素モデル62で構成されたオブザーバの制御対象60とオブザーバ補償器63とを含んでいる。
また、θ*は位置指令、ω*は速度指令、θmは電動機の回転位置、ωmは電動機の回転速度、ωfbはフィードバック速度、T*はトルク指令、Jは機械可動部のイナーシャ、Dは機械可動部の粘性摩擦係数、sはラプラス演算子である。
次に、動作原理について説明する。
制御対象3では、遅れ要素L(s)31の出力を機械可動部P(s)32に入力することで、オブザーバの制御対象60では、機械可動部モデルPo(s)61の出力を遅れ要素モデルLo(s)62に入力することになっている。そのため、制御対象のモデルが正確に同定され、すなわち、Lo(s)=L(s)、Po(s)=P(s)が満たされる場合に、遅れ要素モデル62の出力であるωoは電動機の回転速度ωmの正確な推定速度になり、すなわち、
ωo=ωm (1)
が成り立つので、図3の制御システムを等価的に図4のように書き直すことができる。図4より、速度ループの内には遅れ要素がなくなったため、PI制御部2のゲインを大きく上げられ、速度制御ループの応答特性を向上することで、位置制御器1のゲインも上げられ、位置指令に対する追従特性および外乱に対する抑圧特性を向上することができる。
そこで、本発明はこのような問題点に鑑みてなされたものであり、位相進み補償器を組み合わせることにより、位置ループの内の位相遅れを補償し、位置制御器のゲインを大きく上げられることで、位置指令に対してオーバーシュートがない高速度高精度な追従特性および外乱に対して強力な抑圧特性を実現できる位置制御装置を提供することを目的とする。
請求項1に記載の発明は、位置指令と電動機の回転位置との偏差に基づいて速度指令を算出する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいてトルク指令を算出するPI制御部と、前記トルク指令および電動機の回転速度を入力し、前記電動機の回転速度から遅れ要素モデルの出力を差し引いた値をオブザーバ補償器に入力し、前記トルク指令に前記オブザーバ補償器の出力を足した値を機械可動部モデルに入力し、前記機械可動部モデルの出力を前記遅れ要素モデルに入力すると共に、前記フィードバック速度として出力するオブザーバと、を備え、電動機および負荷機械を駆動制御する位置制御装置において、前記速度指令からトルク指令の位相進み補償信号を算出する位相進み補償器を有し、前記トルク指令に前記トルク指令の位相進み補償信号を足して新たなトルク指令とすることを特徴とするものである。
請求項2に記載の発明は、請求項1記載の位置制御装置において、前記遅れ要素モデルを一次遅れフィルタとし、前記位相進み補償器のゲインを、この一次遅れフィルタの時定数に前記PI制御部の積分ゲインを掛けた値から前記PI制御部の比例ゲインを差し引いた値とすることを特徴とするものである。
請求項3に記載の発明は、位置指令と電動機の回転位置との偏差に基づいて速度指令を算出する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいて比例部速度指令を算出する積分制御部と、前記比例部速度指令とフィードバック速度との偏差に基づいてトルク指令を算出する比例制御部と、前記トルク指令および電動機の回転速度を入力し、前記電動機の回転速度から遅れ要素モデルの出力を差し引いた値をオブザーバ補償器に入力し、前記トルク指令に前記オブザーバ補償器の出力を足した値を機械可動部モデルに入力し、前記機械可動部モデルの出力を前記遅れ要素モデルに入力すると共に、前記フィードバック速度として出力するオブザーバと、を備え、電動機および負荷機械を駆動制御する位置制御装置において、前記速度指令から速度指令の位相進み補償信号を算出する位相進み補償器を有し、前記比例部速度指令に前記速度指令の位相進み補償信号を足して新たな比例部速度指令とすることを特徴とするものである。
請求項4に記載の発明は、請求項3記載の位置制御装置において、前記遅れ要素モデルを一次遅れフィルタとし、前記位相進み補償器のゲインを、前記一次遅れフィルタの時定数に前記積分制御部のゲインを掛けた値とすることを特徴とするものである。
2 PI制御部
3 御対象
31 遅れ要素
32 機械可動部
4 積分部
5 位相進み補償部
6 オブザーバ
60 オブザーバの制御対象
61 機械可動部モデル
62 遅れ要素モデル
63 オブザーバ補償器
64 加算器
65 減算器
7、8 減算器
9 加減算器
10 IP制御部
11 積分制御部
12 比例制御部
以下、本発明の制御装置の動作原理について説明する。
制御対象のモデルが正確に同定され、すなわち、Lo(s)=L(s),Po(s)=P(s)が満たされる場合に、前記従来技術と同じ理由で、図1の制御システムを等価的に図2のように書き直すことができる。図2より、速度ループの内には遅れ要素がなくなったため、PI制御部2のゲインを大きく上げられ、速度制御ループの応答特性を向上することができる。また、位置ループの内には位相遅れを持つ遅れ要素モデル62が存在しているが、その位相遅れは位相進み補償器5のゲインaを調整することにより、補償されることができる。その理由は以下に述べる。
遅れ要素の伝達関数を一次遅れフィルタと近似し、遅れ要素モデル62を式(2)とし、
また、PI制御部2を式(3)とし、
速度指令ω*から電動機の回転速度ωmまでの伝達関数を求め、整理すると、式(4)になる。
また、位相進み補償部5のゲインを式(5)とすると、
速度指令ω*から電動機の回転速度ωmまでの伝達関数は式(6)になる。
式(6)より、一次遅れフィルタの極はキャンセルされ、PI制御器2の比例ゲインKpおよび積分ゲインKiを調整することによって、Gω(s)の極を任意の位置に配置することができる。すなわち、速度指令ω*に対する電動機の回転速度ωmの応答特性のカット周波数を十分高く設定することができる。よって、位置指令θ*に対する電動機の回転位置θmの応答はオーバーシュートがでないように、位置制御器1のゲインを大きく上げることができる。また、位置制御器1のゲインを上げることで、位置指令に対する追従特性および外乱に対する抑圧特性を向上することができる。
このように、位相進み補償器を組み合わせることで、位置ループの内の位相遅れを補償し、位置制御器のゲインを大きく上げられ、位置指令に対してオーバーシュートがない高速度高精度な追従特性および外乱に対して強力な抑圧特性を実現することができる。
以下、本発明の制御装置の動作原理について説明する。
制御対象のモデルが正確に同定され、すなわち、Lo(s)=L(s),Po(s)=P(s)が満たされる場合に、実施例1と同じ理由で、図5の制御システムを等価的に図6のように書き直すことができる。図6より、速度ループの内には遅れ要素がなくなったため、IP制御部10のゲインを大きく上げられ、速度制御ループの応答特性を向上することができる。また、位置ループの内には位相遅れを持つ遅れ要素モデル62が存在しているが、その位相遅れは位相進み補償器5のゲインaを調整することにより、補償されることができる。その理由は以下に述べる。
遅れ要素の伝達関数を一次遅れフィルタと近似し、遅れ要素モデル62を式(7)とし、
また、積分制御部11のゲインをKiとし、比例制御部12のゲインをKpとし、速度指令ω*から電動機の回転速度ωmまでの伝達関数を求め、整理すると、式(8)になる。
また、位相進み補償部5のゲインを式(9)とすると、
速度指令ω*から電動機の回転速度ωmまでの伝達関数は、式(10)になる。
式(10)より、一次遅れフィルタの極はキャンセルされ、IP制御器2の比例ゲインKpおよび積分ゲインKiを調整することによって、Gω(s)の極を任意の位置に配置することができる。すなわち、速度指令ω*に対する電動機の回転速度ωmの応答特性のカット周波数を十分高く設定することができる。よって、位置指令θ*に対する電動機の回転位置θmの応答はオーバーシュートがでないように、位置制御器1のゲインを大きく上げることができる。また、位置制御器1のゲインを上げることで、位置指令に対する追従特性および外乱に対する抑圧特性を向上することができる。
このように、位相進み補償器を組み合わせることで、位置ループの内の位相遅れを補償し、位置制御器のゲインを大きく上げられ、位置指令に対してオーバーシュートがない高速度高精度な追従特性および外乱に対して強力な抑圧特性を実現することができる。
Claims (4)
- 位置指令と電動機の回転位置との偏差に基づいて速度指令を算出する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいてトルク指令を算出するPI制御部と、
前記トルク指令および電動機の回転速度を入力し、前記電動機の回転速度から遅れ要素モデルの出力を差し引いた値をオブザーバ補償器に入力し、前記トルク指令に前記オブザーバ補償器の出力を足した値を機械可動部モデルに入力し、前記機械可動部モデルの出力を前記遅れ要素モデルに入力すると共に、前記フィードバック速度として出力するオブザーバと、
を備え、電動機および負荷機械を駆動制御する位置制御装置において、
前記速度指令からトルク指令の位相進み補償信号を算出する位相進み補償器を有し、
前記トルク指令に前記トルク指令の位相進み補償信号を足して新たなトルク指令とする
ことを特徴とする位置制御装置。 - 前記遅れ要素モデルを一次遅れフィルタとし、前記位相進み補償器のゲインを、前記一次遅れフィルタの時定数に前記PI制御部の積分ゲインを掛けた値から前記PI制御部の比例ゲインを差し引いた値とすることを特徴とする請求項1記載の位置制御装置。
- 位置指令と電動機の回転位置との偏差に基づいて速度指令を算出する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいて比例部速度指令を算出する積分制御部と、前記比例部速度指令とフィードバック速度との偏差に基づいてトルク指令を算出する比例制御部と、
前記トルク指令および電動機の回転速度を入力し、前記電動機の回転速度から遅れ要素モデルの出力を差し引いた値をオブザーバ補償器に入力し、前記トルク指令に前記オブザーバ補償器の出力を足した値を機械可動部モデルに入力し、前記機械可動部モデルの出力を前記遅れ要素モデルに入力すると共に、前記フィードバック速度として出力するオブザーバと、
を備え、電動機および負荷機械を駆動制御する位置制御装置において、
前記速度指令から速度指令の位相進み補償信号を算出する位相進み補償器を有し、
前記比例部速度指令に前記速度指令の位相進み補償信号を足して新たな比例部速度指令
とすることを特徴とする位置制御装置。 - 前記遅れ要素モデルを一次遅れフィルタとし、前記位相進み補償器のゲインを、前記一次遅れフィルタの時定数に前記積分制御部のゲインを掛けた値とすることを特徴とする請求項3記載の位置制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008550087A JP5169836B2 (ja) | 2006-12-21 | 2007-12-05 | 位置制御装置 |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006343748 | 2006-12-21 | ||
JP2006343748 | 2006-12-21 | ||
PCT/JP2007/073440 WO2008075558A1 (ja) | 2006-12-21 | 2007-12-05 | 位置制御装置 |
JP2008550087A JP5169836B2 (ja) | 2006-12-21 | 2007-12-05 | 位置制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2008075558A1 true JPWO2008075558A1 (ja) | 2010-04-08 |
JP5169836B2 JP5169836B2 (ja) | 2013-03-27 |
Family
ID=39536191
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008550087A Expired - Fee Related JP5169836B2 (ja) | 2006-12-21 | 2007-12-05 | 位置制御装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US8040098B2 (ja) |
JP (1) | JP5169836B2 (ja) |
TW (1) | TW200844697A (ja) |
WO (1) | WO2008075558A1 (ja) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7733047B2 (en) * | 2006-02-08 | 2010-06-08 | Mitsubishi Electric Corporation | Motor controller and motor control method |
JP4540727B2 (ja) * | 2008-07-31 | 2010-09-08 | 山洋電気株式会社 | モータ制御装置 |
JP2011010533A (ja) * | 2009-05-25 | 2011-01-13 | Yaskawa Electric Corp | モータ制御装置及びモータ制御システム |
JP5594029B2 (ja) * | 2010-09-30 | 2014-09-24 | トヨタ自動車株式会社 | フィードバック制御回路、フィードバック制御システム |
CN102135758B (zh) * | 2011-04-22 | 2015-08-12 | 力博特公司 | 一种重复控制器及其控制方法以及反馈控制系统 |
JP2013225284A (ja) * | 2012-04-20 | 2013-10-31 | Linestream Technologies | 動作システムのパラメータ推定法、そのパラメータ推定システム、動作プロファイルの生成方法およびその生成システム |
JP5689491B2 (ja) * | 2013-03-05 | 2015-03-25 | ファナック株式会社 | サーボモータの制御装置 |
EP2639657B1 (de) | 2013-04-24 | 2018-04-04 | MOOG GmbH | Verzögerungsminimierte Erfassung einer Hilfsregelgröße |
CN106464193B (zh) * | 2014-05-13 | 2018-11-23 | 三菱电机株式会社 | 电动机控制常数计算装置 |
JP6017595B2 (ja) * | 2015-01-16 | 2016-11-02 | ファナック株式会社 | 振動を抑制するモータ制御装置 |
JP6044649B2 (ja) * | 2015-01-19 | 2016-12-14 | 株式会社明電舎 | ダイナモメータシステムの制御装置 |
JP6226021B2 (ja) * | 2016-04-28 | 2017-11-08 | 株式会社明電舎 | 試験システムのダイナモメータ制御装置 |
CN108111078B (zh) * | 2017-12-27 | 2019-11-29 | 浙江零跑科技有限公司 | 永磁同步电机的分段角度补偿方法 |
US11906475B2 (en) * | 2018-12-21 | 2024-02-20 | Shimadzu Corporation | Material testing machine and method for controlling material testing machine |
CN111230889B (zh) * | 2020-03-17 | 2021-04-30 | 北京理工大学 | 一种调节变负载机器人关节位置的控制方法及系统 |
CN112372639B (zh) * | 2020-11-12 | 2022-03-04 | 华侨大学 | 一种机械臂系统的二重相位超前补偿迭代学习控制方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0199485A (ja) * | 1987-10-09 | 1989-04-18 | Toshiba Corp | サーボ電動機の制御装置 |
JPH0683403A (ja) * | 1992-07-17 | 1994-03-25 | Fanuc Ltd | 適応pi制御方式 |
JPH10254550A (ja) * | 1997-03-12 | 1998-09-25 | Yaskawa Electric Corp | 位置制御装置 |
JP3271242B2 (ja) * | 1997-03-12 | 2002-04-02 | 日本鋼管株式会社 | 連続鋳造機モールド内湯面レベル制御装置 |
JP3900219B2 (ja) * | 1997-10-24 | 2007-04-04 | 株式会社安川電機 | 電動機速度制御装置および同装置のゲイン設定方法 |
CN1146765C (zh) * | 1998-09-28 | 2004-04-21 | 株式会社安川电机 | 位置控制装置 |
JP3526022B2 (ja) * | 2000-03-06 | 2004-05-10 | 株式会社安川電機 | サーボ制御系の発振臨界検出方法 |
JP3835528B2 (ja) * | 2001-07-19 | 2006-10-18 | 株式会社安川電機 | 速度制御装置 |
JP3850363B2 (ja) * | 2002-10-21 | 2006-11-29 | 山洋電気株式会社 | モータの位置制御装置 |
-
2007
- 2007-12-05 JP JP2008550087A patent/JP5169836B2/ja not_active Expired - Fee Related
- 2007-12-05 WO PCT/JP2007/073440 patent/WO2008075558A1/ja active Application Filing
- 2007-12-18 TW TW096148453A patent/TW200844697A/zh unknown
-
2009
- 2009-06-11 US US12/483,112 patent/US8040098B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP5169836B2 (ja) | 2013-03-27 |
TW200844697A (en) | 2008-11-16 |
US8040098B2 (en) | 2011-10-18 |
WO2008075558A1 (ja) | 2008-06-26 |
US20090251092A1 (en) | 2009-10-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5169836B2 (ja) | 位置制御装置 | |
JP5120654B2 (ja) | サーボ制御装置 | |
JP4992909B2 (ja) | サーボ制御装置とその制御方法 | |
JP6020537B2 (ja) | モータ制御装置及びモータ制御方法 | |
JP2009303432A (ja) | モータによる位置制御装置 | |
JP2015115990A (ja) | モータ制御装置 | |
JP5067656B2 (ja) | ディジタル制御装置 | |
JP6453576B2 (ja) | モータシステム | |
JP2017099084A (ja) | 多慣性共振システムにおける共振抑制制御装置 | |
CN110635739A (zh) | 位置控制装置 | |
JP2006215626A (ja) | 位置制御装置 | |
JP2008097334A (ja) | サーボ制御装置とその制御方法 | |
JP5017984B2 (ja) | サーボ制御装置とその速度追従制御方法 | |
JP2019008707A (ja) | サーボ制御装置、サーボ制御方法及びシステム | |
JP2010273400A (ja) | 誘導電動機制御装置 | |
JP2005215842A (ja) | サーボ制御装置 | |
JP2010136504A (ja) | モータ制御装置及びその設計方法 | |
JP4925056B2 (ja) | モータ位置制御装置 | |
US20220216813A1 (en) | Motor control system, motor control method, and program | |
Rustemli et al. | Ripple reduction at speed and torque of step motors used on a two-axis robot arm | |
JP3656745B2 (ja) | 電動機位置制御装置 | |
JP7346920B2 (ja) | モータ制御装置 | |
JP2005182427A (ja) | 制御演算装置 | |
JP5200648B2 (ja) | モータ駆動装置 | |
JP5512428B2 (ja) | 電動機の速度制御装置及び速度制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100915 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20120216 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120410 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120517 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20121204 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20121217 |
|
LAPS | Cancellation because of no payment of annual fees |