JP4973665B2 - 電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置 - Google Patents

電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置 Download PDF

Info

Publication number
JP4973665B2
JP4973665B2 JP2008546917A JP2008546917A JP4973665B2 JP 4973665 B2 JP4973665 B2 JP 4973665B2 JP 2008546917 A JP2008546917 A JP 2008546917A JP 2008546917 A JP2008546917 A JP 2008546917A JP 4973665 B2 JP4973665 B2 JP 4973665B2
Authority
JP
Japan
Prior art keywords
output filter
frequency response
unit
control device
motor control
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.)
Active
Application number
JP2008546917A
Other languages
English (en)
Other versions
JPWO2008065836A1 (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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP2008546917A priority Critical patent/JP4973665B2/ja
Publication of JPWO2008065836A1 publication Critical patent/JPWO2008065836A1/ja
Application granted granted Critical
Publication of JP4973665B2 publication Critical patent/JP4973665B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • 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
    • G05B17/00—Systems involving the use of models or simulators of said systems
    • G05B17/02—Systems involving the use of models or simulators of said systems electric
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
    • H02P23/0004—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Evolutionary Computation (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Power Engineering (AREA)
  • Control Of Electric Motors In General (AREA)
  • Feedback Control In General (AREA)

Description

本発明は、半導体製造装置や工作機械などの位置決め装置あるいは産業用ロボットに用いられる電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置に関するものである。
従来、例えば、半導体製造装置や工作機械などの位置決め装置あるいは産業用ロボットに用いられる電動機制御装置のパラメータ調整、特に出力フィルタの調整においては、制御部の特性を含まない機械の開ループ周波数応答特性を計測し、この結果を基に検出した共振周波数および減衰を推定(特許文献1)し、この推定値を基に出力フィルタの調整する手法が用いられてきた。
また、計測した機械の開ループ特性と使用する制御部の制御部モデルから閉ループ周波数特性を予測し、制御パラメータを調整する手法(特許文献2)もあった。
さらに、出力フィルタを含んで機械の開ループ周波数特性を計測し、その効果を確認しながら調整する手法(特許文献3)もあった。
特開2005−20949号公報 特開2005−275588号公報 特開2006−221404号公報
従来の制御パラメータ調整方法では、特許文献1の場合、推定したモデルに推定誤差が生じた場合やモデルの低次元化によるモデル化誤差が大きい場合には、最適な調整が出来ない場合があった。また、特許文献2の例では、使用する制御則や制御対象により、モデルを変更する必要があるうえ、前者同様モデルの低次元化に伴うモデル化誤差が大きく生じた場合、最適な調整が出来ない場合があった。さらに特許文献3の例では、少なくとも数回の特性計測が必要であり、機械によっては、可動部に多大な負荷がかかる場合があった。
本発明はこのような問題点に鑑みてなされたものであり、一度の計測動作と簡便な計算方法により、所望の周波数応答特性が得られる電動機制御装置と出力フィルタ方法および出力フィルタ調整装置を提供することを目的とする。
上記問題を解決するため、本発明は、次のように構成したのである。
請求項1記載の発明は、機械の動作量を検出する検出部と、指令信号を発生する指令部と、指令信号を受けて電動機を駆動する制御部とからなる電動機制御装置において、前記制御部の特性を含まない開ループ周波数応答特性を取得する開ループ周波数応答特性計測部と、前記制御部の出力フィルタの周波数応答特性を現すモデル演算部と、前記開ループ周波数応答特性計測部により計測した周波数応答の振幅特性と前記モデル演算部により算出された出力フィルタの周波数応答の振幅特性の和を表示する表示部と、を備えることを特徴とするものである。
請求項2記載の発明は、請求項1記載の電動機制御装置において、前記モデル演算部は、1次遅れフィルタモデルを使用することを特徴とするものである。
請求項3記載の発明は、請求項1記載の電動機制御装置において、前記モデル演算部は、ノッチフィルタモデルを使用することを特徴とするものである。
請求項4記載の発明は、請求項1記載の電動機制御装置において、前記モデル演算部は、複数の出力フィルタモデルの和を使用することを特徴とするものである。
請求項5に記載の発明は、機械の動作量を検出する検出部と、指令信号を発生する指令部と、指令信号を受けて電動機を駆動する制御部とからなる電動機制御装置の出力フィルタ調整方法において、機械の動作量を検出する検出部と、指令信号を発生する指令部と、指令信号を受けて電動機を駆動する制御部とからなる電動機制御装置の出力フィルタ調整方法において、トルク指令を入力し速度応答を計測するステップと、前記機械の開ループ応答特性を演算するステップと、周波数応答特性演算の結果を表示して確認するステップと、前記開ループ周波数応答特性に応じて前記出力フィルタを調整するステップと、出力フィルタのパラメータに応じて、周波数応答特性モデルを作成するステップと、前記開ループ応答特性と前記出力フィルタの周波数応答特性を合成するステップと、出力フィルタを介した開ループ周波数応答波形を表示し、出力フィルタの効果を確認するステップと、出力フィルタの効果により所望の効果が得られた場合は出力フィルタのパラメータを制御部に反映するステップと、を備えることを特徴とするものである。
請求項6に記載の発明は、出力フィルタ調整装置であり、請求項1記載の開ループ周波数応答特性計測部とモデル演算部と表示部を電動機制御装置から分離してまとめたことを特徴とするものである。
請求項1乃至4に記載の発明によると、機械の複数状態の特性に対する出力フィルタの効果を確認できるため、一度の計測動作と簡便な計算方法により、所望の周波数応答特性が得られる電動機制御装置を提供できる。
また、請求項5に記載の発明によると、機械の複数状態の特性に対する出力フィルタの効果を確認できるため、一度の計測動作と簡便な計算方法により、所望の周波数応答特性が得られる電動機制御装置の出力フィルタ調整方法を提供できる。
また、請求項6に記載の発明によると、機械の複数状態の特性に対する出力フィルタの効果を確認できるため、一度の計測動作と簡便な計算方法により、所望の周波数応答特性が得られる電動機制御装置の出力フィルタ調整装置を提供できる。
本発明の電動機制御装置の構成を示すブロック図 本発明の方法の処理手順を示すフローチャート 本実施例の機械の開ループ周波数応答特性を表す図 ノッチフィルタ適用により改善された開ループ周波数応答特性を表す図 本発明の出力フィルタ調整装置
符号の説明
1 指令部
2 制御部
3 動作量検出部
4 モデル演算部
5 周波数特性計測部
6 表示部
7 制御対象
8 出力フィルタ調整装置
9 電動機制御装置
10 出力フィルタ
以下、本発明の方法の具体的実施例について、図に基づいて説明する。
図1は本発明の電動機制御装置の構成を示すブロック図である。図1において、1は指令部、2は制御部、3は動作量検出部、4はモデル演算部、5は周波数特性計測部、6は表示部である。動作量検出部3は、制御対象である機械の動作量を検出し、指令部1は上位システムまたはマニュアルにより指令信号を発生する。制御部2は、指令信号を受けて電動機を駆動し、機械を動作させる。周波数特性計測部5は、動作量と指令信号から制御部の特性を含まない開ループ周波数応答特性を生成する。モデル演算部4は、制御部の出力フィルタ10の周波数特性を模擬する。表示部6は、開ループ周波数応答特性計測部により計測した周波数応答の振幅特性とモデル演算部で生成した出力フィルタの周波数応答の振幅特性の和を表示する。
図2は本発明の方法の処理手順を示すフローチャートである。図2に示すように、本発明の電動機制御装置の出力フィルタ調整方法は、ステップ1〜8の8つのステップで構成される。ステップ1では、多くの周波数成分を含むトルク指令を制御部に入力し、速度応答を計測する。ステップ2では、入力したトルク指令および計測した速度応答を基に機械の開ループ応答特性を演算する。ステップ3では、周波数応答特性演算の結果を表示して確認し、ステップ4では、機械の開ループ周波数応答特性に応じた出力フィルタの調整を行う。例えば、ひとつの特徴的な共振ピークが存在する場合、ピークの周波数に合わせノッチフィルタを設定する。ステップ5では、設定した出力フィルタのパラメータに応じて、周波数応答特性モデルを作成する。ステップ6では、ステップ2で求めた機械の開ループ応答特性と出力フィルタの周波数応答特性を合成し、ステップ7で、出力フィルタを介した開ループ周波数応答波形を表示し、出力フィルタの効果を確認する。出力フィルタの効果により所望の効果が得られた場合は、ステップ8により、出力フィルタのパラメータを制御部に反映する。所望の応答が得られない場合は、再度ステップ4からの作業を繰り返し、フィルタを最適に調整する。
以下、ステップ5およびステップ6について詳細に説明する。
図3に示すように機械の開ループ特性が1のようなひとつの特徴的な共振ピークを持ちその共振周波数ωHとすると、出力フィルタとして、図4に示す2のようなノッチフィルタを用いて、共振ピークのゲインを下げるのが適当である。
このときノッチフィルタの伝達関数は、式(1)で表される。
ここでQはノッチフィルタのバンド幅、Aは深さを表すパラメータであり、機械の共振周波数に対応した反共振周波数、減衰に合わせて調整する。
この伝達関数を周波数領域での振幅(ゲイン)として表わすと周波数ωの関数として次式(2)で表わされる。
したがって、式(2)にノッチフィルタのパラメータωH、Q、Aおよび周波数軸の数値を入力することで用意にフィルタの周波数領域での振幅を求めることが出来る。
また、機械の開ループ伝達関数をGm(s)、周波数領域での振幅をHm(ω)とすると、ノッチフィルタを介した開ループの周波数領域での振幅は次式で表されること公知である。
つまり、ノッチフィルタの周波数領域での振幅と機械の周波数領域での振幅を単純に足し合わせることでノッチフィルタを介した開ループの周波数領域での振幅を求めることが出来、ノッチフィルタの効果を容易に確認することが出来る。
図4は、前述の手法を用いて、ノッチフィルタ適用により開ループ周波数応答特性を改善した例である。
1は測定により得られた開ループ周波数応答特性、2はノッチフィルタの周波数応答特性、3はノッチフィルタ適用により改善された開ループ周波数応答特性を示しており、ノッチフィルタにより機械が持つ共振ピークを抑制し、開ループの応答特性が改善されていることがわかる。
同様に出力フィルタとして使用する各種フィルタの特性をモデル化しておけば、その周波数領域での振幅の足し合わせにより、用意に出力フィルタの効果を確認できる。
図5は、図1の開ループ周波数応答特性計測部とモデル演算部と表示部を電動機制御装置から分離し出力フィルタ調整装置としてまとめたものである。図5の8は出力フィルタ調整装置、9は電動機制御装置である。
本発明によると、一度の計測動作と簡便な計算方法により、所望の周波数応答特性が得られるので半導体製造装置や工作機械などの位置決め装置あるいは産業用ロボットへの適用はもちろんのこと一般産業用機械への適用も期待できる。

Claims (6)

  1. 機械の動作量を検出する検出部と、指令信号を発生する指令部と、指令信号を受けて電動機を駆動する制御部とからなる電動機制御装置において、
    前記動作量と前記指令信号から前記制御部の特性を含まない開ループ周波数応答特性を生成する開ループ周波数応答特性計測部と、
    前記制御部の出力フィルタの周波数特性を現すモデル演算部と、
    前記開ループ周波数応答特性計測部により計測した周波数応答の振幅特性と前記モデル演算部により算出された出力フィルタの周波数応答の振幅特性の和を表示する表示部と、
    を備えることを特徴とする電動機制御装置。
  2. 前記モデル演算部は、1次遅れフィルタモデルを使用することを特徴とする請求項1記載の電動機制御装置。
  3. 前記モデル演算部は、ノッチフィルタモデルを使用することを特徴とする請求項1記載の電動機制御装置。
  4. 前記モデル演算部は、複数の出力フィルタモデルの和を使用することを特徴とする請求項1記載の電動機制御装置。
  5. 機械の動作量を検出する検出部と、指令信号を発生する指令部と、指令信号を受けて電動機を駆動する制御部とからなる電動機制御装置の出力フィルタ調整方法において、
    トルク指令を入力し速度応答を計測するステップと、
    前記機械の開ループ応答特性を演算するステップと、
    周波数応答特性演算の結果を表示して確認するステップと、
    前記開ループ周波数応答特性に応じて前記出力フィルタを調整するステップと、
    出力フィルタのパラメータに応じて、周波数応答特性モデルを作成するステップと、
    前記開ループ応答特性と前記出力フィルタの周波数応答特性を合成するステップと
    出力フィルタを介した開ループ周波数応答波形を表示し、出力フィルタの効果を確認するステップと、
    出力フィルタの効果により所望の効果が得られた場合は、出力フィルタのパラメータを制御部に反映するステップと、
    を備えることを特徴とする電動機制御装置の出力フィルタ調整方法。
  6. 請求項1記載の開ループ周波数応答特性計測部とモデル演算部と表示部を電動機制御装置から分離してまとめたことを特徴とする出力フィルタ調整装置。
JP2008546917A 2006-11-28 2007-10-25 電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置 Active JP4973665B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008546917A JP4973665B2 (ja) 2006-11-28 2007-10-25 電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
JP2006319729 2006-11-28
JP2006319729 2006-11-28
PCT/JP2007/070799 WO2008065836A1 (fr) 2006-11-28 2007-10-25 Contrôleur de moteur et procédé permettant d'ajuster un filtre de sortie et dispositif permettant d'ajuster un filtre de sortie
JP2008546917A JP4973665B2 (ja) 2006-11-28 2007-10-25 電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置

Publications (2)

Publication Number Publication Date
JPWO2008065836A1 JPWO2008065836A1 (ja) 2010-03-04
JP4973665B2 true JP4973665B2 (ja) 2012-07-11

Family

ID=39467633

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008546917A Active JP4973665B2 (ja) 2006-11-28 2007-10-25 電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置

Country Status (4)

Country Link
US (1) US7902786B2 (ja)
JP (1) JP4973665B2 (ja)
TW (1) TW200841579A (ja)
WO (1) WO2008065836A1 (ja)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8974546B2 (en) * 2010-02-26 2015-03-10 Whirlpool Corporation Method for treating laundry in a clothes dryer
CN103809449B (zh) * 2014-02-28 2016-03-23 西安费斯达自动化工程有限公司 飞行器多回路模型簇颤振抑制复合pid鲁棒控制器设计方法
CN103809451B (zh) * 2014-02-28 2016-03-23 西安费斯达自动化工程有限公司 飞行器多回路模型簇复合根轨迹多级pid控制器设计方法
CN103809447B (zh) * 2014-02-28 2016-03-02 西安费斯达自动化工程有限公司 飞行器多回路模型簇复合频率控制器设计方法
JP6515844B2 (ja) 2016-03-14 2019-05-22 オムロン株式会社 シミュレーション装置、シミュレーション方法、制御プログラム、および記録媒体
JP6939024B2 (ja) * 2017-03-31 2021-09-22 セイコーエプソン株式会社 ロボット制御装置、ロボットおよびロボットシステム
CN107368032B (zh) * 2017-08-18 2019-05-10 哈尔滨理工大学 大螺距螺杆车削工艺系统综合频响函数方程构建方法
TWI681274B (zh) * 2018-11-14 2020-01-01 財團法人工業技術研究院 工具機頻率響應參數的調整方法及應用其之調整系統
CN110802636A (zh) * 2019-10-23 2020-02-18 山东科技大学 一种多关节串联型工业机器人的谐振抑制方法

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4269073A (en) * 1978-07-24 1981-05-26 The Boeing Company Gyroscope closed-loop speed controller
US6014598A (en) * 1996-06-28 2000-01-11 Arcelik A.S. Model-based fault detection system for electric motors
JP3111046B2 (ja) * 1997-09-24 2000-11-20 インターナショナル・ビジネス・マシーンズ・コーポレ−ション 周波数特性導出方法及び装置、ノッチフィルタ設定方法及び装置、ノッチフィルタ調整方法、制御装置、並びにディスク記憶装置
US6198246B1 (en) * 1999-08-19 2001-03-06 Siemens Energy & Automation, Inc. Method and apparatus for tuning control system parameters
JP4633253B2 (ja) * 2000-12-28 2011-02-16 住友化学株式会社 Pid制御装置のチューニング方法
JP4501368B2 (ja) 2003-06-27 2010-07-14 株式会社安川電機 電動機制御装置の多慣性機械モデル推定装置および電動機制御装置
JP2005063362A (ja) * 2003-08-20 2005-03-10 Yaskawa Electric Corp サーボ制御装置
JP2005275588A (ja) * 2004-03-23 2005-10-06 Yaskawa Electric Corp 電動機制御装置制御パラメータ感度解析装置
JP4325566B2 (ja) * 2005-02-10 2009-09-02 株式会社安川電機 電動機制御装置およびその機械特性測定方法並びに制御器調整方法
JP4396541B2 (ja) * 2005-02-16 2010-01-13 株式会社安川電機 電動機制御装置の制御パラメータ感度解析装置および電動機制御装置の制御パラメータ設定方法
JP4801466B2 (ja) * 2006-02-24 2011-10-26 財団法人電力中央研究所 熱応力緩和パッドおよびそれを用いた熱電変換システム並びにペルチェ冷却システム

Also Published As

Publication number Publication date
US20090230912A1 (en) 2009-09-17
TW200841579A (en) 2008-10-16
JPWO2008065836A1 (ja) 2010-03-04
US7902786B2 (en) 2011-03-08
WO2008065836A1 (fr) 2008-06-05

Similar Documents

Publication Publication Date Title
JPWO2008065836A1 (ja) 電動機制御装置と出力フィルタ調整方法および出力フィルタ調整装置
JP4698656B2 (ja) 制御システムおよび制御支援装置
JP6325504B2 (ja) 学習制御器の自動調整を行う機能を有するサーボ制御装置
JP5980890B2 (ja) 実験モード解析を用いたフィルタ自動調整機能を有するサーボ制御装置
CN101506639B (zh) 操作材料测试仪以测试试样的方法以及测试仪
CN107193218B (zh) 仿真装置、仿真方法、控制程序以及记录介质
JP2009165258A (ja) ゲイン自動調整機能を備えたサーボモータ制御装置
CN102902233B (zh) 具备声音变换装置的机床的数值控制装置
JP6649023B2 (ja) 学習制御器の特性測定を行う機能を有するサーボ制御装置
CN111796610B (zh) 马达控制装置以及计算机可读记录介质
KR101919950B1 (ko) 잔류진동 억제용 모션 프로파일 생성 장치
WO2021181787A1 (ja) 制御装置
JP2008233075A (ja) 振動試験装置
JP4524123B2 (ja) モータ制御装置の制御パラメータ算出方法
JP5191506B2 (ja) モータ制御装置の制御パラメータ算出方法、この方法をコンピュータに実行させるプログラム、及びこのプログラムを記録した記録媒体
JPWO2008053772A1 (ja) モータ制御装置とその制御方法
CN108845594B (zh) 基于传递函数的振动谐波迭代控制方法
JP2005275588A (ja) 電動機制御装置制御パラメータ感度解析装置
CN101943889A (zh) 使电气传动系统调节器自动启动和/或运行的方法及装置
JP4683198B2 (ja) 振動抑制フィルタの設定方法
WO2022113388A1 (ja) サーボパラメータの調整方法、及び調整装置
JP2009081923A (ja) モータ制御システムとそのパラメータ調整方法
JP7107496B2 (ja) 制御系設計方法及び試験システムの制御パラメータ決定方法
JP2006033929A (ja) モータ駆動制御装置
JP4801134B2 (ja) 振動試験装置及び振動試験方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20100401

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: 20120313

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: 20120326

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 4973665

Country of ref document: JP

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20150420

Year of fee payment: 3

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250