JPWO2008062700A1 - サーボ制御装置とその制御方法 - Google Patents
サーボ制御装置とその制御方法 Download PDFInfo
- Publication number
- JPWO2008062700A1 JPWO2008062700A1 JP2008545369A JP2008545369A JPWO2008062700A1 JP WO2008062700 A1 JPWO2008062700 A1 JP WO2008062700A1 JP 2008545369 A JP2008545369 A JP 2008545369A JP 2008545369 A JP2008545369 A JP 2008545369A JP WO2008062700 A1 JPWO2008062700 A1 JP WO2008062700A1
- Authority
- JP
- Japan
- Prior art keywords
- command
- speed
- feedforward
- pass filter
- torque command
- 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
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
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41426—Feedforward of torque
-
- 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/41428—Feedforward of position and speed
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Description
また、θ*は目標位置指令、θmは電動機位置、ω*は速度指令、ωmは電動機の回転速度、ωfbはフィードバック速度、T*はトルク指令、T0 *はトルク指令の基本信号、Tdは外乱補償トルク、Jは実際のプラントのイナーシャ、Jnはノミナルプラントのイナーシャ、sはラプラス演算子である。
また、実際のプラントのイナーシャJの最小値をJmとし、最大値をJMとする。
次に、第1の従来のサーボ制御装置の動作原理について説明する。簡単のため、第1ローパスフィルタ52を式(1)で表される1次ローパスフィルタとする。
ここで、T1は第1ローパスフィルタの時定数である。トルク指令の基本信号T0 *から電動機の回転速度ωmまでの伝達関数G1(s)を求めると、式(2)になる。
また、等価ローパスフィルタ31を式(3)で表されるものとする。
よって、図3の制御システムを図4のように書き直すことができる。図4において、3は第1等価制御対象であり、等価ローパスフィルタ31とノミナルプラント32を含んでいる。最悪の状況である実際のプラントのイナーシャJが最大値JMとなった場合、等価ローパスフィルタL(s,J)は式(4)となる。
このとき、等価ローパスフィルタの位相遅れが一番大きいので、第2ローパスフィルタL2(s)をこれに合わせて式(5)とする。
また、ωmからωfbまでの伝達関数を式(6)とすると、図4の制御システムを図5のように書き直すことができる。
また、オブザーバ補償器63のゲインを十分大きく設定すると、式(7)が成り立つ。
よって、式(8)が成り立つ。
式(3)、式(5)および式(8)により、等価ローパスフィルタL(s,J)81の遅れ位相はほぼ等価ハイパスフィルタH(s,J)83の進み位相に補償されて、位相遅れによる振動や不安定な問題が解消される。すなわち、負荷変動があっても制御系の安定性が保証され、目標指令に対する応答特性が殆ど変わらない。
次に、第2の従来のサーボ制御装置の動作原理について説明する。
図6により、式(9)、(10)、(11)、(12)が成り立つ。
が成り立つ。負荷イナーシャの変動がなく、しかもノミナルイナーシャJnがJと等しい場合は、式(13)が成り立つ。
よって、フィードバック制御の構成と関係なく、電動機の位置θmは完全に規範モデル部70の出力であるフィードフォワード位置指令θffに追従する。従って、フィードバック系のゲインを上げなくても、規範モデル部の応答性を向上することにより、目標位置指令に対する追従性を向上することができる。
平成18年電気学会産業応用部門大会,p.II337−340
また、第2の従来技術では、負荷イナーシャが変動するか正確に同定できなくて実際の負荷イナーシャがノミナルイナーシャと大きくずれる場合、フィードフォワードトルク指令が起こした速度信号がフィードフォワード速度指令と大きく違ってしまって、オーバーショートなどの制御特性が悪化する問題があった。
そこで、本発明はこのような問題点に鑑みてなされたものであり、PI制御に外乱オブザーバと位相進み補償オブザーバを組み合わせたフィードバック制御系に合うようなフィードフォワード制御部を構成することにより、負荷変動などの悪影響を抑制し、目標指令に対してロバストかつ高速な追従性能を実現することができるサーボ制御装置と制御方法を提供することを目的とする。
請求項1に記載の発明は、トルク指令に基づいて電動機および負荷機械を駆動し、前期電動機の位置を目標位置に対して追従させるフィードバック制御を行うサーボ制御装置にて、フィードバック系の位置指令と電動機の位置との偏差に基づいて速度指令を計算する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいて前記トルク指令の基本信号を計算するPI制御部と、前記トルク指令の基本信号および電動機の回転速度に基づいて外乱トルクを推定する外乱オブザーバと、前記トルク指令の基本信号および前記電動機の回転速度に基づいて前記電動機の回転速度より位相進みである前記フィードバック速度を推定する位相進み補償オブザーバと、を備えたサーボ制御装置において、前記目標位置を入力しフィードフォワード位置指令を出力する規範モデル部と、前記フィードフォワード位置指令を入力する微分器と、前記微分器の出力を入力しフィードフォワード速度指令を出力する第1ハイパスフィルタと、前記微分器の出力を入力するノミナルプラントの逆システムと、前記ノミナルプラントの逆システムの出力を入力しフィードフォワードトルク指令を出力する第2ハイパスフィルタと、を備え、前記フィードフォワード位置指令を前記フィードバック系の位置指令とし、前記フィードフォワード速度指令を前記速度指令に足して新たな速度指令とし、前記フィードフォワードトルク指令を前記トルク指令の基本信号に足して新たなトルク指令の基本信号とするものである。
請求項2に記載の発明は、前記第1ハイパスフィルタを前記第2ローパスフィルタの逆システムとするものである。
請求項3に記載の発明は、トルク指令に基づいて電動機および負荷機械を駆動し、前期電動機の位置を目標位置に対して追従させるフィードバック制御を行うサーボ制御装置にて、フィードバック系の位置指令と電動機の位置との偏差に基づいて速度指令を計算する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいて前記トルク指令の基本信号を計算するPI制御部と、前記トルク指令の基本信号および電動機の回転速度に基づいて外乱トルクを推定する外乱オブザーバと、前記トルク指令の基本信号および前記電動機の回転速度に基づいて前記電動機の回転速度より位相進みである前記フィードバック速度を推定する位相進み補償オブザーバと、を備えたサーボ制御装置の制御方法において、前記目標位置を規範モデル部に入力しフィードフォワード位置指令を出力するステップと、前記フィードフォワード位置指令を微分器に入力するステップと、前記微分器の出力を第1ハイパスフィルタに入力しフィードフォワード速度指令を出力するステップと、
前記微分器の出力をノミナルプラントの逆システムに入力するステップと、前記ノミナルプラントの逆システムの出力を第2ハイパスフィルタに入力しフィードフォワードトルク指令を出力するステップと、 前記フィードフォワード位置指令を前記フィードバック系の位置指令とするステップと、前記フィードフォワード速度指令を前記速度指令に加算して新たな速度指令とするステップと、前記フィードフォワードトルク指令を前記トルク指令の基本信号に加算して新たなトルク指令の基本信号とするステップと、を備えたことを特徴とするものである。
請求項4に記載の発明は、請求項3記載のサーボ制御装置の制御方法において、前記第1ハイパスフィルタは、前記第2ローパスフィルタの逆システムであることを特徴とするものである。
12、54 加算器
51、64、65 減算器
1 位置制御部
2 PI制御部
3 第1等価制御対象
31、82 等価ローパスフィルタ
4 実際のプラント
5 外乱オブザーバ
52 第1ローパスフィルタ
53、74 ノミナルプラントの逆システム
6 位相進み補償オブザーバ
32、61、81 ノミナルプラント
62 第2ローパスフィルタ
63 オブザーバ補償器
7 フィードフォワード制御部
70 規範モデル部
71 第1ハイパスフィルタ
72 第2ハイパスフィルタ
73 微分器
8 第2等価制御対象
83 等価ハイパスフィルタ
9 積分項
図1は、本発明の実施例を示すサーボ制御装置のブロック図である。図において、各部には、図3および図6の相当部分と同一記号を付してその説明を省略する。また、71は第1ハイパスフィルタ、72は第2ハイパスフィルタである。本発明は第1の従来技術に第2の従来技術から改良したフィードフォワード制御部を巧みに組み合わせたものである。
以下、本発明のサーボ制御装置の動作原理および構成方法について説明する。
本発明のサーボ制御装置のフィードバック制御部は第1の従来技術と全く同じであるため、第1の従来技術と同じ理由で、図1の制御システムを図2のように書き直すことができる。また、式(1)乃至式(8)は依然成り立つ。図2により、
が成り立つ。
式(14)および式(16)により、式(18)が成り立つ。
となる。また、式(15)および式(17)により、式(19)が成り立つ。
よって、電動機の位置θmをフィードフォワード位置指令θffに追従させるため、第1ハイパスフィルタ71および第2ハイパスフィルタ72を式(20)、(21)とする必要がある。
式(8)より、等価ハイパスフィルタH(s,J)83のカット周波数は殆ど負荷イナーシャJによらず一定であるため、第1ハイパスフィルタ71を式(22)とすると、式(20)の条件が満たされる。
また、式(3)より、等価ローパスフィルタL(s,J)82のカット周波数はほぼ負荷イナーシャJに反比例して変わるので、すべてのJに対して式(21)の条件を満たすことが不可能である。そこで、負荷イナーシャJが変動範囲の中間値J0になる場合に合わせて第2ハイパスフィルタ72を式(23)とする。
一方、本発明のトルクフィードフォワードは第2の従来のサーボ制御装置のトルクフィードフォワードと大きく違って、負荷イナーシャの変動があっても、フィードフォワード制御部に使われたノミナルイナーシャが必ず第2等価制御対象8のイナーシャと一致するので、トルクフィードフォワードを加えるによる応答特性の乱れが少ない。特に、急変な目標位置指令がでない限り、等価ローパスフィルタL(s,J)82の影響が小さい。
以上のように、負荷イナーシャの変動があっても、電動機の位置が規範モデル部の出力に追従するので、規範モデル部の応答性を向上することにより、電動機の位置の目標位置指令に対する追従性を向上することができる。
Claims (4)
- トルク指令に基づいて電動機および負荷機械を駆動し、前期電動機の位置を目標位置に対して追従させるフィードバック制御を行うサーボ制御装置にて、フィードバック系の位置指令と電動機の位置との偏差に基づいて速度指令を計算する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいて前記トルク指令の基本信号を計算するPI制御部と、前記トルク指令の基本信号および電動機の回転速度に基づいて外乱トルクを推定する外乱オブザーバと、前記トルク指令の基本信号および前記電動機の回転速度に基づいて前記電動機の回転速度より位相進みである前記フィードバック速度を推定する位相進み補償オブザーバと、を備えたサーボ制御装置において、
前記目標位置を入力しフィードフォワード位置指令を出力する規範モデル部と、
前記フィードフォワード位置指令を入力する微分器と、
前記微分器の出力を入力しフィードフォワード速度指令を出力する第1ハイパスフィルタと、
前記微分器の出力を入力するノミナルプラントの逆システムと、
前記ノミナルプラントの逆システムの出力を入力しフィードフォワードトルク指令を出力する第2ハイパスフィルタと、
を備え、
前記フィードフォワード位置指令を前記フィードバック系の位置指令とし、前記フィードフォワード速度指令を前記速度指令に加算して新たな速度指令とし、前記フィードフォワードトルク指令を前記トルク指令の基本信号に加算して新たなトルク指令の基本信号とすることを特徴とするサーボ制御装置。 - 前記第1ハイパスフィルタは、前記第2ローパスフィルタの逆システムであることを特徴とする請求項1記載のサーボ制御装置。
- トルク指令に基づいて電動機および負荷機械を駆動し、前期電動機の位置を目標位置に対して追従させるフィードバック制御を行うサーボ制御装置にて、フィードバック系の位置指令と電動機の位置との偏差に基づいて速度指令を計算する位置制御部と、前記速度指令とフィードバック速度との偏差に基づいて前記トルク指令の基本信号を計算するPI制御部と、前記トルク指令の基本信号および電動機の回転速度に基づいて外乱トルクを推定する外乱オブザーバと、前記トルク指令の基本信号および前記電動機の回転速度に基づいて前記電動機の回転速度より位相進みである前記フィードバック速度を推定する位相進み補償オブザーバと、を備えたサーボ制御装置の制御方法において、
前記目標位置を規範モデル部に入力しフィードフォワード位置指令を出力するステップと、
前記フィードフォワード位置指令を微分器に入力するステップと、
前記微分器の出力を第1ハイパスフィルタに入力しフィードフォワード速度指令を出力するステップと、
前記微分器の出力をノミナルプラントの逆システムに入力するステップと、
前記ノミナルプラントの逆システムの出力を第2ハイパスフィルタに入力しフィードフォワードトルク指令を出力するステップと、
前記フィードフォワード位置指令を前記フィードバック系の位置指令とするステップと、
前記フィードフォワード速度指令を前記速度指令に加算して新たな速度指令とするステップと、
前記フィードフォワードトルク指令を前記トルク指令の基本信号に加算して新たなトルク指令の基本信号とするステップと、
を備えたことを特徴とするサーボ制御装置の制御方法。 - 前記第1ハイパスフィルタは、前記第2ローパスフィルタの逆システムであることを特徴とする請求項3記載のサーボ制御装置の制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008545369A JP4992909B2 (ja) | 2006-11-21 | 2007-11-14 | サーボ制御装置とその制御方法 |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006313776 | 2006-11-21 | ||
JP2006313776 | 2006-11-21 | ||
PCT/JP2007/072111 WO2008062700A1 (fr) | 2006-11-21 | 2007-11-14 | Appareil de contrôle servo et procédé de contrôle correspondant |
JP2008545369A JP4992909B2 (ja) | 2006-11-21 | 2007-11-14 | サーボ制御装置とその制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2008062700A1 true JPWO2008062700A1 (ja) | 2010-03-04 |
JP4992909B2 JP4992909B2 (ja) | 2012-08-08 |
Family
ID=39429635
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008545369A Expired - Fee Related JP4992909B2 (ja) | 2006-11-21 | 2007-11-14 | サーボ制御装置とその制御方法 |
Country Status (4)
Country | Link |
---|---|
EP (1) | EP2096507A4 (ja) |
JP (1) | JP4992909B2 (ja) |
TW (1) | TW200841141A (ja) |
WO (1) | WO2008062700A1 (ja) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5098863B2 (ja) * | 2008-07-11 | 2012-12-12 | 株式会社安川電機 | 同期制御装置 |
JP2010137724A (ja) * | 2008-12-11 | 2010-06-24 | Toyota Motor Corp | 制振制御装置および制振制御方法 |
JP2015122846A (ja) * | 2013-12-20 | 2015-07-02 | Juki株式会社 | 位置決め装置の制御装置 |
WO2016118838A1 (en) | 2015-01-23 | 2016-07-28 | Berry Plastics Corporation | Polymeric material for an insulated container |
JP6531682B2 (ja) * | 2016-03-11 | 2019-06-19 | オムロン株式会社 | モータ制御装置、モータ制御方法、プログラム、および記録媒体 |
JP7020200B2 (ja) * | 2018-03-13 | 2022-02-16 | 富士電機株式会社 | 速度・位置制御システム |
CN108873698B (zh) * | 2018-07-07 | 2021-06-01 | 福州大学 | 一种抗扰动两阶段定点伺服控制方法 |
CN113311706B (zh) * | 2021-05-26 | 2022-05-27 | 广东电网有限责任公司 | 高性能超前观测器的高频噪声功率增益的自动跟踪方法 |
CN113359485B (zh) * | 2021-07-27 | 2022-08-16 | 安徽工业大学 | 一种电液伺服系统输出反馈预设性能控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08147038A (ja) * | 1994-11-21 | 1996-06-07 | Tsubakimoto Chain Co | モータの駆動制御装置 |
JP3835528B2 (ja) * | 2001-07-19 | 2006-10-18 | 株式会社安川電機 | 速度制御装置 |
JP3834815B2 (ja) | 2001-12-10 | 2006-10-18 | 株式会社安川電機 | 最適指令作成装置 |
JP4391218B2 (ja) * | 2003-02-20 | 2009-12-24 | 三菱電機株式会社 | サーボ制御装置 |
JP2005267296A (ja) * | 2004-03-19 | 2005-09-29 | Yaskawa Electric Corp | サーボ制御装置 |
-
2007
- 2007-11-14 JP JP2008545369A patent/JP4992909B2/ja not_active Expired - Fee Related
- 2007-11-14 EP EP07831841A patent/EP2096507A4/en not_active Withdrawn
- 2007-11-14 WO PCT/JP2007/072111 patent/WO2008062700A1/ja active Application Filing
- 2007-11-21 TW TW96144170A patent/TW200841141A/zh unknown
Also Published As
Publication number | Publication date |
---|---|
TW200841141A (en) | 2008-10-16 |
WO2008062700A1 (fr) | 2008-05-29 |
JP4992909B2 (ja) | 2012-08-08 |
EP2096507A4 (en) | 2009-12-09 |
EP2096507A1 (en) | 2009-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4992909B2 (ja) | サーボ制御装置とその制御方法 | |
JP5169836B2 (ja) | 位置制御装置 | |
JP5120654B2 (ja) | サーボ制御装置 | |
JP4779969B2 (ja) | 電動機制御装置 | |
JP6020537B2 (ja) | モータ制御装置及びモータ制御方法 | |
CN105932930B (zh) | 电动机控制装置 | |
JP2009303432A (ja) | モータによる位置制御装置 | |
JP6353731B2 (ja) | モータシステム | |
JP6453576B2 (ja) | モータシステム | |
JP2008097334A (ja) | サーボ制御装置とその制御方法 | |
WO2016079839A1 (ja) | 多重巻線電動機の駆動制御装置 | |
JP5067656B2 (ja) | ディジタル制御装置 | |
JP2015115990A (ja) | モータ制御装置 | |
JP5413036B2 (ja) | モータ制御装置及びモータ制御システム | |
JP2005085074A (ja) | 位置制御装置 | |
JP2017099084A (ja) | 多慣性共振システムにおける共振抑制制御装置 | |
JP5689491B2 (ja) | サーボモータの制御装置 | |
JP5017984B2 (ja) | サーボ制御装置とその速度追従制御方法 | |
JP2018116600A (ja) | モータ制御装置 | |
JP2005267296A (ja) | サーボ制御装置 | |
JP2006302201A (ja) | サーボ制御装置 | |
JP2019221032A (ja) | 電動機の制御装置 | |
JP2012118785A (ja) | 2自由度制御系のチューニング | |
JP2008217405A (ja) | アクチュエータ制御装置およびアクチュエータ制御方法 | |
JP2009118688A (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 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20120410 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120423 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150518 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |