JP2004007955A - Position controller of motor - Google Patents

Abstract

<P>PROBLEM TO BE SOLVED: To provide a position controller of a motor capable of adjusting a control parameter in a short period of time with high responsiveness, without measuring in advance the frequency characteristics of an object to be controlled that has a resonance frequency. <P>SOLUTION: The positional controller of a motor is equipped with a plurality of control parameter sets in advance which contain at least a proportional gain of a positional control part and that of a speed control part. Selecting a set and measuring a response state of a motor to the positional instruction when the motor is controlled using the control parameter of a selected set are sequentially performed. A desired single set is selected according to a measured response state. A set of selected control parameters is established and the control parameters are changed as a set. <P>COPYRIGHT: (C)2004,JPO

Description

【０００９】
制御対象の加工装置の固有振動数を無視できる値に速度制御部５０７の比例ゲインＫｖｐを固定し、位置制御部５０５の比例ゲインＫｐｐを比例ゲインＫｖｐより高めに設定すると、サーボ系では次第に振動的になる。振動周波数をｆ_ｉとすると、振動周波数ｆ_ｉは比例ゲインＫｐｐと比例ゲインＫｖｐに対して次式（２）の関係を有する。
【００１０】
【数２】

【００１１】
このとき、指令発生部５０３から与えられた位置指令で電動機５０１を駆動させながら、振動周波数ｆｉを測定する。そして、式（２）に基づいて、電動機５０１と負荷のイナーシャ等の定数を含む制御対象のゲイン１／Ｊを求める。
【００１２】
その後、速度制御部５０７の動作を積分・比例制御（ＩＰ制御）に切り替える。速度制御部５０７の比例ゲインをＫｖｐ、積分ゲインをＫ_ＶＩとし、速度制御部５０７の積分ゲインＫ_ＶＩを非０の値（零でない値）とすると、このときのブロック線図は図３２により示される。このときの制御系全体の伝達関数Ｇ_１（Ｓ）は次式（３）により示される。
【００１３】
【数３】

【００１４】
上記のように構成された第１の従来技術の制御システムにおいて、速度制御部５０７の比例ゲインＫｖｐ、積分ゲインＫ_ＶＩ、及び位置制御部５０５の比例ゲインＫｐｐの３つのゲイン関係を一定に保ちながら電動機５０１の応答周波数成分と制御対象である加工装置の固有周波数との間で共振状態になるまで前記の３つのゲインを徐々に上げていく。そして、共振状態となった後、前記の３つのゲインを反対に徐々に下げていき、共振が収まった時のゲインを最適ゲインと設定していた。
【００１５】
また、電動機の位置制御に関する他の従来技術としては、日本の特開平１０−５６７９０号公報（第２の従来技術）に開示された技術がある（特許文献２）。以下、第２の従来技術である電動機の位置制御装置について図を用いて説明する。
図３３は第２の従来技術の電動機の位置制御装置のシステム構成を示すブロック図である。
【００１６】
図３３において、電動機６０１は電動機トルクによって駆動され、負荷機械６０２は電動機６０１によって駆動される。電動機６０１の回転位置及び回転速度は回転検出器６０３により検出される。トルク制御回路６０４は電動機トルクをトルク指令信号に一致させる。位置指令信号発生回路６０５は電動機６０１及び負荷機械６０２に対する位置指令である位置指令信号を形成して、その位置指令信号をフィードフォワード回路６０８へ出力する。フィードフォワード回路６０８は位置指令信号が入力されて、フィードフォワード信号と応答目標位置信号と応答目標速度信号を出力する。
図３３に示すように、第２の従来技術の位置制御装置には、速度補償回路６０６、位置補償回路６０７、スイッチ６０９、駆動試験用トルク指令信号発生回路６１０、及び自動調整回路６１１が設けられている。
【００１７】
次に、上記のように構成された第２の従来技術の位置制御装置における動作を説明する。
まず、スイッチ６０９を接点（ｂ）に切り替えて、駆動試験用トルク指令信号発生回路６１０が、例えば疑似ランダム信号などのトルク指令信号をトルク制御回路６０４へ出力する。駆動試験用トルク指令信号発生回路６１０がトルク指令信号をトルク制御回路６０４へ出力して、電動機６０１の駆動試験を行い、そのときのトルク指令信号と電動機６０１の回転速度を自動調整回路６１１に入力する。
【００１８】
自動調整回路６１１では、内蔵している高次の伝達関数モデルのパラメータを、例えば最小２乗法を用いて計算することにより、制御対象のトルク指令信号から電動機の回転速度までの伝達関数の詳細な同定を行う。同定された伝達関数の最も小さい複素零点の絶対値を推定反共振周波数ωｚｅとして選ぶ。また、低周波領域のゲイン特性から総イナーシャＪｅを推定する。この推定反共振周波数ωｚｅと推定総イナーシャＪｅを用いて計算された二慣性系最適ゲインＫｏｐｔと、伝達関数の周波数特性とゲイン余裕と位相余裕とを用いて求められた限界ゲインＫｍａｘとのうち、小さい方のゲインを速度補償回路６０６の速度ゲインＫｖとして決定する。決定された速度ゲインＫｖを元に位置補償回路６０７の位置ゲインＫｐと位置積分ゲインＫｐＩを所定の計算式を用いて決定する。またフィードフォワード回路６０８のゲインパラメータも推定反共振周波数ωｚｅと推定総イナーシャＪｅを用いて計算し決定する。
【００１９】
【特許文献１】
特許第２８９０５２９号明細書（第２−４頁、第２図）
【特許文献２】
特開平１０−５６７９０号公報（第８−１２頁、第１図）
【００２０】
【発明が解決しようとする課題】
前述のように、日本の特許第２８９０５２９号の第１の従来技術においては、複数のゲイン関係を一定に保ちながら電動機と制御対象との間で生じる共振状態を検知して最適な制御パラメータを決定していた。制御対象が共振周波数を持つ場合、共振周波数成分を抑圧するフィルタを挿入することにより制御パラメータの値をさらに大きくして応答性を上げることは可能であるが、このような調整方法では制御パラメータの調整として不十分であった。
【００２１】
また、日本の特開平１０−５６７９０号公報に開示された第２の従来技術においては、共振特性を有する制御対象に対して、制御パラメータを安定した設定とするため、制御対象の反共振周波数の推定値及び制御対象の周波数応答値を測定する必要がある。これらの値を得るためには、試験信号を与えて測定するなどの動作が必要であった。
【００２２】
本発明は、従来の技術における前述のように種々の問題を解決するものであり、共振周波数の存在する制御対象に対しても、制御対象の周波数特性を予め測定することなく、応答性の高い制御パラメータの調整を短時間で実現できる電動機の位置制御装置を提供することを目的とするものである。
【００２３】
【課題を解決するための手段】
上記目的を達成するために、本発明の電動機の位置制御装置は、少なくとも位置制御部の比例ゲインと速度制御部の比例ゲインとを含む制御パラメータのセットを予め複数有しており、セットの選択及び選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態の測定を順次行い、測定された応答状態に応じて好ましいセットを１つ選択して、選択されたセットの制御パラメータを装置に設定する。このように構成された本発明の電動機の位置制御装置は、制御パラメータをセットで変更するので、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
【００２４】
また、本発明の他の観点の電動機の位置制御装置は、少なくとも位置制御部の比例ゲインと速度制御部の比例ゲインとを含む制御パラメータのセットを予め複数有しており、セットの選択及び選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態の測定を、速度制御部の比例ゲインの低いセットから順次行い、振動持続を検知した時点で応答状態の測定を中止し、それまでの応答結果に基づいてセットの１つを選択して、選択されたセットの制御パラメータを設定する。このように構成された本発明の電動機の位置制御装置は、振動持続を検知した時点で応答状態の測定を中止するので、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
【００２５】
また、本発明の他の観点の電動機の位置制御装置は、少なくとも位置制御部の比例ゲインと速度制御部の比例ゲインとを含む制御パラメータのセットを予め複数有しており、セットの選択及び選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態の測定を順次行い、セットの選択として、振動持続を検知した場合は速度制御部の複数の比例ゲインにおける現在のセットより低いセットを次に選択し、持続発振を検知しない場合は速度制御部の複数の比例ゲインにおける現在のセットより高いセットを次に選択する。このようにセットの選択を繰り返すことにより、次に選択するセットがなくなった時点で、それまでの応答結果に基づいて好ましいセットを１つ選択し、選択されたセットの制御パラメータを設定する。このように構成された本発明の電動機の位置制御装置は、調整回数を減らすことができるので、短時間で制御パラメータを調整することができる。
【００２６】
また、本発明の他の観点の電動機の位置制御装置は、少なくとも位置制御部の比例ゲインと速度制御部の比例ゲインとを含む制御パラメータのセットを予め複数有しており、セット選択し、選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態を測定し、この応答状態に応じて好ましい制御パラメータのセットを１つ選択している。そして、選択されたセットの制御パラメータを設定する場合に、外部から開始セットを指定できるよう構成されている。このように構成された本発明の電動機の位置制御装置においては、任意の開始セットを指定できるため、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
【００２７】
また、本発明の他の観点の電動機の位置制御装置は、少なくとも位置制御部の比例ゲインと速度制御部の比例ゲインを含む制御パラメータのセットを予め複数有しており、セットを選択し、選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態を測定し、この応答状態に応じて好ましい制御パラメータのセットを１つ選択している。そして、選択されたセットの制御パラメータを設定する場合に、外部から入力された負荷構成パターンに関連づけられた開始セットから応答状態を測定するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、入力された負荷構成パターンに最適な開始セットが決定されているため、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
【００２８】
また、本発明の他の観点の電動機の位置制御装置は、電動機の検出位置または検出速度に含まれる所定周波数以上の振動成分の振幅、あるいは電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分の振幅が第１の所定値以上である期間が第１の所定時間以上であることを検知したとき、直ちに現在のセットの速度制御部の比例ゲインより低い速度制御部の比例ゲインを持つセットの制御パラメータに設定するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、制御パラメータ調整中に振動が発生した場合でも、確実に短時間で振動を収束させることができ安全な制御パラメータの調整ができる。
【００２９】
また、本発明の他の観点の電動機の位置制御装置は、位置指令値、速度指令値、検出位置、検出速度のうち少なくとも１つに基づいた、位置制御部の比例ゲインと速度制御部の比例ゲインとを少なくとも含む制御パラメータのセットを予め複数有している。そして、この位置制御装置は、セットを選択し、選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態を測定し、この応答状態に応じて好ましいセットを１つ選択し、選択されたセットの制御パラメータを設定する。このように構成された本発明の電動機の位置制御装置においては、位置指令値、速度指令値、検出位置、検出速度のうち少なくとも１つに基づいて制御パラメータを調整しているため、位置指令に対し優れた応答性を有する制御を実現できるように制御パラメータを調整することができる。
【００３０】
また、本発明の他の観点の電動機の位置制御装置は、少なくとも位置制御部の比例ゲインと速度制御部の比例ゲインとを含む制御パラメータのセットを予め複数有しており、セットを選択し、選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態を測定し、この応答状態に応じて好ましい制御パラメータのセットを１つ選択している。そして、選択されたセットの制御パラメータを設定した後、電動機を所定回数だけ制御して、振動しないかどうかを再確認するよう構成されているので、安定な制御パラメータを確実に設定できる。
【００３１】
また、本発明の他の観点の電動機の位置制御装置は、少なくとも位置制御部の比例ゲインと速度制御部の比例ゲインとを含む制御パラメータのセットを予め複数有しており、セットを選択し、選択されたセットの制御パラメータを用いて電動機を制御したときの位置指令に対する電動機の応答状態を測定し、この応答状態に応じて好ましい制御パラメータのセットを１つ選択している。そして、選択されたセットの制御パラメータを設定し、次に現在設定されている制御パラメータのうち少なくとも１つを固定し、残りの制御パラメータを変化させて、電動機を制御したときの位置指令に対する電動機の応答状態に応じて、変化させるパラメータを調整する。このように構成された本発明の電動機の位置制御装置においては、セットで制御パラメータを調整した後、さらに個別に各制御パラメータを調整するよう構成されているため、応答性の高い調整ができる。
【００３２】
また、本発明の他の観点の電動機の位置制御装置は、制御パラメータの調整過程で、外部から入力された目標指標を満足した時点で、制御パラメータの調整を停止し、その時点の制御パラメータを調整結果として設定するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、短時間で制御パラメータの調整ができる。
【００３３】
また、本発明の他の観点の電動機の位置制御装置は、位置制御系内または速度制御系内のいずれかに配置されノッチ周波数可変なノッチフィルタと、検出位置または検出速度に含まれる所定周波数以上の振動成分を減少させるようノッチフィルタのノッチ周波数を逐次修正するノッチ周波数修正部を具備している。このように構成された本発明の電動機の位置制御装置においては、制御対象の共振周波数による発振を抑圧するノッチフィルタを自動的に生成するため、制御対象の周波数応答を測定することなく応答性の高い制御パラメータの調整が可能となる。
【００３４】
また、本発明の他の観点の電動機の位置制御装置は、制御パラメータのセットが変化する時、変化直前のセットと変化直前のノッチ周波数を関連づけて記憶し、制御パラメータ調整部の出力である制御パラメータのセットが過去に選択されたセットに変化したとき、変化後のセットに関連づけて記憶されたノッチ周波数をノッチフィルタの周波数に設定し直すノッチ周波数記憶部が具備されている。このように構成された本発明の電動機の位置制御装置においては、制御パラメータ調整中に振動などでノッチフィルタのノッチ周波数が変化した場合でも、過去に選択されたセットで制御された時のノッチ周波数に確実に戻すことができる。
【００３５】
また、本発明の他の観点の電動機の位置制御装置は、ノッチ周波数記憶部を具備している。このノッチ周波数記憶部は、制御パラメータのセットが変化する時、変化直前のセットと変化直前のノッチ周波数を関連づけて記憶し、制御パラメータ調整部の出力である制御パラメータのセットが過去に選択されたセットに変化したとき、変化後のセットに関連づけて記憶されたノッチ周波数をノッチフィルタのノッチ周波数に設定し直し、その後所定時間の間ノッチフィルタのノッチ周波数の変更を禁止する。このように構成された本発明の電動機の位置制御装置においては、ノッチフィルタのノッチ周波数を過去に選択されたセットで制御された時点のノッチ周波数に戻した後、振動収束途中の振動によってノッチ周波数が変更されることを防ぐことができるため、ノッチ周波数を確実に戻すことができる。
【００３６】
また、本発明の他の観点の電動機の位置制御装置は、検出位置または検出速度に含まれる所定周波数以上の振動成分の検出を指令に応じて検出期間を限定するように構成されている。このように構成された本発明の電動機の位置制御装置においては、検出位置または検出速度に含まれる所定周波数以上の振動成分の誤検出がなくなり、応答性の高い制御パラメータの調整ができる。
また、本発明の他の観点の電動機の位置制御装置は、検出位置または検出速度に含まれる所定周波数以上の振動成分の振幅が所定値以上であることを検知したとき、イナーシャ推定動作を一時停止するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、イナーシャ推定動作を安定化させることができ、安定性を持つ制御パラメータの調整ができる。
発明の新規な特徴は添付の請求の範囲に特に記載したものに他ならないが、構成及び内容の双方に関して本発明は、他の目的や特徴と合わせて図面と共に以下の詳細な説明を読むことにより、より良く理解され評価されるであろう。
【００３７】
【発明の実施の形態】
以下、本発明に係る電動機の位置制御装置の好ましい実施の形態について、添付図面を参照しつつ説明する。
【００３８】
《実施の形態１》
図１は本発明の実施の形態１に係る電動機の位置制御装置の制御システムの構成を示すブロック図である。図１において、速度検出部２から電動機１の検出速度ωｍが出力される。検出速度ωｍは積分器３に入力され、検出位置θｍが算出される。位置制御部４には位置指令θｍ＊と検出位置θｍとの偏差が減算部で算出され入力される。位置制御部４は位置指令θｍ＊と検出位置θｍとの偏差を零に制御するための速度指令ωｍ＊を出力する。位置制御部４の具体的動作としては、例えば次式（４）に表されるように、差分θｍ＊−θｍを比例制御した結果を速度指令ωｍ＊として出力する。
【００３９】
【数４】

【００４０】
式（４）において、Ｋｐｐは位置制御部４における比例ゲインである。
速度制御部５には速度指令ωｍ＊と検出速度ωｍとの偏差が減算部で算出され入力される。速度制御部５は速度指令ωｍ＊と検出速度ωｍとの偏差を零に制御するためのトルク指令τ１＊を電動機駆動部６に出力する。速度制御部５の具体的動作としては、例えば次式（５）に表されるように差分（ωｍ＊−ωｍ）を比例積分制御した結果をトルク指令τ１＊として出力する。
【００４１】
【数５】

【００４２】
式（５）において、Ｋｖｐは速度制御部５の比例ゲインであり、Ｔｖｉは速度制御部５の積分時定数である。
電動機駆動部６は速度制御部５からのトルク指令τ１＊に応じて負荷７に連結された電動機１を駆動する。
第１の制御パラメータ調整部８には検出速度ωｍ、位置指令θｍ＊、及び位置指令θｍ＊と検出位置θｍとの位置偏差（θｍ＊−θｍ）が入力され、第１の制御パラメータ調整部８は位置制御部４及び速度制御部５の制御パラメータを設定する。
【００４３】
以下、第１の制御パラメータ調整部８の構成と動作について図２から図１０を参照しつつ詳細に説明する。
図２は第１の制御パラメータ調整部８の構成を示すブロック図である。
図２に示すように、第１の制御パラメータ調整部８は、ハイパスフィルタ８１、振動持続時間測定部８２、指令開始／完了検出部８３、コイン割れ回数／整定時間測定部８４、及び第１のステップ処理部８５を具備している。
【００４４】
まず、ハイパスフィルタ８１、振動持続時間測定部８２、指令開始／完了検出部８３、及びコイン割れ回数／整定時間測定部８４の動作について説明する。
図３はハイパスフィルタ８１と振動持続時間測定部８２の動作を説明するための動作波形の一例を示す波形図である。
【００４５】
ハイパスフィルタ８１は検出速度ωｍが入力され、検出速度ωｍに含まれる所定周波数以上の振動成分ｄｘを出力する。図３の（ａ）はハイパスフィルタ８１に入力される検出速度ωｍの時間変化を示す波形図であり、図３の（ｂ）はハイパスフィルタ８１の出力である振動成分ｄｘの時間変化を示す波形図である。
【００４６】
振動持続時間測定部８２は、図３の（ｂ）に示すように、振動成分ｄｘの振幅が所定値ｄ＿ｔｈ以上である継続時間（以後、振動持続時間ｔ＿ｖｉｂと記す）を計測する。振動成分ｄｘの振幅の所定値ｄ＿ｔｈは、例えば電動機１を位置制御したときに音が発生する時の速度検出値に含まれる振動成分の振幅値を予め求めておき、その振幅値を設定しておく。そして、計測された振動持続時間ｔ＿ｖｉｂが第１の所定時間Ｔ＿ｖｉｂ１以上であれば持続発振フラグを立てる。また、振動持続時間ｔ＿ｖｉｂが第１の所定時間Ｔ＿ｖｉｂ１より短い第２の所定時間Ｔ＿ｖｉｂ２以上であれば短時間発振フラグを立てる。第２の所定時間Ｔ＿ｖｉｂ２の値としては、発振時間として動作上許容できる程度の時間が望ましい。また、第１の所定時間Ｔ＿ｖｉｂ１の値としては、完全に発振したと判断できる時間が望ましい。
【００４７】
指令開始／完了検出部８３は、入力された位置指令θｍ＊から位置指令開始及び位置指令完了を検出する。位置指令θｍ＊の位置指令開始の検出は、例えば位置指令θ＊の時間変化を算出し、その算出値が０から非０（非０とは零でない値を言う）への変化を検知することにより可能である。また、位置指令θｍ＊の位置指令完了の検出は、例えば位置指令θ＊の時間変化を算出し、その算出値が非０から０への変化を検知することにより可能である。
【００４８】
図４はコイン割れ回数／整定時間測定部８４の動作を説明するための動作の一例を示す波形図である。図４は位置偏差（θｍ＊−θｍ）の時間変化を示す波形図である。コイン割れ回数／整定時間測定部８４は、図４に示すように、入力された位置偏差（θｍ＊−θｍ）と、指令開始／完了検出部８３からの検出信号に基づき、位置指令完了時から位置指令開始時までの期間において、位置偏差（θｍ＊−θｍ）が予め設定された整定幅ｐｅ＿ｔｈと交差する回数（以後、コイン交差回数ｎ＿ｃｒｏｓｓと記す）を計測する。ここで交差するとは、図４のＡ点、Ｂ点、Ｃ点のように、位置偏差（θｍ＊−θｍ）が、予め設定された整定幅ｐｅ＿ｔｈと比べて大きい値から小さい値へと変化すること、もしくはその逆の変化をすることを意味する。コイン交差回数ｎ＿ｃｒｏｓｓが所定回数Ｎｃ１を超えていたらコイン割れフラグを立てる。所定回数Ｎｃ１は２回が望ましい。また、位置指令完了時点から、位置偏差（θｍ＊−θｍ）が最初に予め設定された整定幅ｐｅ＿ｔｈ以下になるまでの時間（以後、整定時間ｔｃと記す）を計測する。
【００４９】
次に、第１の制御パラメータ調整手段８における第１のステップ処理部８５について説明する。
第１のステップ処理部８５は、例えば図５に示すようなセット番号（セットＮｏ．）が付けられた制御パラメータのセットを予め複数有している。図５において、Ｋｐｐ１、Ｔｖｉ１は検出速度ωｍが所定値ωｍ＿ｔｈより小さい時に設定する制御パラメータであり、Ｋｐｐ１は位置制御部４の比例ゲイン、Ｔｖｉ１は速度制御部５の積分時定数である。Ｋｐｐ２、Ｔｖｉ２は検出速度ωｍが所定値ωｍ＿ｔｈ以上の時に設定する制御パラメータであり、Ｋｐｐ２は位置制御部４の比例ゲイン、Ｔｖｉ２は速度制御部５の積分時定数である。Ｋｖｐは速度制御部５の比例ゲインである。図５において、速度制御部５の比例ゲインＫｖｐの値が低いセットからセット番号を付けている。即ち、図５においては、Ｋｖｐ１＜Ｋｖｐ２＜…＜ＫｖｐＮという関係を有している。
【００５０】
第１のステップ処理部８５は、例えば図６に示すような倍率設定表を有している。この表は後述する図８に示したフローチャートのステップ５ａ以降において使用する。図６において倍率設定値Ｋ１，Ｋ２，Ｋ３，・・・，ＫＭの小さい順に倍率番号を付けている。即ち、図６においては、Ｋ１＜Ｋ２＜…＜ＫＭという関係を有している。
【００５１】
以下、第１のステップ処理部８５の調整処理動作について、図７及び図８に示したフローチャートを用いて説明する。図７における最下部の”Ａ”は図８の最上部の”Ａ”につながっていることを示している。
ステップ１ａでは、セット番号＝１のセットを選択し、選択されたセット番号＝１の制御パラメータを位置制御部４及び速度制御部５に設定する。
ステップ１ａに続くステップ２ａには、図７に示すように、位置指令開始の検出結果に応じて２つの処理の流れを有する。
１つ目の処理の流れは、位置指令開始を検出した時の処理である。これは、図７のステップ２ａにおける左側に示したフローチャートである。ステップ２ａ−１における位置指令開始検出は、前述の通り、指令開始／完了検出部８３において行われる。位置指令開始を検出したとき、動作回数ｎを１増加させる。同時に振動持続時間測定部８２の振動持続時間ｔ＿ｖｉｂと、コイン割れ回数／整定時間測定部８４のコイン交差回数ｎ＿ｃｒｏｓｓを零にリセットする（ステップ２ａ−２）。
【００５２】
次に、ステップ２ａ−３において、動作回数ｎが所定回数ｍｖ１を超えたか否かを判断する。この所定回数ｍｖ１は予め設定されている。超えていたら、ステップ２ａ−４において、現在のセット番号と、持続発振フラグ、短時間発振フラグ、コイン割れフラグの各フラグ状態を関連づけて記憶する。次に、ステップ２ａ−５において、セット番号の値を１増加したセットを選択し、選択されたセットの制御パラメータを設定する。持続発振フラグと短時間発振フラグとコイン割れフラグをクリアして、動作回数ｎの初期化（ｎ＝１）を行う。ステップ２ａ−５においてセット番号の値を１増加すると、第１のステップ処理部８５が有する最大セット番号（Ｎ）を超える場合には、その状態がステップ２ａ−６において検出され、ステップ３ａへ移る。
【００５３】
ステップ２ａにおける２つ目の処理の流れは、図７のステップ２ａにおける右側に示したフローチャートであり、位置指令開始を検出せず持続発振フラグが立ったことを検知した時の処理である。持続発振フラグが立つとは、前述のように、計測された振動持続時間ｔ＿ｖｉｂが第１の所定時間Ｔ＿ｖｉｂ１以上であるときである。持続発振フラグの状態は前述の振動持続時間測定部８２から入力される。持続発振フラグが立ったことを検知したとき（ステップ２ａ−７）、現在のセット番号と、持続発振フラグ、短時間発振フラグ、及びコイン割れフラグの各フラグ状態とを関連づけて記憶する（ステップ２ａ−８）。次に、ステップ２ａ−９において、セット番号１を選択し、選択されたセットの制御パラメータを設定する。また、持続発振フラグと短時間発振フラグとコイン割れフラグをクリアし、動作回数ｎの初期化（ｎ＝１）を行い、振動持続時間測定部８２の振動持続時間ｔ＿ｖｉｂとコイン割れ回数／整定時間測定部８４のコイン交差回数ｎ＿ｃｒｏｓｓとを零にリセットする。そして、セット番号１を選択し、選択されたセットの制御パラメータを設定する。選択されたセットの制御パラメータを設定するのは、振動持続を検知した直後であり、振動を素早く抑制するための処理である。セット番号１の速度制御部５の比例ゲインＫｖｐは低く、この処理に最も適している。そして後述のステップ３ａに移るまで、振動持続時間測定部８２とコイン割れ回数／整定時間測定部８４の動作を一時停止させる。これは、発振収束過程では持続発振フラグと短時間発振フラグとコイン割れフラグを立てる必要がないからである。その後、ステップ２ａ−１０において、位置指令開始検出の動作回数ｎをカウントし、動作回数ｎが所定回数ｍｖ２を超えたと判断した場合、ステップ３ａへ移る。
【００５４】
図９は実施の形態１におけるセット番号と評価条件の結果の一例を示す表である。図９において、○がフラグが立っていないことを示しており、×はフラグが立っていることを示す。ステップ３ａでは、図９に示すようなステップ２ａで記憶された結果から、持続発振フラグと短時間発振フラグとコイン割れフラグがすべて立っていないセットの中で、速度制御部５の比例ゲインが最も高いセットを、選択するセットと判断する。図９に示した例の場合には、セット番号３を選択するセットと判断し、ステップ４ａに移る。
ステップ４ａでは、選択されたセットの制御パラメータを設定し、所定回数ｍｖ３だけ動作させ安定動作を確認する。動作回数が所定回数ｍｖ３に到達するまでに短時間発振フラグが立ったことを検出した場合には、図９に示すようなステップ２ａで記憶された評価条件の結果に基づき、持続発振フラグと短時間発振フラグとコイン割れフラグがすべて立っていないセットから現在選択されているセットを除いて、速度制御部５の比例ゲインが最も高いセットを新たに選択するセットと判断する。このステップ４ａにおける処理により、ステップ３ａで選択されたセットが安定動作性に欠ける場合、最適セットの再選択が可能となる。
【００５５】
続いて、ステップ５ａでは、より応答性の高い制御パラメータを設定する。現在設定されている制御パラメータのうち、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時の位置制御部４の比例ゲインＫｐｐ１以外は固定する。そして、比例ゲインＫｐｐ１のみを変化させて電動機１の応答状態に基づいて調整する。比例ゲインＫｐｐ１の変化のさせ方は、図６に示すような倍率設定表から倍率設定値を選択し、ステップ４ａの終了時点で選択されているセットの位置制御部４の比例ゲインＫｐｐ１と選択された倍率設定値との積Ｋｐｐ１ｓを、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時の位置制御部４の比例ゲインＫｐｐ１とすることにより行われる。
まず、倍率番号＝１とし、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時の位置制御部４の比例ゲインＫｐｐ１ｓを、Ｋｐｐ１ｓ＝Ｋｐｐ１×Ｋ１として設定する。
【００５６】
ステップ４ａに続くステップ５ａには、図８に示すように、倍率番号＝１を選択した後において、位置指令開始の検出結果に応じて２つの処理の流れを有する。
１つ目の処理の流れは、位置指令開始を検出した時の処理である。これは、図８のステップ５ａにおける左側に示したフローチャートである。ステップ５ａ−２における位置指令開始検出は指令開始／完了検出部８３において行われる。位置指令の開始が検出されたとき、動作回数ｎを１増加させる。同時に振動持続時間測定部８２の振動持続時間ｔ＿ｖｉｂと、コイン割れ回数／整定時間測定部８４のコイン交差回数ｎ＿ｃｒｏｓｓを零にリセットする。また、その時点で測定された整定時間ｔｃが、同じ倍率番号を選択した状態で過去に測定された整定時間ｔｃより長い場合は、その時点で測定された整定時間ｔｃを同じ倍率番号での整定時間の最大値として更新する（ステップ５ａ−３）。
【００５７】
次に、ステップ５ａ−４において動作回数ｎが所定回数ｍｖ４を超えたか否かを判断する。この所定回数ｍｖ４は予め設定されている。動作回数ｎが所定回数ｍｖ４を越えていないとき、ステップ５ａ−２に戻る。動作回数ｎが所定回数ｍｖ４を超えていたとき、現在の倍率番号及び、持続発振フラグと短時間発振フラグとコイン割れフラグとの各フラグ状態と整定時間の最大値とを関連づけて記憶する（ステップ５ａ−５）。次に、ステップ５ａ−６において、倍率番号の値を１増加した倍率設定値を選択し、選択された倍率設定値を用いてＫｐｐ１ｓを計算して設定する。また、持続発振フラグと短時間発振フラグとコイン割れフラグをクリアし、動作回数ｎを初期化し（ｎ＝１）、整定時間の最大値をクリアする。ステップ５ａ−７において、倍率番号の値を１増加すると第１のステップ処理部８５が有する最大の倍率番号を超えると判断したときには、ステップ６ａへ移る。
【００５８】
ステップ５ａにおける２つ目の処理の流れは、位置指令開始を検出せず、持続発振フラグ、短時間発振フラグ、コイン割れフラグのいずれかのフラグが立ったことを検知した時の処理である。これは、図８のステップ５ａにおける右側に示したフローチャートである。
位置指令開始を検出せず、持続発振フラグ、短時間発振フラグ、コイン割れフラグのいずれかが立ったことが検知したとき、ステップ５ａ−９において、現在の倍率番号、持続発振フラグと短時間発振フラグとコイン割れフラグの各フラグ状態、及び整定時間の最大値を関連づけて記憶する。
【００５９】
次に、ステップ５ａ−１０において、倍率番号１を選択し、選択された倍率設定値を用いてＫｐｐ１を設定し、持続発振フラグと短時間発振フラグとコイン割れフラグをクリアし、動作回数ｎを初期化し（ｎ＝１）、振動持続時間測定部８２の振動持続時間ｔ＿ｖｉｂとコイン割れ回数／整定時間測定部８４のコイン交差回数ｎ＿ｃｒｏｓｓを零にリセットする。ここで、倍率番号１を選択するのは、持続発振フラグ、短時間発振フラグ、コイン割れフラグのいずれかが立っている不安定状態を素早く抑制するための処理である。
ステップ５ａ−１１において、位置指令開始検出の動作回数ｎをカウントし、動作回数ｎが所定回数ｍｖ５を超えたと判断した場合、ステップ６ａへ移る。
図１０は実施の形態１における倍率設定値と評価条件の結果の一例を示す表である。図１０において、○がフラグが立っていないことを示しており、×はフラグが立っていることを示す。
【００６０】
ステップ６ａでは、図１０に示すようなステップ５ａで記憶された結果から、持続発振フラグと短時間発振フラグとコイン割れフラグがすべて立っていないセットの中で、整定時間の最も短い倍率番号を選択する。そして、ステップ３ａの終了時に選択されたセットのＫｐｐ１と、ステップ６ａで選択された倍率番号の倍率設定値の積Ｋｐｐ１ｓを、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時に設定する位置制御部４の比例ゲインとして決定して、第１のステップ処理部８５の調整処理動作が終了する。
【００６１】
上記の第１のステップ処理部８５の調整処理動作により、位置制御部４及び速度制御部５の制御パラメータが自動的に調整される。このように実施の形態１における第１の制御パラメータ調整部８が動作することにより、振動やコイン割れを生じさせることなく、整定時間の最も短い制御パラメータが設定されるため、優れた応答性を有する電動機の位置制御装置を提供することができる。
なお、実施の形態１における第１の制御パラメータ調整部８の調整動作において、図８に示したステップ５ａ以降のステップで、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時の位置制御部４の比例ゲイン設定値Ｋｐｐ１ｓが、検出速度ωｍが所定値ωｍ＿ｔｈ以上の時の位置制御部４の比例ゲインＫｐｐ２より大きくなる場合がある。この場合には、比例ゲインＫｐｐ２から比例ゲイン設定値Ｋｐｐ１ｓへの切り替えを、所定時間かけて徐々に切り換える。比例ゲインＫｐｐ２と比例ゲイン設定値Ｋｐｐ１ｓとの差が大きいと切り替え時に値の変化が急激になり振動成分が生じやすいからである。
【００６２】
上記のように本発明の実施の形態１の電動機の位置制御装置は、位置制御部４の比例ゲインと速度制御部５の比例ゲイン等を含む制御パラメータをセットとして持ち、最適な制御パラメータのセットを選択するよう調整を行う構成である。このため、実施の形態１の電動機の位置制御装置においては、電動機の制御応答性を測定する回数を減らすことができ、短時間で制御パラメータの調整が可能となる。
【００６３】
また、本発明の実施の形態１の電動機の位置制御装置は、電動機の動作状態に応じて制御パラメータを切り替えるよう制御パラメータを調整するため、位置指令完了後、位置指令と検出位置との偏差をより短時間で零に近づける制御パラメータの調整が可能となる。
【００６４】
《実施の形態２》
以下、本発明に係る実施の形態２の電動機の位置制御装置について図１１から図１４を用いて説明する。図１１は本発明の実施の形態２に係る電動機の位置制御装置の制御システムの構成を示すブロック図である。実施の形態２の説明において、前述の実施の形態１における要素と同じ構成、機能を有するものには同じ番号を付して、その説明は省略する。実施の形態２の電動機の位置制御装置において、前述の実施の形態１の構成と異なるところは、第１の制御パラメータ調整部８の代わりに第２の制御パラメータ調整部９が設けられていることである。
【００６５】
図１２は第２の制御パラメータ調整部９の構成を示すブロック図である。図１２に示すように、第２の制御パラメータ調整部９は実施の形態１における第１の制御パラメータ調整部８と同様に、ハイパスフィルタ８１、振動持続時間測定部８２、指令開始／完了検出部８３、及びコイン割れ回数／整定時間測定部８４を具備している。第２の制御パラメータ調整部９の構成において、前述の第１の制御パラメータ調整部８の構成と異なるところは、第１のステップ処理部８５の代わりに、第２のステップ処理部９５が設けられていることである。
【００６６】
以下、実施の形態２における第２のステップ処理部９５について説明する。
第２のステップ処理部９５は、第１のステップ処理部８５と同様、例えば図５に示したようなセット番号が付された制御パラメータのセットを予め複数有している。また、第２のステップ処理部９５は、第１のステップ処理部８５と同様、例えば図６に示したような倍率設定表を有している。
第２のステップ処理部９５の調整処理動作を、図１３及び図１４に示したフローチャートを用いて説明する。図１３における最下部の”Ａ”は図１４における最上部の”Ａ”につながっている。
【００６７】
第２のステップ処理部９５の調整処理動作におけるステップ１ｂ、ステップ３ｂ、ステップ４ｂ、ステップ５ｂ、及びステップ６ｂは、それぞれ実施の形態１で説明したステップ１ａ、ステップ３ａ、ステップ４ａ、ステップ５ａ、及びステップ６ａと同様の処理を行うため、それらの処理の説明は省略する。
ステップ１ｂに続くステップ２ｂには、図１３に示すように、位置指令開始の検出結果に応じて２つの処理の流れを有する。
【００６８】
１つ目の処理の流れは、位置指令開始を検出した時の処理である。これは、図１３のステップ２ｂにおける左側に示したフローチャートである。ステップ２ｂ−１における位置指令開始検出は、指令開始／完了検出部８３において行われる。位置指令開始が検出されたとき、動作回数ｎを１増加させる。同時に振動持続時間測定部８２の振動持続時間ｔ＿ｖｉｂと、コイン割れ回数／整定時間測定部８４のコイン交差回数ｎ＿ｃｒｏｓｓを零にリセットする（ステップ２ｂ−２）。
【００６９】
次に、ステップ２ｂ−３において、動作回数ｎが所定回数ｍｖ１を超えたか否かを判断する。この所定回数ｍｖ１は予め設定されている。動作回数ｎが所定回数ｍｖ１を超えていたとき、現在のセット番号及び、持続発振フラグと短時間発振フラグとコイン割れフラグの各フラグ状態を関連づけて記憶する（ステップ２ｂ−４）。ステップ２ｂ−５において、次のセットを選択し、選択されたセットの制御パラメータを設定し、持続発振フラグと短時間発振フラグとコイン割れフラグをクリアし、動作回数ｎの初期化（ｎ＝１）を行う。
【００７０】
ステップ２ｂ−５における次のセットの選択は、以下の通り行われる。この１つ目の処理の流れは、持続発振フラグが立っていない時のみ行われる。持続発振フラグが立った時の処理については後述する。１つ目の処理の流れは持続発振フラグが立っていない時であるため、ステップ２ｂ−５におけるセットの選択は、セット番号のより大きいセットを選択する。したがって、１つ目の処理の流れにおいては、応答性を高めることができる可能性がある。そこで、次のセットとして、現在のセット番号と、過去に選択したセットでかつ持続発振フラグが立ったと記憶しているセットの中で最も小さいセット番号との間にあるセット番号を選択する。次のセットとしては、特に、現在のセット番号と上記のように最も小さいセット番号の丁度真ん中に近いセット番号が望ましい。もし、過去に選択したセットでかつ持続発振フラグが立ったと記憶しているセットが存在しない場合には、現在のセット番号と最も大きいセット番号との間にあるセット番号を選択する。この場合も２つのセット番号の丁度真ん中に近いセット番号を選択することが望ましい。
【００７１】
ステップ２ｂにおける２つ目の処理の流れは、図１３のステップ２ｂにおける右側に示したフローチャートであり、位置指令開始を検出せず持続発振フラグが立ったことを検知した時の処理である。持続発振フラグの状態は前述の振動持続時間測定部８２から入力される。持続発振フラグが立ったことを検知したとき（ステップ２ｂ−６）、現在のセット番号と、持続発振フラグ、短時間発振フラグ、及びコイン割れフラグの各フラグ状態とを関連づけて記憶する（ステップ２ｂ−７）。次に、ステップ２ａ−８において、セット番号１を選択し、選択されたセットの制御パラメータを設定し、持続発振フラグと短時間発振フラグとコイン割れフラグをクリアし、動作回数ｎの初期化し（ｎ＝１）、そして振動持続時間測定部８２の振動持続時間ｔ＿ｖｉｂとコイン割れ回数／整定時間測定部８４のコイン交差回数ｎ＿ｃｒｏｓｓとを零にリセットする。そして、セット番号１を選択し、選択されたセットの制御パラメータを設定する。選択されたセットの制御パラメータを設定するのは、振動持続を検知した直後であり、振動を素早く抑制するための処理である。セット番号１の速度制御部５の比例ゲインＫｖｐは低く、この処理に最も適している。そして、振動持続時間測定部８２とコイン割れ回数／整定時間測定部８４の動作を一時停止させる。これは、発振収束過程では持続発振フラグと短時間発振フラグとコイン割れフラグを立てる必要がないからである。その後、ステップ２ｂ−９において、動作回数ｎが所定回数ｍｖ２を超えたか否かが判断される。ステップ２ｂ−１０において、動作回数ｎが所定回数ｍｖ２を超えたと判断した場合、次のセットを選択し、選択されたセットの制御パラメータを設定し、持続発振フラグと短時間発振フラグとコイン割れフラグをクリアし、動作回数ｎの初期化（ｎ＝１）を行う。
【００７２】
ステップ２ｂ−１０における次のセットの選択は、以下の通り行う。持続発振フラグが立ったのは、制御パラメータを高く設定しすぎたためと推測される。したがって、安定動作するセット番号はより小さいセットであると推測される。そこで、次のセットとしては、持続発振フラグが立ったことを検知したときのセット番号と、過去に選択したセットでかつ持続発振フラグが立っていないと記憶しているセットの中で最も大きいセット番号との間にあるセット番号を選択する。特に、上記の２つのセット番号の丁度真ん中に近いセット番号が望ましい。もし、過去に選択したセットでかつ持続発振フラグが立っていないと記憶しているセットが存在しない場合は、持続発振フラグが立ったのを検知したときのセット番号と、最も小さいセット番号との間にあるセット番号を選択する。この場合も２つのセット番号の丁度真ん中に近いセット番号を選択することが望ましい。
【００７３】
上記のように、ステップ２ｂにおいて、位置指令開始を検出した時の処理と、持続発振フラグが立ったことを検知した特の処理を続けていくと、次に選択するセットが存在しない場合が起きる（ステップ２ｂ−１１）。この状態の時にステップ３ｂへ移る。
【００７４】
実施の形態２におけるステップ３ｂ以降の調整処理動作は、前述の実施の形態１におけるステップ３ａ以降の調整処理動作と同じである。すなわち、図１４に示すように、ステップ３ｂ→ステップ４ｂ→ステップ５ｂ→ステップ６ｂの順に、実施の形態１におけるステップ３ａ、ステップ４ａ、ステップ５ａ、ステップ６ａと同じ処理を行い、第２のステップ処理部９５の調整処理動作が終了する。
上記のように、実施の形態２においては、位置制御部４及び速度制御部５の制御パラメータが自動的に調整される。この結果、実施の形態２の電動機の位置制御装置においては、振動やコイン割れを生じることがなく、整定時間の最も短い制御パラメータが設定されるため、優れた応答性を得る調整を実現している。
【００７５】
なお、実施の形態２における第２の制御パラメータ調整部９の調整処理動作において、図１４に示したステップ５ｂ以降のステップで、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時の位置制御部４の比例ゲイン設定値Ｋｐｐ１ｓが、検出速度ωｍが所定値ωｍ＿ｔｈ以上の時の位置制御部４の比例ゲインＫｐｐ２より大きくなる場合がある。この場合には、比例ゲインＫｐｐ２から比例ゲイン設定値Ｋｐｐ１ｓへの切り替えを、所定時間かけて徐々に切り換える。比例ゲインＫｐｐ２と比例ゲイン設定値Ｋｐｐ１ｓとの差が大きいと切り替え時の変化が急激になり振動成分が生じやすいからである。
【００７６】
上記のように本発明の実施の形態２の電動機の位置制御装置は、位置制御部の比例ゲインと速度制御部の比例ゲイン等を含む制御パラメータをセットとして持ち、最適な制御パラメータのセットを選択するよう調整を行うため、電動機の制御応答性を測定する回数を減らすことができ、短時間で制御パラメータの調整が可能となる。
また、本発明の実施の形態２の電動機の位置制御装置は、選択されたセットのパラメータを用いて電動機１の応答状態を測定するステップ２ｂにおいて、次に選択するセットを効率よく選ぶことによって、選択するセットの数を少なくすることができる。この結果、実施の形態２においては、制御パラメータの調整を短時間で行うことができる。
【００７７】
また、本発明の実施の形態２の電動機の位置制御装置は、電動機の動作状態に応じて制御パラメータを切り替えるよう制御パラメータを調整するため、位置指令完了後、位置指令と検出位置との偏差をより短時間で零に近づける制御パラメータの調整が可能となる。
【００７８】
《実施の形態３》
以下、本発明に係る実施の形態３の電動機の位置制御装置について図１５から図１７を用いて説明する。図１５は本発明の実施の形態３に係る電動機の位置制御装置の制御システムの構成を示すブロック図である。実施の形態３の説明において、前述の実施の形態１における要素と同じ構成、機能を有するものには同じ番号を付して、その説明は省略する。実施の形態３の電動機の位置制御装置において、前述の実施の形態１の構成と異なるところは、第１の制御パラメータ調整部８の代わりに第３の制御パラメータ調整部１０が設けられていることである。
【００７９】
図１６は第３の制御パラメータ調整部１０の構成を示すブロック図である。図１６に示すように、第３の制御パラメータ調整部１０は実施の形態１における第１の制御パラメータ調整部８と同様に、ハイパスフィルタ８１、振動持続時間測定部８２、指令開始／完了検出部８３、及びコイン割れ回数／整定時間測定部８４を具備している。第３の制御パラメータ調整部１０の構成において、前述の第１の制御パラメータ調整部８の構成と異なるところは、第１のステップ処理部８５の代わりに第３のステップ処理部１０５が設けられていることである。
【００８０】
以下、実施の形態３における第３のステップ処理部１０５について説明する。
第３のステップ処理部１０５は、第１のステップ処理部８５と同様、例えば図５に示したようなセット番号が付された制御パラメータのセットを予め複数有している。また、第３のステップ処理部１０５は、第１のステップ処理部８５と同様、例えば図６に示したような倍率設定表を有している。
【００８１】
第３のステップ処理部１０５の調整処理動作を、図１７に示したフローチャートを用いて説明する。
図１７に示すように、実施の形態３においては、ステップ１ｃ→ステップ２ｃ→ステップ３ｃ→ステップ４ｃ→ステップ５ｃ→ステップ６ｃの順に調整処理が行われている。この調整処理において、ステップ２ｃ、ステップ３ｃ、ステップ４ｃ、ステップ５ｃ、及びステップ６ｃは、前述の実施の形態１で説明したステップ２ａ、ステップ３ａ、ステップ４ａ、ステップ５ａ、及びステップ６ａと同じ処理が行われるため、これらの処理については説明を省略する。
【００８２】
前述の実施の形態１における第１のステップ処理部８５の動作において、ステップ１ａで最初のセットの選択を、速度制御ゲインＫｖｐの最も低いセット番号１としている。しかしながら、例えば電動機１及び電動機１によって駆動される負荷８が共に剛体であり、互いにバネ定数の大きいもので連結されているような場合には、低い共振周波数がないため、速度制御部５の比例ゲインを十分上げて設定して、高い応答性を得ることができる。したがって、このような場合には、最初のセットの選択時に、途中のセット番号を与えてやれば、応答性のよいセットの選択が短時間で可能となる。そこで、実施の形態３の電動機の位置制御装置では、調整処理動作のステップ１ｃにおいて、外部から指定された開始セット番号を最初のセットとして選択し、選択されたセットの制御パラメータを位置制御部４及び速度制御部５に設定する。
【００８３】
このように実施の形態３の電動機の位置制御装置においては、位置制御部の比例ゲインと速度制御部の比例ゲインを含む制御パラメータをセットとして持ち、外部から指定された開始セット番号から調整処理動作を始めている。実施の形態３においては、このように制御パラメータの調整処理動作を行うため、電動機の制御応答性の測定回数を減らすことができ、短時間で制御パラメータの調整が可能となる。
【００８４】
また、本発明の実施の形態３の電動機の位置制御装置は、電動機の動作状態に応じて制御パラメータを切り替えるよう制御パラメータを調整するため、位置指令完了後、位置指令と検出位置との偏差をより短時間で零に近づける制御パラメータの調整が可能となる。
【００８５】
《実施の形態４》
以下、本発明に係る実施の形態４の電動機の位置制御装置について図１８から図２０を用いて説明する。図１８は本発明の実施の形態４に係る電動機の位置制御装置の制御システムの構成を示すブロック図である。実施の形態４の説明において、前述の実施の形態１から実施の形態３における要素と同じ構成、機能を有するものには同じ番号を付して、その説明は省略する。実施の形態４の電動機の位置制御装置において、前述の実施の形態３の構成と異なるところは、負荷構成パターン入力部１１が設けられていることである。
【００８６】
以下、実施の形態４における負荷構成パターン入力部１１について図を用いて説明する。
負荷構成パターン入力部１１は、例えば図１９に示すような装置構成と開始セット番号とを関連づけた表を有している。装置構成とは、電動機１とこの電動機１によって駆動される負荷８とがどのように連結されているかを表すものである。例えば、図２０に示すように、負荷７はボールねじ２０に取り付けられており、電動機１はボールねじ２０の軸にタイミングベルト２１を介して連結されている。この場合の装置構成を、「ボールねじ＋タイミングベルト」とする。図１９に示す表は予め作成され記憶されている。このような表の作成方法としては、例えば該当する装置構成の場合の共振周波数の一般的な分布に基づいて、開始セット番号を決める。共振周波数が高いと判断される場合は開始セット番号を高くし、共振周波数が低いと判断される場合は開始セット番号を低くする。
【００８７】
負荷構成パターン入力部１１の動作は、外部から装置構成の情報が入力がされると、図１９に示すような表に基づいて開始セット番号を第３の制御パラメータ調整部１０ｋへ出力する。第３の制御パラメータ調整部１０ｋは、前述の実施の形態３で説明した制御パラメータの調整処理動作を行う。
上記のように実施の形態４の電動機の位置制御装置においては、装置構成が入力されるよう構成されているため、制御パラメータの調整処理動作を関連づけられた開始セットから始められるため、電動機の制御応答性を測定する回数を減らすことができ、短時間で制御パラメータの調整が可能となる。
【００８８】
《実施の形態５》
以下、本発明に係る実施の形態５の電動機の位置制御装置について図２１と図２２を用いて説明する。図２１は本発明の実施の形態５に係る電動機の位置制御装置の制御システムの構成を示すブロック図である。実施の形態５の説明において、前述の実施の形態１における要素と同じ構成、機能を有するものには同じ番号を付して、その説明は省略する。実施の形態５の電動機の位置制御装置において、前述の実施の形態１の構成と異なるところは、第１の制御パラメータ調整部８の代わりに第４の制御パラメータ調整部１２が設けられていることである。
【００８９】
図２２は第４の制御パラメータ調整部１２の構成を示すブロック図である。図２２に示すように、第４の制御パラメータ調整部１２は実施の形態１における第１の制御パラメータ調整部８と同様に、ハイパスフィルタ８１、振動持続時間測定部８２、指令開始／完了検出部８３、及びコイン割れ回数／整定時間測定部８４を具備している。第４の制御パラメータ調整部１２の構成において、前述の第１の制御パラメータ調整部８の構成と異なるところは、第１のステップ処理部８５の代わりに第４のステップ処理部１１５が設けられていることである。
【００９０】
以下、実施の形態５における第４のステップ処理部１１５について説明する。
第４のステップ処理部１１５は、前述の実施の形態１における第１のステップ処理部８５と同様の動作を行うとともに、電動機１の応答の測定過程において測定結果が外部から入力された目標仕様を満たした場合には、その時点で設定されている制御パラメータを調整結果として、調整処理動作を終了するよう構成されている。
このように、実施の形態５では、制御パラメータの調整処理動作の途中において、外部から入力された目標仕様を満たした時点で調整処理動作を終了するので調整処理時間の短縮を図ることが可能となる。
【００９１】
《実施の形態６》
以下、本発明に係る実施の形態６の電動機の位置制御装置について図２３から図２５を用いて説明する。図２３は本発明の実施の形態６に係る電動機の位置制御装置の制御システムの構成を示すブロック図である。実施の形態６の説明において、前述の実施の形態１における要素と同じ構成、機能を有するものには同じ番号を付して、その説明は省略する。実施の形態６の電動機の位置制御装置において、前述の実施の形態１の構成と異なるところは、ノッチフィルタ１３、ノッチ周波数修正部１４、及びノッチ周波数記憶部１５が設けられていることである。
【００９２】
ノッチフィルタ１３には、速度制御部５の出力であるトルク指令τ１＊が入力され、フィルタ処理した結果を新たなトルク指令τ２＊として電動機駆動部６に出力する。電動機駆動部６はトルク指令τ２＊に応じて電動機１を駆動する。
また、検出速度ωｍがノッチ周波数修正部１４に入力され、検出速度ωｍに含まれる所定周波数以上の周波数成分が減少するようノッチフィルタ１３のノッチ周波数ｆｎを逐次修正する。ノッチ周波数記憶部１５の動作については後述する。
【００９３】
ノッチ周波数修正部１４の具体的な動作の一例について図２４を用いて説明する。図２４はノッチ周波数修正部１４の構成の一例を示すブロック図である。ノッチ周波数修正部１４は、ハイパスフィルタ１４１、基準信号発生部１４２、ノッチフィルタ１４３、及び適応部１４４を具備している。ノッチ周波数修正部１４のノッチフィルタ１４３はノッチフィルタ１３と同じ構成を有している。
【００９４】
以下、上記のように構成されたノッチ周波数修正部１４の動作について説明する。
検出速度ωｍがノッチ周波数修正部１４に入力されると、検出速度ωｍはハイパスフィルタ１４１に通され、ハイパスフィルタ１４１は検出速度ωｍに含まれる振動成分ｄｘを加算器１４５に出力する。基準信号生成部１４２は基準信号ｒを出力される。基準信号ｒと振動成分ｄｘは、加算器１４５に入力されて加算値ｘがノッチフィルタ１４３に入力される。ノッチフィルタ１４３はフィルタ処理した信号ｙを出力する。そして、ノッチフィルタ１４３からの信号ｙと基準信号ｒとが減算器１４６に入力され、これらの偏差ｅが、適応部１４４に入力される。適応部１４４では、偏差ｅが減少するようノッチ周波数ｆｎを逐次修正していく。ノッチ周波数ｆｎの修正としては、たとえば公知の勾配法を用いて実現できる。勾配法を記載した文献としては、谷萩隆嗣著（Ｔａｋａｓｈｉ　Ｙａｈａｇｉ）、“ディジタル信号処理の理論３（Ｔｈｅｏｒｙ　ｏｆ　Ｄｉｇｉｔａｌ　Ｓｉｇｎａｌ　Ｐｒｏｃｅｓｓｉｎｇ　３）”、初版、株式会社コロナ社、１９８６年１２月１０日発行、ｐ１６５−ｐ１６６がある。
適応部１４４からのノッチ周波数ｆｎは、ノッチ周波数修正部１４のノッチフィルタ１４３に設定されると同時にノッチフィルタ１３にも設定される。基準信号生成部１４２では、例えば振動成分ｄｘが減少した結果である零を示す信号が出力される。
【００９５】
実施の形態６において、第１の制御パラメータ調整部８の構成要素である振動持続時間測定部８２（図２参照）が持続発振フラグを立てるための基準時間である所定時間Ｔ＿ｖｉｂ１の設定方法について図２５を用いて説明する。
【００９６】
図２５はノッチ周波数修正部１４の動作時の波形を示している。図２５の（ａ）は検出速度ωｍの時間変化を示し、（ｂ）は検出速度ωｍに含まれる振動成分ｄｘの時間変化を示し、（ｃ）はノッチ周波数ｆｎの時間変化を示す。ノッチ周波数修正部１４は振動成分ｄｘが生じてから修正動作を始めるため、修正動作完了までの期間には必ず振動成分ｄｘが現れる。図２５の（ｂ）に示すように振動成分ｄｘが生じた期間が振動持続時間ｔ＿ｖｉｂである。ノッチ周波数修正部１４の修正動作完了後は、ノッチフィルタ１３によって振動成分ｄｘが抑制されるため、第１の制御パラメータ調整部８の調整処理動作においてセット番号をさらに上げて応答性を上げることができる。しかし、前述の実施の形態１で説明したように、第１の制御パラメータ調整部８が測定している振動成分ｄｘの振動持続時間ｔ＿ｖｉｂが所定時間Ｔ＿ｖｉｂ１を超えると持続発振フラグを立ててその時点のセットより応答性を上げられなくなる。このため、ノッチ周波数修正部１４はノッチ周波数ｆｎの修正中に発生する振動を無視する必要がある。したがって、ノッチ周波数修正部１４の修正動作時間を予め調べておき、それよりも長い時間を所定時間Ｔ＿ｖｉｂ１に設定するのが望ましい。
【００９７】
また、ノッチ周波数修正部１４がノッチ周波数を修正している最中は応答状態が振動的になるなど乱れが生じるため、そのセットにおける定常時の応答状態とは判断できない。したがって、短時間発振フラグを立てるかどうかの判断と、コイン割れフラグを立てるかどうかの判断は安定した動作中に判断する必要がある。ノッチ周波数修正部１４がノッチ周波数修正動作するのは制御パラメータが変化した時である。第１の制御パラメータ調整部８はセットを変更してから所定回数ｍｖ１の動作後に次のセットを選択する。セット変更後から次のセットを選択するまでの間で、所定回数ｍｖ１より少ない所定回数ｍｖ６を動作させた後に、短時間発振フラグを立てるかどうかの判断と、コイン割れフラグを立てるかどうかの判断を行う。これによってそのセットにおける定常時の応答状態を測定することができる。
【００９８】
次に、ノッチ周波数記憶部１５の動作について説明する。ノッチ周波数記憶部１５は、第１の制御パラメータ調整部８の構成要素である第１のステップ処理部８５（図２参照）が、図７に示すステップ２ａにおいて、セット番号とともに各フラグの状態を記憶する時に、その時点でノッチフィルタ１３に設定されているノッチ周波数ｆｎをセット番号に関連付けて記憶する。そして、第１の制御パラメータ調整部８の構成要素である第１のステップ処理部８５が、ステップ２ａにおいてセット選択時に、そのセットに関連づけられたノッチ周波数ｆｎが記憶されている場合は、記憶されたノッチ周波数ｆｎをノッチフィルタ１３、ノッチ周波数修正部１４のノッチフィルタ１４３、及び適応部１４４に設定する。このようにノッチ周波数ｆｎを設定することにより、ノッチフィルタ１３，１４３の状態をそのセットにおいて過去に記憶した状態に復元できる。
【００９９】
また、実施の形態６においては、ノッチ周波数ｆｎがノッチフィルタ１３、ノッチ周波数修正部１４のノッチフィルタ１４３、及び適応部１４４に設定された後、所定時間経過するまでノッチ周波数ｆｎの変更を禁止している。第１の制御パラメータ調整部８は振動持続状態を検知して、一旦セット番号１の制御パラメータで駆動して振動を収束させる時、振動収束途中の振動成分に適応部１４４が反応し、ノッチフィルタ１３、ノッチ周波数修正部１４のノッチフィルタ１４３、及び適応部１４４に設定したノッチ周波数ｆｎを再修正してしまうことが起こりうる。したがって、ノッチ周波数ｆｎをノッチフィルタ１３、ノッチ周波数修正部１４のノッチフィルタ１４３、及び適応部１４４に設定した後、所定時間の間はノッチ周波数ｆｎの変更を禁止することによって、ノッチ周波数ｆｎの適正な修正を確実に行うことができる。
【０１００】
上記のように本発明に係る実施の形態６の電動機の位置制御装置は、検出速度ωｍに含まれる振動成分ｄｘを減少させるノッチフィルタ１３が自動的に機能するため、電動機１の制御系における共振周波数など周波数特性を予め測定することなく振動を抑えることができる。結果として第１の制御パラメータ調整部８は制御対象の共振を考慮した上での応答性よい制御パラメータの調整が可能となる。
なお、実施の形態６の電動機の位置制御装置においては、ノッチ周波数修正部１４の入力を検出速度ωｍとしたが、検出位置θｍ、トルク指令τ１＊を入力としても同様の効果が得られる。
【０１０１】
《実施の形態７》
以下、本発明に係る実施の形態７の電動機の位置制御装置について図２６から図２８を用いて説明する。
実施の形態７の電動機の位置制御装置のシステム構成は、前述の図１に示した実施の形態１のシステム構成と同じである。実施の形態１においては、検出速度ωｍに含まれる振動成分ｄｘの振幅を常時測定する構成で説明したが、振動成分ｄｘの振幅を所定期間は測定しないよう構成してもよい。
【０１０２】
以下、図２６、図２７及び図２８を用いて説明する。実施の形態７の説明において、前述の実施の形態１における要素と同じ構成、機能を有するものには同じ番号を付して、その説明は省略する。
図２６は実施の形態７における（ａ）位置指令値θｍ＊、（ｂ）位置指令値θｍ＊の微分値、（ｃ）検出速度ωｍ、（ｄ）振動成分ｄｘ、及び（ｅ）位置指令値θｍ＊の加速度の変化の時間変化の第１の例を示す波形図である。図２７は実施の形態７における（ａ）位置指令値θｍ＊、（ｂ）位置指令値θｍ＊の微分値、（ｃ）検出速度ωｍ、（ｄ）振動成分ｄｘ、及び（ｅ）位置指令値θｍ＊の加速度の変化の例の時間変化の第２の例を示す波形図である。図２８は実施の形態７における（ａ）位置指令値θｍ＊、（ｂ）位置指令値θｍ＊の微分値、（ｃ）検出速度ωｍ、（ｄ）振動成分ｄｘ、及び（ｅ）位置指令値θｍ＊の加速度の変化の時間変化の第３の例を示す波形図である。
【０１０３】
図２６の（ａ）に示すような位置指令値θｍ＊において、制御される電動機がほぼ位置指令θｍ＊に追従できていると仮定すると、図２６の（ｂ）に示される位置指令値θｍ＊の微分値と、図２６の（ｃ）に示される検出速度ωｍはほぼ同じ波形となる。
検出速度ωｍの振動成分ｄｘを抽出するために、検出速度ωｍをハイパスフィルタに通した結果が図２６の（ｄ）に示した振動成分ｄｘの波形である。図２６の（ｃ）には振動成分がないが、図２６の（ｄ）には振動成分ｄｘが生じている。これは検出速度ωｍの加速度の変化点に高調波成分が含まれており、これが抽出された結果である。図２６の（ａ）に示されるような位置指令値θｍ＊で電動機が制御されて、実施の形態１で説明した制御パラメータの調整処理動作を行う場合、常時検出速度ωｍに含まれる振動成分ｄｘが監視されている。このため、図２６の（ｄ）に示すような検出速度ωｍの加速度の変化点に含まれる高調波成分を発振による振動と誤判断する可能性がある。
【０１０４】
図２６の（ｄ）と（ｅ）に示すように、位置指令値θｍ＊の加速度の変化が大きな値を示す時点からの所定期間と、振動成分ｄｘが大きな振幅を生じる期間とが一致している。そこで、位置指令値θｍ＊の加速度の変化点から所定期間を除いた期間における検出速度ωｍに含まれる振動成分ｄｘのみを監視することにより、誤判断を防止することが可能となる。
次に、図２７の（ａ）に示すような位置指令値θｍ＊において、図２７の（ｂ）に示すように位置指令値θｍ＊の微分値が方形波でかつノイズが乗っている場合を考える。
制御される電動機１がほぼ位置指令値θｍ＊に追従できていると仮定すると、図２７の（ｂ）に示した位置指令値θｍ＊の微分値と、図２７の（ｃ）に示した検出速度ωｍはほぼ同じ波形となる。検出速度ωｍの振動成分ｄｘを抽出するために検出速度ωｍをハイパスフィルタに通した結果が、図２７の（ｄ）である。図２７の（ｅ）は位置指令値θｍ＊の加速度の変化を算出したものである。ノイズの影響により、位置指令値θｍ＊の加速度の変化と振動成分ｄとの相関をとることは困難である。
【０１０５】
図２７の（ｂ）と（ｄ）から分かるように、位置指令開始時点及び位置指令終了時点からの所定期間と、振動成分ｄｘが大きな振幅を生じる期間と一致している。図２７の（ａ）に示されるような位置指令値θｍ＊で電動機が制御され、実施の形態１で説明した制御パラメータの調整処理動作を行う場合、常時検出速度ωｍに含まれる振動成分ｄｘを監視している。このため、図２７の（ｄ）に示すような検出速度ωｍの加速度の変化点に含まれる高調波成分を、発振による振動と誤判断する可能性がある。このような場合、位置指令開始時点及び位置指令終了時点からの所定期間を除いた期間の検出速度ωｍに含まれる振動成分ｄｘのみを監視することにより誤判断を防止することが可能となる。
【０１０６】
次に、図２８の（ａ）に示すような位置指令値θｍ＊において、図２６の（ａ）と同じ位置指令値θｍ＊にノイズが乗っている場合を考える。制御される電動機がほぼ位置指令θｍ＊に追従できていると仮定すると、図２８の（ｂ）に示した位置指令値θｍ＊の微分値と、図２８の（ｃ）に示した検出速度ωｍはほぼ同じ波形となる。検出速度ωｍの振動成分ｄｘを抽出するために検出速度ωｍをハイパスフィルタに通した結果が図２８の（ｄ）である。図２８の（ｅ）は位置指令値θｍ＊の加速度の変化を算出したものである。ノイズの影響により、位置指令値θｍ＊の加速度の変化と振動成分ｄｘとの相関をとることは困難である。
【０１０７】
図２８の（ｄ）の波形から分かるように、位置指令がある期間及び位置指令終了時点からの所定期間に振動成分ｄｘが大きな振幅を生じる期間がある。図２８の（ａ）に示されるような位置指令値θｍ＊で電動機が制御され、実施の形態１で示した制御パラメータの調整処理動作を行う場合、常時検出速度ωｍに含まれる振動成分ｄｘを監視している。このため、図２８の（ｄ）に示すような検出速度ωｍの加速度の変化点に含まれる高調波成分を、発振による振動と誤判断する可能性がある。このような場合、位置指令がある期間及び位置指令終了時点からの所定期間を除く期間の検出速度ωｍに含まれる振動成分ｄｘのみを監視することにより誤判断を防止することが可能となる。
このように振動成分を検出する期間を指令に基づいて選択することにより、振動成分の誤検出がなくなり、優れた応答性を示す制御パラメータの調整が可能となる。
【０１０８】
なお、実施の形態７のシステム構成は、実施の形態１で説明した図１と同じ制御システムの構成として説明しているが、図２３に示した実施の形態６の制御システムの構成としても同様の効果が得られる。
【０１０９】
《実施の形態８》
以下、本発明に係る実施の形態８の電動機の位置制御装置について図２９を用いて説明する。図２９は本発明の実施の形態８に係る電動機の位置制御装置の制御システムの構成を示すブロック図である。実施の形態８の説明において、前述の実施の形態１における要素と同じ構成、機能を有するものには同じ番号を付して、その説明は省略する。実施の形態８の電動機の位置制御装置において、前述の実施の形態１の構成と異なるところは、イナーシャ推定部１６及びイナーシャ推定一時停止判断部１７が設けられていることである。
【０１１０】
以下、実施の形態８におけるイナーシャ推定部１６及びイナーシャ推定一時停止判断部１７の動作について説明する。
イナーシャ推定部１６は、検出速度ωｍと電動機１を制御するトルク指令τ１＊が入力され、電動機１及びこの電動機１で駆動される負荷７の総イナーシャを推定演算する。イナーシャ推定部１６においてイナーシャ推定演算された総イナーシャは、速度制御部５に入力され、速度制御部５の制御パラメータの補正に使われる。
【０１１１】
イナーシャ推定一時停止判断部１７は、検出速度ωｍが入力され、検出速度ωｍに含まれる所定周波数以上の振動成分の振幅を監視している。そして、イナーシャ推定一時停止判断部１７は、所定周波数以上の振動成分の振幅が所定値以上であることを検知すると、電動機１が振動状態であると判断し、イナーシャ推定部１６のイナーシャ推定演算を所定時間停止させる。検出速度ωｍに含まれる所定周波数以上の振動成分は、例えば検出速度ωｍに対して所定周波数をカットオフ周波数とするハイパスフィルタへ通過させることによって得られる。
電動機１及びこの電動機１で駆動される負荷７の全体が剛体で構成されていると仮定すると、総イナーシャと印加トルクτと検出速度ωｍは次式（６）の関係が成り立つ。
【０１１２】
【数６】

【０１１３】
式（６）において、Ｊは電動機１及び電動機１で駆動される負荷７の総イナーシャである。また、（ωｍ）’は検出速度ωｍの微分値であり、即ち加速度である。したがって、印加トルクτと加速度（ωｍ）’から総イナーシャＪを計算することができる。このように算出された総イナーシャＪを用いて速度制御部５の制御パラメータを補正することにより、応答周波数を一定に保つことができ、位置制御部４の制御パラメータとの関係を安定状態に保つことができる。
【０１１４】
振動状態の場合、その振動周波数が速度を検出するための制御周期の１／２以上であるとエイリアシング（ａｌｉａｓｉｎｇ）が起きてしまうため、式（６）で総イナーシャＪが正しく算出できない。したがって、振動状態に算出された総イナーシャＪの値を用いて速度制御部５の制御パラメータを補正すると、位置制御部４の制御パラメータとの関係が不安定になり、振動が抑制されない場合がある。
実施の形態８の電動機の位置制御装置においては、イナーシャ推定一時停止判断部１７が検出速度ωｍに含まれる振動成分の振幅を監視し、この振幅が所定値以上になったことを振動状態として検知している。この振動状態を検知した時点から所定時間において、イナーシャ推定部１６の総イナーシャＪのイナーシャ推定演算を停止させる。停止中の総イナーシャ値は停止直前の値を保持する。そして、所定時間経過した時点で振動状態を検知しなかった場合には、イナーシャ推定部１６の総イナーシャＪのイナーシャ推定演算を再開させる。
【０１１５】
このように、実施の形態８の電動機の位置制御装置は、振動状態を検知した時にイナーシャ推定演算を停止させることにより、イナーシャ推定部１６は正しいイナーシャ推定演算値のみを出力する構成である。このため、実施の形態８の電動機の位置制御装置は、速度制御部５の制御パラメータと位置制御部４の制御パラメータとの関係を常に安定状態に保つことができる。
【０１１６】
なお、実施の形態８においては、図２９に示したシステム構成を有する電動機の位置制御装置を一例として説明したが、図２３に示した実施の形態６のシステム構成にイナーシャ推定部１６とイナーシャ推定一時停止判断部１７を付加した構成としても同様の効果が得られる。
【０１１７】
実施の形態１から８の位置制御装置においては、速度検出部２の出力である検出速度ωｍを積分器３に通して検出位置θｍを求める構成で説明したが、本発明はこのような構成に限定されるものではなく、速度検出部２の代わりに位置検出部を設け、この位置検出部の出力である検出位置θｍから検出速度ωｍを求める構成としても前述の各実施の形態と同様の効果が得られる。
【０１１８】
また、実施の形態１から８において、第１の制御パラメータ調整部８、第２の制御パラメータ調整部９、第３の制御パラメータ調整部１０、及び第４の制御パラメータ調整部１２は、図５に示すような、位置制御部４の比例ゲインＫｐｐと、速度制御部５の比例ゲインＫｖｐと積分時定数Ｔｖｉのセットを複数有し、電動機の応答状態に応じて制御パラメータのセットの１つを選択するよう調整する構成の例で説明した。本発明はこのような構成に限定されるものではなく、位置制御部４の比例ゲインＫｐｐと速度制御部５の比例ゲインＫｖｐを含むセットであればどのような組み合わせのセットでもよい。
【０１１９】
また、実施の形態１から８において、第１の制御パラメータ調整部８、第２の制御パラメータ調整部９、第３の制御パラメータ調整部１０、及び第４の制御パラメータ調整部１２は、ステップ４ａ、ステップ４ｂ、又はステップ４ｃの後、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時に、位置制御部４の比例ゲインを調整して制御パラメータを設定する構成として説明した。本発明はこのような構成に限定されるものではなく、検出速度ωｍが所定値ωｍ＿ｔｈより小さい時に、位置制御部４の比例ゲインと所定値ωｍ＿ｔｈの両方を変化させて調整し、制御パラメータを設定する構成としても前述の各実施の形態と同様の効果が得られる。
【０１２０】
また、実施の形態１から８において、第１の制御パラメータ調整部８、第２の制御パラメータ調整部９、第３の制御パラメータ調整部１０、及び第４の制御パラメータ調整部１２は、ステップ１ａからステップ６ａまでの処理、ステップ１ｂからステップ６ｂまでの処理、又はステップ１ｃからステップ６ｃまでの処理を行う構成で説明した。しかし、ステップ１ａからステップ４ａまでの処理、ステップ１ｂからステップ４ｂまでの処理、又はステップ１ｃからステップ４ｃまでの処理であっても十分な応答性を得ることができる。このため、第１の制御パラメータ調整部８、第２の制御パラメータ調整部９、第３の制御パラメータ調整部１０、及び第４の制御パラメータ調整部１２においては、ステップ１ａからステップ４ａまでの処理、ステップ１ｂからステップ４ｂまでの処理、又はステップ１ｃからステップ４ｃまでの処理で終了する構成でもよい。
【０１２１】
また、実施の形態１から８において用いた電動機は、特定の種類に限定されるものではなく、例えば、直流電動機や永久磁石同期電動機を用いてもよい。また、本発明の電動機は回転型の電動機に限定されず、リニアモータを用いてもよい。
また、実施の形態３及び実施の形態４において、第３のパラメータ調整部１０の構成要素である第３のステップ処理部１０５は、ステップ２ｃからステップ６ｃまでの処理を、実施の形態１で説明したステップ２ａからステップ６ａまでの処理と同様である説明した。しかし、本発明においては、ステップ２ｃからステップ６ｃまでの処理を、実施の形態２で説明したステップ２ｂからステップ６ｂまでの処理と同様の処理としても実施の形態３及び実施の形態４と同様の効果が得られる。
【０１２２】
また、実施の形態５において、第４のパラメータ調整部１２の構成要素である第４のステップ処理部１１５は、実施の形態１で説明した第１のパラメータ調整部８の構成要素である第１のステップ処理部８５と同様の動作を行う構成とした。本発明の実施の形態５の位置制御装置はこのような構成に限定されるものではなく、実施の形態２で説明した第２のパラメータ調整部９の構成要素である第１のステップ処理部９５と同様の動作を行うよう構成してもよい。
【０１２３】
また、実施の形態５から８において、第１のパラメータ調整部８は、実施例２で説明した第２のパラメータ調整部９に置き換えても同様の効果が得られる。
また、実施の形態６から８において、第１のパラメータ調整部８は、実施例３から５で説明した第３のパラメータ調整部１０、第３のパラメータ調整部１０ｋ、第４のパラメータ調整部１２のいずれかに置き換えても同様の効果が得られる。
【０１２４】
以上、実施の形態において詳細に説明したところから明らかなように、本発明の電動機の位置制御装置は次の特徴を有する。
本発明の電動機の位置制御装置は、電動機の検出位置から前記電動機の速度を算出し、または電動機の検出速度から前記電動機の位置を算出する位置／速度演算部と、
前記検出位置を位置指令値に追従させる位置制御部と、
前記検出速度を前記位置制御部の出力に応じた速度指令値に追従させる速度制御部と、
前記速度制御部の出力に応じたトルク指令値に基づいて前記電動機を駆動する電動機駆動部と、
少なくとも前記位置制御部の比例ゲインと前記速度制御部の比例ゲインとを含む制御パラメータのセットを複数有し、セットの選択及び選択されたセットの制御パラメータを用いて前記電動機を制御したときの位置指令に対する前記電動機の応答状態の測定動作を順次行い、測定された応答結果に応じて１つのセットの制御パラメータを設定する制御パラメータ調整部とを具備する。このように構成された本発明の電動機の位置制御装置は、制御パラメータをセットで変更するので、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
【０１２５】
また、本発明の電動機の位置制御装置における制御パラメータ調整部は、
セットの選択及び選択されたセットの制御パラメータを用いて前記電動機を制御して前記電動機の応答状態の測定動作を順次行うとき、前記電動機の検出位置または検出速度に含まれる所定周波数以上の振動成分の検知、前記電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分の検知、及び位置指令完了後の位置指令値と検出位置との偏差の検知のうち少なくとも１つの振動成分の検知を含む測定動作を、前記速度制御部の比例ゲインの低いセットから高いセットへ順次行うよう構成されており、
位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が第１の所定値以上である期間が第１の所定時間以上であることを検知したときまでの測定された応答結果において、
（１）位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が前記第１の所定値以上である期間が前記第１の所定時間未満である条件（１）、
（２）位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が前記第１の所定値以上である期間が前記第１所定時間よりも短い第２の所定時間未満である条件（２）、及び
（３）位置指令の完了時点から次の指令開始までの期間で、位置指令値と検出位置との偏差が予め設定された整定幅と交差する回数が第１の所定回数以下である条件（３）、
の前記３つの条件のうち少なくとも条件（１）を含む１つ以上を満たしたセットから１つを選択して、その選択されたセットの制御パラメータを設定するよう構成されている。このように構成された本発明の電動機の位置制御装置は、振動持続を検知した時点で応答状態の測定を中止するので、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
【０１２６】
また、本発明の電動機の位置制御装置における制御パラメータ調整部は、
セットの選択及び選択されたセットの制御パラメータを用いて前記電動機を制御して前記電動機の応答状態の測定動作を順次行うとき、前記電動機の検出位置または検出速度に含まれる所定周波数以上の振動成分の検知、前記電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分の検知、及び位置指令完了後の位置指令値と検出位置との偏差の検知のうち少なくとも１つの振動成分の検知を含む測定動作を順次行うよう構成されており、
セットの選択において、
（Ａ）位置指令の開始から次の指令開始までの期間において、振動成分の振幅が第１の所定値以上である期間が第１の所定時間以上であることを検知した場合、応答状態を既に測定したセットでかつ振動成分の振幅が前記第１の所定値以上である時間が前記第１の所定時間以上であることを検知しなかったセットの中で最も高い速度制御部の比例ゲイン、あるいは前記条件に該当する速度制御部の比例ゲインがない場合は全セットの中で最も低い速度制御部の比例ゲインと、現時点で設定されている速度制御部の比例ゲインとの間の値を有する速度制御部の比例ゲインを持つセットを次に選択する第１の選択、
（Ｂ）位置指令の開始から次の指令開始までの期間において、振動成分の振幅が前記第１の所定値以上である期間が、前記第１の所定時間以上であることを検知しなかった場合、応答状態を既に測定したセットでかつ振動成分の振幅が前記第１の所定値以上である期間が、前記第１の所定時間以上であることを検知したセットの中で最も低い速度制御部の比例ゲイン、あるいは前記条件に該当する速度制御部の比例ゲインがない場合は全セットの中で最も高い速度制御部の比例ゲインと、現時点で設定されている速度制御部の比例ゲインとの間の値を有する速度制御部の比例ゲインを持つセットを次に選択する第２の選択、の２つの選択を繰り返し行い、
前記選択において、次に選択するセットが存在しなくなったとき、測定された応答結果において、
（１）位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が前記第１の所定値以上である時間が前記第１の所定時間未満である条件（１）、
（２）位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が前記第１の所定値以上である期間が前記第１所定時間よりも短い第２の所定時間未満である条件（２）、及び
（３）位置指令の完了時点から次の指令開始までの期間で、位置指令値と検出位置との偏差が予め設定された整定幅と交差する回数が第１の所定回数以下である条件（３）、
の前記３つの条件のうち少なくとも条件（１）を含む１つ以上を満たしたセットから１つを選択して、その選択されたセットの制御パラメータを設定するよう構成されている。このように構成された本発明の電動機の位置制御装置は、セットの選択を繰り返すことにより、次に選択するセットがなくなった時点で、それまでの応答結果に基づいて好ましいセットを１つ選択し、選択されたセットの制御パラメータを設定しているので、短時間で好ましい制御パラメータに調整することができる。
【０１２７】
また、本発明の電動機の位置制御装置における制御パラメータ調整部は、外部から指定された開始セットを最初に選択するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、任意の開始セットを指定できるため、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
また、本発明の電動機の位置制御装置は、開始セットが関連づけられた複数の負荷構成パターンを有し、前記複数の負荷構成パターンの中の１つが外部から指定される負荷構成パターン入力部が設けられており、
前記制御パラメータ調整部は、前記負荷構成パターン入力部から入力された負荷構成パターンに関連づけられた開始セットを最初に選択するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、入力された負荷構成パターンに最適な開始セットが決定されているため、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
【０１２８】
また、本発明の電動機の位置制御装置における制御パラメータ調整部は、位置指令の開始から次の指令開始までの期間において、振動成分の振幅が前記第１の所定値以上である期間が前記第１の所定時間以上であることを検知したとき、直ちに、現在の速度制御部の比例ゲインよりも低い速度制御部の比例ゲインを持つセットの制御パラメータを設定して、前記電動機を第２の所定回数だけ制御した後、次のセットを選択するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、制御パラメータ調整中に振動が発生した場合でも、確実に短時間で振動を収束させることができ安全な制御パラメータの調整ができる。
また、本発明の電動機の位置制御装置における制御パラメータ調整部は、少なくとも、前記位置指令値、前記速度指令値、前記検出位置、前記検出速度のうち少なくとも１つに基づいた位置制御部の比例ゲインと速度制御部の比例ゲインとを含む制御パラメータのセットを複数有し、セットの選択及び選択されたセットの制御パラメータを用いて前記電動機を制御したときの位置指令に対する電動機の応答状態の測定動作を順次行い、測定された応答状態に応じて制御パラメータのセットの１つを選択して、選択されたセットの制御パラメータを設定するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、位置指令値、速度指令値、検出位置、及び検出速度のうち少なくとも１つに基づいて制御パラメータを調整しているため、位置指令に対し優れた応答性を有する制御を実現できるように制御パラメータを調整することができる。
【０１２９】
また、本発明の電動機の位置制御装置は、電動機の検出位置から前記電動機の速度を算出し、または電動機の検出速度から前記電動機の位置を算出する位置／速度演算部と、
前記検出位置を位置指令値に追従させる位置制御部と、
前記検出速度を前記位置制御部の出力に応じた速度指令値に追従させる速度制御部と、
前記速度制御部の出力に応じたトルク指令値に基づいて前記電動機を駆動する電動機駆動部と、
少なくとも前記位置制御部の比例ゲインと前記速度制御部の比例ゲインとを含む制御パラメータのセットを複数有する制御パラメータ調整部と、を具備し、
前記制御パラメータ調整部は、
セットの選択及び選択されたセットの制御パラメータを用いて前記電動機を制御して前記電動機の応答状態の測定動作を順次行うとき、前記電動機の検出位置または検出速度に含まれる所定周波数以上の振動成分の検知、前記電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分の検知、及び位置指令完了後の位置指令値と検出位置との偏差の検知のうち少なくとも１つの振動成分の検知を含む測定動作を順次行うよう構成されており、測定された結果において、
（１）位置指令の開始から次の指令開始までの期間で、振動成分の振幅が前記第１の所定値以上である期間が第１の所定時間未満である条件（１）、
（２）位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が第１の所定値以上である期間が前記第１所定時間よりも短い第２の所定時間未満である条件（２）、及び
（３）位置指令の完了時点から次の指令開始までの期間で、位置指令値と検出位置との偏差が予め設定された整定幅と交差する回数が第１の所定回数以下である条件（３）、
の前記３つの条件のうち少なくとも条件（１）を含む１つ以上を満たしたセットから１つを選択して、その選択されたセットの制御パラメータを設定した時から第３の所定回数だけ前記電動機を制御する間、位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が前記第１の所定値以上である期間が前記第１の所定時間以上であることを検知した時、前記３つの条件のうち少なくとも条件（１）を含む１つ以上を満たしたセットのうち現在のセットを除いたセットのなかで、前記速度制御部の比例ゲインが最も高いセットを新たに選択して、新たに選択されたセットの制御パラメータを設定するよう構成されている。このように構成された本発明の電動機の位置制御装置は、選択されたセットの制御パラメータを設定した後、電動機を所定回数だけ制御して、振動しないかどうかを再確認するよう構成されているので、安定な制御パラメータを確実に設定できる。
【０１３０】
本発明の他の観点の電動機の位置制御装置は、電動機の検出位置から前記電動機の速度を算出し、または電動機の検出速度から前記電動機の位置を算出する位置／速度演算部と、
前記検出位置を位置指令値に追従させる位置制御部と、
前記検出速度を前記位置制御部の出力に応じた速度指令値に追従させる速度制御部と、
前記速度制御部の出力に応じたトルク指令値に基づいて前記電動機を駆動する電動機駆動部と、
少なくとも前記位置制御部の比例ゲインと前記速度制御部の比例ゲインを含む制御パラメータのセットを複数有する制御パラメータ調整部と、を具備し、
前記制御パラメータ調整部は、
セットの選択及び選択されたセットの制御パラメータを用いて前記電動機を制御して前記電動機の応答状態の測定動作を順次行うとき、前記電動機の検出位置または検出速度に含まれる所定周波数以上の振動成分の検知、前記電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分の検知、及び位置指令完了後の位置指令値と検出位置との偏差の検知のうち少なくとも１つの振動成分の検知を含む測定動作を順次行うよう構成されており、測定された応答結果において、
（１）位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が前記第１の所定値以上である時間が第１の所定時間未満である条件（１）、
（２）位置指令の開始から次の指令開始までの期間で、前記振動成分の振幅が前記第１の所定値以上である期間が前記第１所定時間よりも短い第２の所定時間未満である条件（２）、及び
（３）位置指令の完了時点から次の指令開始までの期間で、位置指令値と検出位置との偏差が予め設定された整定幅と交差する回数が第１の所定回数以下である条件（３）、
の前記３つの条件のうち少なくとも条件（１）を含む１つ以上を満たしたセットから１つを選択して、その選択されたセットの制御パラメータを設定し、
次に、現在設定されている制御パラメータのうち少なくとも前記速度制御部の比例ゲインを固定し、残りの制御パラメータを変化させ、前記電動機を制御したときの位置指令に対する前記電動機の応答状態に応じて、固定したパラメータ以外のパラメータを設定するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、セットで制御パラメータを調整した後、さらに個別に各制御パラメータを調整するよう構成されているため、応答性の高い調整が可能となる。
【０１３１】
また、本発明の他の観点の電動機の位置制御装置は、電動機の検出位置から前記電動機の速度を算出し、または電動機の検出速度から前記電動機の位置を算出する位置／速度演算部と、
前記検出位置を位置指令値に追従させる位置制御部と、
前記検出速度を前記位置制御部の出力に応じた速度指令値に追従させる速度制御部と、
前記速度制御部の出力に応じたトルク指令値に基づいて前記電動機を駆動する電動機駆動部と、
位置指令完了後、前記検出位置と前記位置指令値との偏差が予め設定された整定幅に入るまでの時間の目標値が外部から設定される制御パラメータ調整部と、を具備し、
前記制御パラメータ調整部は、セットを選択し、選択されたセットの制御パラメータで前記電動機の応答状態を測定する動作において、位置指令完了後、前記検出位置と前記位置指令値との偏差が整定幅に入るまでの時間が、外部から設定された前記目標値以下になった時、セットの選択を停止し、その時の制御パラメータを設定するよう構成されている。このように構成された本発明の電動機の位置制御装置は、制御パラメータの調整過程で、外部から入力された目標指標を満足した時に、制御パラメータの調整を停止し、その時点の制御パラメータを調整結果として設定するよう構成されているので、短時間で制御パラメータの調整ができる。
【０１３２】
また、本発明の電動機の位置制御装置は、位置制御系内または速度制御系内のいずれかに配置され、ノッチ中心周波数が可変であるノッチフィルタと、
前記検出位置または前記検出速度に含まれる所定周波数以上の振動成分、あるいは前記電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分を、減少させるよう前記ノッチフィルタのノッチ周波数を逐次修正するノッチ周波数修正部とが設けられている。このように構成された本発明の電動機の位置制御装置においては、制御対象の共振周波数による発振を抑圧するノッチフィルタを自動的に生成するため、制御対象の周波数応答を測定することなく応答性の高い制御パラメータの調整が可能となる。
【０１３３】
また、本発明の電動機の位置制御装置は、位置制御系内または速度制御系内のいずれかに配置され、ノッチ中心周波数が可変であるノッチフィルタと、
前記検出位置または前記検出速度に含まれる所定周波数以上の振動成分、あるいは電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分を、減少させるよう前記ノッチフィルタのノッチ周波数を逐次修正するノッチ周波数修正部と、
選択されたセットが変化した時、変化直前の前記セットと変化直前のノッチ周波数を関連づけて記憶し、新たに選択されたセットが過去に選択されたセットと同じとき、過去に選択された前記セットに関連づけて記憶されたノッチ周波数を前記ノッチフィルタのノッチ周波数として設定し直すノッチ周波数記憶部と、が設けられている。このように構成された本発明の電動機の位置制御装置においては、制御パラメータ調整中に振動などでノッチフィルタのノッチ周波数が変化した場合でも、過去に選択されたセットで制御された時のノッチ周波数に確実に戻すことができる。
【０１３４】
また、本発明の電動機の位置制御装置は、位置制御系内または速度制御系内のいずれかに配置され、ノッチ周波数が可変であるノッチフィルタと、
前記検出位置または前記検出速度に含まれる所定周波数以上の振動成分、あるいは電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分を、減少させるよう前記ノッチフィルタのノッチ周波数を逐次修正するノッチ周波数修正部と、
選択されたセットが変化する時、変化直前のセットと変化直前のノッチ周波数を関連づけて記憶し、新たに選択されたセットが過去に選択されたセットと同じとき、過去に選択された前記セットに関連づけて記憶されたノッチ周波数を前記ノッチフィルタのノッチ周波数として設定し直し、その後、第４の所定時間の間は前記ノッチフィルタのノッチ周波数を変更を禁止するノッチ周波数記憶部と、が設けられている。このように構成された本発明の電動機の位置制御装置においては、ノッチフィルタのノッチ周波数を過去に選択されたセットで制御された時点のノッチ周波数に戻した後、振動収束途中の振動によってノッチ周波数が変更されることを防ぐことができるため、ノッチ周波数を確実に戻すことができる。
【０１３５】
また、本発明の電動機の位置制御装置における制御パラメータ調整部は、
位置指令が所定条件を満たす期間のみ、電動機の検出位置または検出速度に含まれる所定周波数以上の振動成分を検知するか、あるいは電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分を検知するよう構成されている。このように構成された本発明の電動機の位置制御装置においては、検出位置または検出速度に含まれる所定周波数以上の振動成分の誤検出がなくなり、応答性の高い制御パラメータの調整ができる。
【０１３６】
さらに、本発明の他の観点の電動機の位置制御装置は、電動機の検出位置から前記電動機の速度を算出し、または電動機の検出速度から前記電動機の位置を算出する位置／速度演算部と、
前記検出位置を位置指令値に追従させる位置制御部と、
前記検出速度を前記位置制御部の出力に応じた速度指令値に追従させる速度制御部と、
前記速度制御部の出力に応じたトルク指令値に基づいて前記電動機を駆動する電動機駆動部と、
前記検出速度から算出される加速度と前記トルク指令値に基づいて前記電動機及び前記電動機で駆動される負荷の総イナーシャを推定するイナーシャ推定部と、
前記電動機の検出位置または検出速度に含まれる所定周波数以上の振動成分の振幅、あるいは前記電動機駆動部への入力であるトルク指令に含まれる所定周波数以上の振動成分の振幅が所定値以上であることを検知した時から、前記イナーシャ推定部のイナーシャ推定演算を所定時間停止させるイナーシャ推定一時停止判断部と、
少なくとも前記位置制御部の比例ゲインと前記速度制御部の比例ゲインを含む制御パラメータのセットを複数有し、セットを選択し、選択されたセットの制御パラメータを用いて前記電動機を制御したときの位置指令に対する前記電動機の応答状態を測定し、この応答状態に応じて１つのセットの制御パラメータを設定する制御パラメータ調整部、を具備する。このように構成された本発明の電動機の位置制御装置は、検出位置または検出速度に含まれる所定周波数以上の振動成分の振幅が所定値以上であることを検知したとき、イナーシャ推定動作を一時停止するよう構成されているので、イナーシャ推定動作を安定化させることができ、安定性を持つ制御パラメータの調整ができる。
発明をある程度の詳細さをもって好適な形態について説明したが、この好適形態の現開示内容は構成の細部において変化してしかるべきものであり、各要素の組合せや順序の変化は請求された発明の範囲及び思想を逸脱することなく実現し得るものである。
【０１３７】
【発明の効果】
以上、実施の形態において詳細に説明したところから明らかなように、本発明の電動機の位置制御装置は次の効果を有する。
本発明の電動機の位置制御装置においては、制御パラメータをセットで変更するので、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
また、本発明の電動機の位置制御装置は、振動持続を検知した時点で応答状態の測定を中止するよう構成されているため、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
また、本発明の電動機の位置制御装置においては、セットの選択を繰り返すことにより、次に選択するセットがなくなった時点で、それまでの応答結果に基づいて好ましいセットを１つ選択し、選択されたセットの制御パラメータを設定しているので、短時間で好ましい制御パラメータに調整することができる。
【０１３８】
また、本発明の電動機の位置制御装置における制御パラメータ調整部が外部から指定された開始セットを最初に選択するよう構成されているので、任意の開始セットを指定できるため、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
また、本発明の電動機の位置制御装置においては、入力された負荷構成パターンに最適な開始セットが決定されているため、調整回数を減らすことができ、短時間で制御パラメータを調整することができる。
また、本発明の電動機の位置制御装置においては、制御パラメータ調整中に振動が発生した場合でも、確実に短時間で振動を収束させることができ安全な制御パラメータの調整ができる。
【０１３９】
また、本発明の電動機の位置制御装置においては、位置指令値、速度指令値、検出位置、及び検出速度のうち少なくとも１つに基づいて制御パラメータを調整しているため、位置指令に対し優れた応答性を有する制御を実現できるように制御パラメータを調整することができる。
また、本発明の電動機の位置制御装置は、選択されたセットの制御パラメータを設定した後、電動機を所定回数だけ制御して、振動しないかどうかを再確認するよう構成されているので、安定な制御パラメータを確実に設定できる。
本発明の電動機の位置制御装置においては、セットで制御パラメータを調整した後、さらに個別に各制御パラメータを調整するよう構成されているため、応答性の高い調整が可能となる。
【０１４０】
また、本発明の電動機の位置制御装置は、制御パラメータの調整過程で、外部から入力された目標指標を満足した時に、制御パラメータの調整を停止し、その時点の制御パラメータを調整結果として設定するよう構成されているので、短時間で制御パラメータの調整ができる。
また、本発明の電動機の位置制御装置においては、制御対象の共振周波数による発振を抑圧するノッチフィルタを自動的に生成するため、制御対象の周波数応答を測定することなく応答性の高い制御パラメータの調整が可能となる。
また、本発明の電動機の位置制御装置においては、制御パラメータ調整中に振動などでノッチフィルタのノッチ周波数が変化した場合でも、過去に選択されたセットで制御された時のノッチ周波数に確実に戻すことができる。
【０１４１】
また、本発明の電動機の位置制御装置においては、ノッチフィルタのノッチ周波数を過去に選択されたセットで制御された時点のノッチ周波数に戻した後、振動収束途中の振動によってノッチ周波数が変更されることを防ぐことができるため、ノッチ周波数を確実に戻すことができる。
また、本発明の電動機の位置制御装置においては、検出位置または検出速度に含まれる所定周波数以上の振動成分の誤検出がなくなり、応答性の高い制御パラメータの調整ができる。
【０１４２】
さらに、本発明の電動機の位置制御装置は、検出位置または検出速度に含まれる所定周波数以上の振動成分の振幅が所定値以上であることを検知したとき、イナーシャ推定動作を一時停止するよう構成されているので、イナーシャ推定動作を安定化させることができ、安定性を持つ制御パラメータの調整ができる。
【図面の簡単な説明】
【図１】本発明に係る実施の形態１における電動機の位置制御装置の構成を示すブロック図である。
【図２】本発明に係る実施の形態１における第１のパラメータ調整部の構成の一例を示すブロック図である。
【図３】本発明に係る実施の形態１における振動持続時間測定部の動作を説明するための動作波形図である。
【図４】本発明に係る実施の形態１におけるコイン割れ回数／整定時間測定部の動作を説明するための動作波形図である。
【図５】本発明に係る実施の形態１における制御パラメータのセットの一覧の例を示す表である。
【図６】本発明に係る実施の形態１における倍率設定値の一覧の例を示す表である。
【図７】本発明に係る実施の形態１における第１の制御パラメータ調整部の動作を示す第１のフローチャートである。
【図８】本発明に係る実施の形態１における第１の制御パラメータ調整部の動作を示す第２のフローチャートである。
【図９】本発明に係る実施の形態１におけるセット番号と評価条件の結果の一例を示す表である。
【図１０】本発明に係る実施の形態１における倍率設定値と評価条件の結果の一例を示す表である。
【図１１】本発明に係る実施の形態２における電動機の位置制御装置の構成を示すブロック図である。
【図１２】本発明に係る実施の形態２における第２の制御パラメータ調整部の構成の一例を示すブロック図である。
【図１３】本発明に係る実施の形態２における第２の制御パラメータ調整部の動作を示す第１のフローチャートである。
【図１４】本発明に係る実施の形態２における第２の制御パラメータ調整部の動作を示す第２のフローチャートである。
【図１５】本発明に係る実施の形態３における電動機の位置制御装置の構成を示すブロック図である。
【図１６】本発明に係る実施の形態３における第３の制御パラメータ調整部の構成の一例を示すブロック図である。
【図１７】本発明に係る実施の形態３における第３の制御パラメータ調整部の動作を示すフローチャートである。
【図１８】本発明に係る実施の形態４における電動機の位置制御装置の構成を示すブロック図である。
【図１９】装置構成と開始セット番号とを関連づけた一覧の例を示す表である。
【図２０】装置構成の一例を示す構成図である。
【図２１】本発明に係る実施の形態５における電動機の位置制御装置の構成を示すブロック図である。
【図２２】本発明に係る実施の形態５における第４の制御パラメータ調整部の構成の一例を示すブロック図である。
【図２３】本発明に係る実施の形態６における電動機の位置制御装置の構成を示すブロック図である。
【図２４】本発明に係る実施の形態６におけるノッチ周波数修正部の構成の一例を示すブロック図である。
【図２５】本発明に係る実施の形態６におけるノッチ周波数修正部の動作時の検出速度、振動成分、及びノッチ周波数の時間変化の一例を示す波形図である。
【図２６】本発明に係る実施の形態７において、位置指令値、位置指令値の微分値、検出速度、振動成分、及び位置指令値の加速度の変化における時間変化の第１の例を示す波形図である。
【図２７】本発明に係る実施の形態７において、位置指令値、位置指令値の微分値、検出速度、振動成分、及び位置指令値の加速度の変化における時間変化の第２の例を示す波形図である。
【図２８】本発明に係る実施の形態７において、位置指令値、位置指令値の微分値、検出速度、振動成分、及び位置指令値の加速度の変化における時間変化の第３の例を示す波形図である。
【図２９】本発明に係る実施の形態８における電動機の位置制御装置の構成を示すブロック図である。
【図３０】第１の従来技術に係る電動機の位置制御装置のシステム構成を示すブロック図である。
【図３１】第１の従来技術に係る電動機の位置制御装置における速度制御部をＰ制御にしたときの制御構成を示す図である。
【図３２】第１の従来技術に係る電動機の位置制御装置における速度制御部の積分ゲインを非０にしたときの制御構成を示すブロック図である。
【図３３】第２の従来技術に係る電動機の位置制御装置のシステム構成を示すブロック図である。
【符号の説明】
１　電動機
２　速度検出部
３　積分器
４　位置制御部
５　速度制御部
６　電動機駆動部
７　負荷
８　第１の制御パラメータ調整部
９　第２の制御パラメータ調整部
１０　第３の制御パラメータ調整部
１１　負荷構成パターン入力部
１２　第４の制御パラメータ調整部
１３　ノッチフィルタ
１４　ノッチ周波数修正部
１５　ノッチ周波数記憶部
１６　イナーシャ推定部
１７　イナーシャ推定一時停止判断部
８１　ハイパスフィルタ
８２　振動持続時間測定部
８３　指令開始／完了検出部
８４　コイン割れ回数／整定時間測定部
８５　第１のステップ処理部
９５　第２のステップ処理部
１０５　第３のステップ処理部
１１５　第４のステップ処理部[0001]
TECHNICAL FIELD OF THE INVENTION
Background of the Invention
The present invention relates to a position control device that controls the rotational position of a motor, and more particularly to a position control device for a motor that adjusts control parameters.
[0002]
[Prior art]
2. Description of the Related Art As a conventional technique relating to position control of an electric motor, a technique described in Japanese Patent No. 2890529 (first conventional technique) is known (Patent Document 1). Hereinafter, the first related art will be described.
[0003]
FIG. 30 is a block diagram showing a configuration of a control system in a motor position control device according to a first conventional technique. In the control system of the position control device shown in FIG. 30, in addition to the position feedback loop of the rotation position of the electric motor 501, a speed feedback loop for controlling the rotation speed of the electric motor 501, and for controlling the current of the electric motor 501. Current feedback loop is provided. In the current feedback loop, control is performed so that the value obtained by digital-to-analog conversion of the output value of the speed control unit 507 and the motor current supplied from the power amplifier 509 to the motor 501 become zero. In the speed feedback loop, control is performed so that the output value of the position control unit 505 and the motor speed calculated by the speed calculation unit 506 become equal. Finally, in the position feedback loop, control is performed so that the difference between the position detected by the position detector 502 such as a pulse encoder or a linear scale and the position command value given from the command generator 503 becomes zero. .
[0004]
An output from the position detector 502 is input to a position counter 504 and converted into a rotation position of the electric motor 501. The speed calculator 506 calculates the rotation speed from the output of the position detector 502. As shown in FIG. 30, the difference between the rotational position and the position command value provided from command generation unit 503 is input to position control unit 505, and position control unit 505 outputs a speed command value. The difference between the speed command value and the rotation speed from the speed calculation unit 506 is input to the speed control unit 507, and the speed control unit 507 outputs a command value for driving the electric motor 501. This command value is input to the power amplifier 509 through the D / A converter 508. The power amplifier 509 drives the electric motor 501 according to the input from the D / A converter 508.
[0005]
In FIG. 30, reference numeral 510 denotes a parameter change determination unit, which has a function of changing control parameters of the position control unit 505 and the speed control unit 507. In FIG. 30, a thick arrow indicates a digital quantity signal, a thin arrow indicates an analog quantity signal, and a broken arrow indicates an instruction signal.
[0006]
Hereinafter, the operation of parameter change determination section 510 shown in FIG. 30 will be described.
First, the speed control unit 507 is set to proportional control (P control). FIG. 31 is a block diagram of the entire control system when the speed control unit 507 performs the P control. FIG. 31 is a block diagram in the case where the response frequency can be set high enough to make the current feedback loop a constant, and the speed feedback loop can be approximated by a linear expression. Further, the gain of the control target taking into account the constant gain of the current feedback loop, the motor torque constant, the inertia of the sum of the electric motor and the load, the resolution of the position detector 502, and the like is 1 / J.
[0007]
Transfer function G of the entire control system shown in FIG. ₂ (S) is given by the following equation (1).
[0008]
(Equation 1)

[0009]
When the proportional gain Kvp of the speed control unit 507 is fixed to a value at which the natural frequency of the processing device to be controlled can be ignored, and the proportional gain Kpp of the position control unit 505 is set higher than the proportional gain Kvp, the servo system gradually vibrates. become. Vibration frequency is f _i Then, the vibration frequency f _i Has a relationship of the following equation (2) with respect to the proportional gain Kpp and the proportional gain Kvp.
[0010]
(Equation 2)

[0011]
At this time, the vibration frequency fi is measured while driving the electric motor 501 with the position command given from the command generator 503. Then, based on the equation (2), a gain 1 / J of the control target including constants such as the inertia of the motor 501 and the load is obtained.
[0012]
Thereafter, the operation of the speed control unit 507 is switched to integral / proportional control (IP control). The proportional gain of the speed control unit 507 is Kvp, and the integral gain is K _VI And the integral gain K of the speed control unit 507 _VI Is a non-zero value (non-zero value), a block diagram at this time is shown in FIG. The transfer function G of the entire control system at this time ₁ (S) is represented by the following equation (3).
[0013]
[Equation 3]

[0014]
In the first prior art control system configured as described above, the proportional gain Kvp and the integral gain K _VI , And the proportional gain Kpp of the position control unit 505, while keeping the three gain relations constant, until the resonance state occurs between the response frequency component of the electric motor 501 and the natural frequency of the processing device to be controlled. Is gradually raised. After the resonance state, the three gains are gradually decreased in the opposite manner, and the gain when the resonance stops is set as the optimum gain.
[0015]
Further, as another conventional technique relating to position control of an electric motor, there is a technique disclosed in Japanese Patent Application Laid-Open No. H10-56790 (second conventional technique) (Patent Document 2). Hereinafter, a second prior art electric motor position control device will be described with reference to the drawings.
FIG. 33 is a block diagram showing a system configuration of a second conventional motor position control device.
[0016]
In FIG. 33, the electric motor 601 is driven by the electric motor torque, and the load machine 602 is driven by the electric motor 601. The rotation position and rotation speed of the electric motor 601 are detected by a rotation detector 603. The torque control circuit 604 matches the motor torque with the torque command signal. The position command signal generation circuit 605 forms a position command signal that is a position command for the electric motor 601 and the load machine 602, and outputs the position command signal to the feedforward circuit 608. The feedforward circuit 608 receives the position command signal and outputs a feedforward signal, a response target position signal, and a response target speed signal.
As shown in FIG. 33, the second conventional position control device includes a speed compensation circuit 606, a position compensation circuit 607, a switch 609, a drive test torque command signal generation circuit 610, and an automatic adjustment circuit 611. ing.
[0017]
Next, the operation of the position control device of the second related art configured as described above will be described.
First, the switch 609 is switched to the contact (b), and the drive test torque command signal generation circuit 610 outputs a torque command signal such as a pseudo random signal to the torque control circuit 604. The drive test torque command signal generation circuit 610 outputs a torque command signal to the torque control circuit 604 to perform a drive test of the motor 601, and inputs the torque command signal and the rotation speed of the motor 601 to the automatic adjustment circuit 611 at that time. I do.
[0018]
The automatic adjustment circuit 611 calculates the parameters of the built-in higher-order transfer function model using, for example, the least squares method, and thereby obtains detailed information on the transfer function from the torque command signal to be controlled to the rotation speed of the motor. Perform identification. The absolute value of the smallest complex zero of the identified transfer function is selected as the estimated anti-resonance frequency ωze. Further, the total inertia Je is estimated from the gain characteristics in the low frequency region. Of the two-inertial-system optimum gain Kopt calculated using the estimated anti-resonance frequency ωze and the estimated total inertia Je, and the limit gain Kmax obtained using the frequency characteristics of the transfer function, the gain margin, and the phase margin, The smaller gain is determined as the speed gain Kv of the speed compensation circuit 606. Based on the determined speed gain Kv, the position gain Kp and the position integral gain KpI of the position compensation circuit 607 are determined using a predetermined calculation formula. The gain parameter of the feedforward circuit 608 is also calculated and determined using the estimated anti-resonance frequency ωze and the estimated total inertia Je.
[0019]
[Patent Document 1]
Patent No. 2890529 (pages 2-4, FIG. 2)
[Patent Document 2]
JP-A-10-56790 (pages 8-12, FIG. 1)
[0020]
[Problems to be solved by the invention]
As described above, in the first prior art of Japanese Patent No. 2890529, the optimum control parameter is determined by detecting the resonance state generated between the electric motor and the control target while keeping the plurality of gain relationships constant. Was. When the control target has a resonance frequency, it is possible to further increase the value of the control parameter and increase the responsiveness by inserting a filter that suppresses the resonance frequency component. Adjustment was insufficient.
[0021]
In the second prior art disclosed in Japanese Patent Application Laid-Open No. H10-56790, the anti-resonance frequency of the control target is set to be stable for the control target having resonance characteristics. It is necessary to measure the estimated value and the frequency response value of the control target. In order to obtain these values, operations such as measurement with a test signal applied were required.
[0022]
The present invention is to solve various problems as described above in the related art, and also for a control target having a resonance frequency, without previously measuring the frequency characteristics of the control target, and having a high response. It is an object of the present invention to provide a motor position control device capable of adjusting control parameters in a short time.
[0023]
[Means for Solving the Problems]
In order to achieve the above object, the motor position control device of the present invention has a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects the set. And measuring the response state of the motor to the position command when controlling the motor using the selected set of control parameters, and sequentially selecting one of the preferable sets according to the measured response state, and selecting the selected set. Set the control parameters of the set to the device. The motor position control device of the present invention configured as described above changes the control parameters as a set, so that the number of adjustments can be reduced and the control parameters can be adjusted in a short time.
[0024]
Further, the electric motor position control device according to another aspect of the present invention has a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects and selects the set. The response state of the motor to the position command when the motor is controlled using the set of control parameters is measured sequentially from the set with the lower proportional gain of the speed control unit, and the response state is measured when the vibration continuation is detected. Is stopped, and one of the sets is selected based on the previous response result, and the control parameters of the selected set are set. The motor position control device of the present invention configured as described above stops measuring the response state at the time of detecting the vibration continuation, so that the number of adjustments can be reduced and the control parameters can be adjusted in a short time. it can.
[0025]
Further, the electric motor position control device according to another aspect of the present invention has a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects and selects the set. The response state of the motor to the position command when the motor is controlled using the set control parameters is sequentially measured, and as a selection of the set, if the vibration continuation is detected, the current in the plurality of proportional gains of the speed control unit is determined. Next, a set lower than the current set is selected, and if no continuous oscillation is detected, a set higher than the current set in the plurality of proportional gains of the speed control unit is selected next. By repeating the selection of sets in this way, when there is no more set to be selected next, one preferable set is selected based on the response results up to that point, and the control parameters of the selected set are set. The electric motor position control device of the present invention configured as described above can reduce the number of adjustments, and can adjust control parameters in a short time.
[0026]
Further, the electric motor position control device according to another aspect of the present invention has a plurality of sets of control parameters including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects and selects the set. The response state of the motor to the position command when the motor is controlled using the set of control parameters is measured, and one preferable set of control parameters is selected according to the response state. Then, when setting the control parameters of the selected set, a start set can be designated from outside. In the electric motor position control device of the present invention configured as described above, an arbitrary start set can be designated, so that the number of adjustments can be reduced and control parameters can be adjusted in a short time.
[0027]
Further, the electric motor position control device according to another aspect of the present invention has a plurality of sets of control parameters including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects and selects the set. The response state of the motor to the position command when the motor is controlled using the set of control parameters is measured, and one preferable set of control parameters is selected according to the response state. Then, when setting the control parameters of the selected set, the response state is measured from a start set associated with the load configuration pattern input from the outside. In the motor position control device of the present invention configured as described above, since the optimal start set is determined for the input load configuration pattern, the number of adjustments can be reduced, and the control parameters can be adjusted in a short time. can do.
[0028]
According to another aspect of the present invention, there is provided a position control device for an electric motor, wherein the amplitude of a vibration component having a frequency equal to or higher than a predetermined frequency included in a detected position or a detected speed of the electric motor, or a predetermined value included in a torque command input to the electric motor drive unit. When detecting that the period in which the amplitude of the vibration component equal to or higher than the frequency is equal to or larger than the first predetermined value is equal to or longer than the first predetermined time, the proportionality of the speed control unit that is lower than the proportional gain of the speed control unit of the current set is immediately used. It is configured to set a set of control parameters having a gain. In the motor position control device of the present invention configured as described above, even when vibration occurs during control parameter adjustment, the vibration can be surely converged in a short time, and the control parameter can be adjusted safely.
[0029]
According to another aspect of the present invention, there is provided a position control device for an electric motor, comprising: a proportional gain of a position control unit and a proportional gain of the speed control unit based on at least one of a position command value, a speed command value, a detected position, and a detected speed. A plurality of control parameter sets including at least a gain are provided in advance. The position control device selects a set, measures a response state of the motor to a position command when the motor is controlled using the control parameters of the selected set, and determines a preferred set as 1 according to the response state. Select one and set the control parameters for the selected set. In the electric motor position control device of the present invention configured as described above, the control parameter is adjusted based on at least one of the position command value, the speed command value, the detected position, and the detected speed. Control parameters can be adjusted so that control with excellent responsiveness can be realized.
[0030]
Further, the position control device for the electric motor according to another aspect of the present invention has a plurality of sets of control parameters including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects the set. A response state of the motor to a position command when the motor is controlled using the selected set of control parameters is measured, and one preferable set of control parameters is selected according to the response state. Then, after the selected set of control parameters is set, the motor is controlled a predetermined number of times to check again whether or not it will vibrate, so that stable control parameters can be reliably set.
[0031]
Further, the position control device for the electric motor according to another aspect of the present invention has a plurality of sets of control parameters including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects the set. A response state of the motor to a position command when the motor is controlled using the selected set of control parameters is measured, and one preferable set of control parameters is selected according to the response state. Then, the selected set of control parameters is set, and then at least one of the currently set control parameters is fixed, and the remaining control parameters are changed to control the motor with respect to the position command when the motor is controlled. The parameter to be changed is adjusted according to the response state of. In the electric motor position control device of the present invention configured as described above, after the control parameters are adjusted as a set, each control parameter is further adjusted individually, so that a highly responsive adjustment can be performed.
[0032]
Further, in the motor position control device according to another aspect of the present invention, in the process of adjusting the control parameters, when the target index input from the outside is satisfied, the adjustment of the control parameters is stopped, and the control parameters at that time are changed. It is configured to set as an adjustment result. In the electric motor position control device of the present invention configured as described above, control parameters can be adjusted in a short time.
[0033]
A motor position control device according to another aspect of the present invention includes a notch filter having a variable notch frequency disposed in either a position control system or a speed control system, and a predetermined frequency included in a detection position or a detection speed. A notch frequency correction unit for sequentially correcting the notch frequency of the notch filter so as to reduce the vibration component of the notch. In the electric motor position control device of the present invention configured as described above, the notch filter that suppresses oscillation due to the resonance frequency of the control target is automatically generated, so that the responsiveness is measured without measuring the frequency response of the control target. Adjustment of a high control parameter becomes possible.
[0034]
According to another aspect of the present invention, there is provided a position control device for an electric motor, wherein when a set of control parameters changes, a set immediately before the change and a notch frequency immediately before the change are stored in association with each other, and the control output from the control parameter adjustment unit is stored. A notch frequency storage unit is provided which resets the notch frequency stored in association with the changed set to the frequency of the notch filter when the set of parameters has changed to a set selected in the past. In the electric motor position control device of the present invention configured as described above, even when the notch frequency of the notch filter changes due to vibration or the like during control parameter adjustment, the notch frequency when controlled by the set selected in the past is used. Can be surely returned.
[0035]
A motor position control device according to another aspect of the present invention includes a notch frequency storage unit. When the control parameter set changes, the notch frequency storage unit stores the set immediately before the change and the notch frequency immediately before the change in association with each other, and the control parameter set output from the control parameter adjustment unit is selected in the past. When the set is changed, the notch frequency stored in association with the changed set is reset to the notch frequency of the notch filter, and thereafter, the change of the notch frequency of the notch filter is prohibited for a predetermined time. In the electric motor position control device of the present invention configured as described above, the notch frequency of the notch filter is returned to the notch frequency at the time when the notch filter was controlled by the previously selected set, and then the notch frequency is set by the vibration during the vibration convergence. Can be prevented from being changed, so that the notch frequency can be reliably returned.
[0036]
Further, a motor position control device according to another aspect of the present invention is configured to limit a detection period according to a command to detect a vibration component having a predetermined frequency or higher included in a detection position or a detection speed. In the electric motor position control device of the present invention configured as described above, erroneous detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or the detected speed is eliminated, and a highly responsive control parameter can be adjusted.
Further, the electric motor position control device according to another aspect of the present invention temporarily suspends the inertia estimation operation when detecting that the amplitude of the vibration component having a predetermined frequency or higher included in the detection position or the detection speed is equal to or higher than a predetermined value. It is configured to be. In the electric motor position control device of the present invention configured as described above, the inertia estimation operation can be stabilized, and the control parameters having stability can be adjusted.
While the novel features of the invention are the same as those particularly set forth in the appended claims, the invention, both as to its structure and content, together with other objects and features, will be understood by reading the following detailed description, when taken in conjunction with the drawings. Will be better understood and appreciated.
[0037]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, preferred embodiments of a motor position control device according to the present invention will be described with reference to the accompanying drawings.
[0038]
<< Embodiment 1 >>
FIG. 1 is a block diagram showing a configuration of a control system of a motor position control device according to Embodiment 1 of the present invention. In FIG. 1, a speed detection unit 2 outputs a detected speed ωm of the electric motor 1. The detection speed ωm is input to the integrator 3, and the detection position θm is calculated. The deviation between the position command θm * and the detected position θm is calculated and input to the position control unit 4 by the subtraction unit. The position control unit 4 outputs a speed command ωm * for controlling the deviation between the position command θm * and the detected position θm to zero. As a specific operation of the position control unit 4, for example, as shown in the following equation (4), a result of proportionally controlling the difference θm * −θm is output as a speed command ωm *.
[0039]
(Equation 4)

[0040]
In Expression (4), Kpp is a proportional gain in the position control unit 4.
The difference between the speed command ωm * and the detected speed ωm is calculated and input to the speed control unit 5 by the subtraction unit. The speed control unit 5 outputs to the motor drive unit 6 a torque command τ1 * for controlling the deviation between the speed command ωm * and the detected speed ωm to zero. As a specific operation of the speed control unit 5, for example, a result obtained by performing a proportional integral control on the difference (ωm * −ωm) as shown in the following equation (5) is output as a torque command τ1 *.
[0041]
(Equation 5)

[0042]
In Expression (5), Kvp is a proportional gain of the speed control unit 5, and Tvi is an integration time constant of the speed control unit 5.
The motor drive unit 6 drives the motor 1 connected to the load 7 according to the torque command τ1 * from the speed control unit 5.
The first control parameter adjusting unit 8 receives the detected speed ωm, the position command θm *, and the positional deviation (θm * −θm) between the position command θm * and the detected position θm. Sets the control parameters of the position control unit 4 and the speed control unit 5.
[0043]
Hereinafter, the configuration and operation of the first control parameter adjustment unit 8 will be described in detail with reference to FIGS.
FIG. 2 is a block diagram showing the configuration of the first control parameter adjustment unit 8.
As shown in FIG. 2, the first control parameter adjusting unit 8 includes a high-pass filter 81, a vibration duration measuring unit 82, a command start / completion detecting unit 83, a coin break count / settling time measuring unit 84, and a first A step processing unit 85 is provided.
[0044]
First, the operations of the high-pass filter 81, the vibration duration measuring unit 82, the command start / completion detecting unit 83, and the coin breakage / settling time measuring unit 84 will be described.
FIG. 3 is a waveform diagram showing an example of operation waveforms for explaining operations of the high-pass filter 81 and the vibration duration measuring unit 82.
[0045]
The high-pass filter 81 receives the detection speed ωm and outputs a vibration component dx of a predetermined frequency or higher included in the detection speed ωm. FIG. 3A is a waveform diagram showing a temporal change in the detection speed ωm input to the high-pass filter 81, and FIG. 3B is a waveform diagram showing a temporal change in the vibration component dx output from the high-pass filter 81. FIG.
[0046]
As shown in FIG. 3B, the vibration duration measuring unit 82 measures a duration (hereinafter, referred to as a vibration duration t_vib) in which the amplitude of the vibration component dx is equal to or greater than a predetermined value d_th. The predetermined value d_th of the amplitude of the vibration component dx is obtained, for example, by previously obtaining the amplitude value of the vibration component included in the speed detection value when a sound is generated when the electric motor 1 is position-controlled, and setting the amplitude value. deep. Then, if the measured vibration duration t_vib is equal to or longer than the first predetermined time T_vib1, a continuous oscillation flag is set. If the vibration duration t_vib is equal to or longer than a second predetermined time T_vib2 shorter than the first predetermined time T_vib1, a short-time oscillation flag is set. The value of the second predetermined time T_vib2 is desirably a time that is operationally acceptable as the oscillation time. Further, it is desirable that the value of the first predetermined time T_vib1 be a time during which it can be determined that oscillation has completely occurred.
[0047]
The command start / completion detecting unit 83 detects the start and completion of the position command from the input position command θm *. The start of the position command θm * is detected, for example, by calculating a time change of the position command θ * and detecting a change in the calculated value from 0 to non-zero (non-zero is a non-zero value). Is possible. Further, the completion of the position command θm * can be detected, for example, by calculating a time change of the position command θ * and detecting a change in the calculated value from non-zero to zero.
[0048]
FIG. 4 is a waveform diagram showing an example of an operation for explaining the operation of the coin breakage / settling time measuring section 84. FIG. 4 is a waveform diagram showing a time change of the position deviation (θm * −θm). As shown in FIG. 4, the number of coin breaks / settling time measuring section 84 is based on the input position deviation (θm * −θm) and the detection signal from the command start / completion detecting section 83, During the period up to the start of the position command, the number of times the position deviation (θm * −θm) intersects with the preset settling width pe_th (hereinafter, referred to as the coin crossing number n_cross) is measured. Here, “intersect” means that the position deviation (θm * −θm) changes from a large value to a small value as compared with the preset settling width pe_th, as at points A, B, and C in FIG. Means to change or vice versa. If the number of coin crossings n_cross exceeds a predetermined number of times Nc1, a coin break flag is set. The predetermined number Nc1 is desirably two times. In addition, the time from when the position command is completed until the position deviation (θm * −θm) becomes equal to or smaller than the preset settling width pe_th (hereinafter, referred to as settling time tc) is measured.
[0049]
Next, the first step processing section 85 in the first control parameter adjusting means 8 will be described.
The first step processing unit 85 has a plurality of sets of control parameters to which set numbers (set numbers) as shown in FIG. In FIG. 5, Kpp1 and Tvi1 are control parameters set when the detected speed ωm is smaller than the predetermined value ωm_th, Kpp1 is a proportional gain of the position control unit 4, and Tvi1 is an integration time constant of the speed control unit 5. Kpp2 and Tvi2 are control parameters set when the detected speed ωm is equal to or greater than a predetermined value ωm_th, Kpp2 is a proportional gain of the position control unit 4, and Tvi2 is an integration time constant of the speed control unit 5. Kvp is a proportional gain of the speed control unit 5. In FIG. 5, set numbers are assigned to sets in which the value of the proportional gain Kvp of the speed control unit 5 is low. That is, in FIG. 5, there is a relationship of Kvp1 <Kvp2 <... <KvpN.
[0050]
The first step processing unit 85 has a magnification setting table as shown in FIG. 6, for example. This table is used in step 5a and subsequent steps of the flowchart shown in FIG. In FIG. 6, magnification numbers are assigned in ascending order of magnification setting values K1, K2, K3,..., KM. That is, in FIG. 6, the relationship is K1 <K2 <... <KM.
[0051]
Hereinafter, the adjustment processing operation of the first step processing unit 85 will be described with reference to the flowcharts shown in FIGS. 7 and 8. The "A" at the bottom in FIG. 7 indicates that it is connected to the "A" at the top in FIG.
In step 1a, a set with the set number = 1 is selected, and the control parameters of the selected set number = 1 are set in the position control unit 4 and the speed control unit 5.
As shown in FIG. 7, step 2a following step 1a has two processing flows according to the detection result of the start of the position command.
The first processing flow is a processing when the position command start is detected. This is the flowchart shown on the left side in step 2a of FIG. The position command start detection in step 2a-1 is performed by the command start / completion detection unit 83 as described above. When the start of the position command is detected, the number of operations n is increased by one. At the same time, the vibration duration t_vib of the vibration duration measuring unit 82 and the number of coin crossings n_cross of the coin breaking / settling time measuring unit 84 are reset to zero (step 2a-2).
[0052]
Next, in step 2a-3, it is determined whether or not the number of operations n has exceeded a predetermined number of times mv1. The predetermined number mv1 is set in advance. If it has exceeded, in step 2a-4, the current set number and the flag states of the continuous oscillation flag, short oscillation flag, and coin break flag are stored in association with each other. Next, in step 2a-5, a set in which the value of the set number is incremented by 1 is selected, and control parameters of the selected set are set. The continuous oscillation flag, the short oscillation flag, and the coin break flag are cleared, and the number of operations n is initialized (n = 1). When the value of the set number is increased by 1 in step 2a-5, if the value exceeds the maximum set number (N) of the first step processing unit 85, the state is detected in step 2a-6, and the process proceeds to step 3a. .
[0053]
The flow of the second process in step 2a is a flowchart shown on the right side in step 2a in FIG. 7, and is a process when it is detected that the continuous oscillation flag has been set without detecting the start of the position command. The continuous oscillation flag is set when the measured vibration duration t_vib is equal to or longer than the first predetermined time T_vib1, as described above. The state of the continuous oscillation flag is input from the aforementioned vibration duration measuring unit 82. When it is detected that the continuous oscillation flag has been set (step 2a-7), the current set number is stored in association with the flag states of the continuous oscillation flag, the short-time oscillation flag, and the coin break flag (step 2a). -8). Next, in step 2a-9, set number 1 is selected, and control parameters of the selected set are set. Also, the continuous oscillation flag, the short oscillation flag, and the coin break flag are cleared, the number of operations n is initialized (n = 1), and the vibration duration t_vib and the number of coin breaks / settling time of the vibration duration measuring unit 82 are set. The coin crossing count n_cross of the measuring unit 84 is reset to zero. Then, set number 1 is selected, and the control parameters of the selected set are set. The control parameters of the selected set are set immediately after the detection of the continuation of the vibration, and is a process for quickly suppressing the vibration. The proportional gain Kvp of the speed controller 5 of the set number 1 is low and is most suitable for this processing. Then, the operation of the vibration duration measuring unit 82 and the number of coin breaks / settling time measuring unit 84 is temporarily stopped until the process proceeds to step 3a described later. This is because it is not necessary to set the continuous oscillation flag, the short oscillation flag, and the coin break flag in the oscillation convergence process. Thereafter, in step 2a-10, the number of operations n for position command start detection is counted, and if it is determined that the number of operations n exceeds the predetermined number mv2, the process proceeds to step 3a.
[0054]
FIG. 9 is a table showing an example of the result of the set number and the evaluation condition in the first embodiment. In FIG. 9, ○ indicates that the flag is not set, and X indicates that the flag is set. In step 3a, based on the result stored in step 2a as shown in FIG. 9, the proportional gain of the speed control unit 5 is the largest among the sets in which the continuous oscillation flag, the short oscillation flag, and the coin break flag are not all set. The higher set is determined to be the set to be selected. In the case of the example shown in FIG. 9, it is determined that the set is set to select the set number 3, and the process proceeds to step 4a.
In step 4a, the control parameters of the selected set are set, and the operation is performed a predetermined number of times mv3 to confirm the stable operation. If it is detected that the oscillation flag is set for a short time before the number of operations reaches the predetermined number mv3, the continuous oscillation flag and the short oscillation flag are set based on the result of the evaluation condition stored in step 2a as shown in FIG. The set with the highest proportional gain of the speed control unit 5 is determined as a set to be newly selected, excluding the currently selected set from the sets in which the time oscillation flag and the coin break flag are not all set. By the processing in step 4a, when the set selected in step 3a lacks stable operability, the optimal set can be reselected.
[0055]
Subsequently, in step 5a, a control parameter having higher responsiveness is set. Among the currently set control parameters, the control parameters other than the proportional gain Kpp1 of the position controller 4 when the detected speed ωm is smaller than the predetermined value ωm_th are fixed. Then, only the proportional gain Kpp1 is changed and adjusted based on the response state of the electric motor 1. The way to change the proportional gain Kpp1 is to select a magnification setting value from a magnification setting table as shown in FIG. 6 and select the proportional gain Kpp1 of the position control unit 4 of the set selected at the end of step 4a. The product Kpp1s with the set magnification value is set as the proportional gain Kpp1 of the position control unit 4 when the detected speed ωm is smaller than the predetermined value ωm_th.
First, the magnification number = 1, and the proportional gain Kpp1s of the position control unit 4 when the detection speed ωm is smaller than the predetermined value ωm_th is set as Kpp1s = Kpp1 × K1.
[0056]
In step 5a following step 4a, as shown in FIG. 8, after selecting the magnification number = 1, there are two processing flows according to the detection result of the start of the position command.
The first processing flow is a processing when the position command start is detected. This is the flowchart shown on the left side in step 5a of FIG. The position command start detection in step 5a-2 is performed by the command start / completion detection unit 83. When the start of the position command is detected, the number of operations n is increased by one. At the same time, the vibration duration t_vib of the vibration duration measuring unit 82 and the coin crossing number n_cross of the coin breaking / settling time measuring unit 84 are reset to zero. If the settling time tc measured at that time is longer than the settling time tc measured in the past with the same magnification number selected, the settling time tc measured at that time is set with the same magnification number. The time is updated as the maximum value (step 5a-3).
[0057]
Next, in step 5a-4, it is determined whether the number of operations n has exceeded a predetermined number of times mv4. The predetermined number mv4 is set in advance. When the number n of operations does not exceed the predetermined number mv4, the process returns to step 5a-2. When the number of operations n exceeds the predetermined number of times mv4, the current magnification number, the flag states of the continuous oscillation flag, the short oscillation flag, and the coin break flag and the maximum value of the settling time are stored in association with each other (step 5a-5). Next, in step 5a-6, a magnification setting value in which the magnification number value is increased by 1 is selected, and Kpp1s is calculated and set using the selected magnification setting value. Further, the continuous oscillation flag, the short oscillation flag, and the coin break flag are cleared, the number of operations n is initialized (n = 1), and the maximum value of the settling time is cleared. In step 5a-7, when it is determined that increasing the value of the magnification number by 1 exceeds the maximum magnification number of the first step processing unit 85, the process proceeds to step 6a.
[0058]
The second processing flow in step 5a is processing when it is detected that any one of the continuous oscillation flag, the short oscillation flag, and the coin break flag has been set without detecting the start of the position command. This is the flowchart shown on the right side in step 5a of FIG.
If the start of the position command is not detected and it is detected that any of the continuous oscillation flag, the short oscillation flag, and the coin break flag has been set, in step 5a-9, the current magnification number, the continuous oscillation flag and the short oscillation are set. The flag states of the flag and the coin break flag and the maximum value of the settling time are stored in association with each other.
[0059]
Next, in step 5a-10, the magnification number 1 is selected, Kpp1 is set using the selected magnification setting value, the continuous oscillation flag, the short oscillation flag, and the coin break flag are cleared, and the number of operations n is set. Initialization (n = 1), the vibration duration t_vib of the vibration duration measurement unit 82 and the number of coin crossings n_cross of the coin breakage / settling time measurement unit 84 are reset to zero. Here, the selection of the magnification number 1 is a process for quickly suppressing an unstable state in which any of the continuous oscillation flag, the short oscillation flag, and the coin break flag is set.
In step 5a-11, the number of operations n for position command start detection is counted, and if it is determined that the number of operations n exceeds the predetermined number mv5, the process proceeds to step 6a.
FIG. 10 is a table showing an example of the result of the magnification setting value and the evaluation condition in the first embodiment. In FIG. 10, ○ indicates that the flag is not set, and X indicates that the flag is set.
[0060]
In step 6a, from the results stored in step 5a as shown in FIG. 10, a magnification number having the shortest settling time is selected from the set in which the continuous oscillation flag, the short oscillation flag, and the coin break flag are not all set. I do. The proportionality of the position control unit 4 sets the product Kpp1s of the set Kpp1 selected at the end of step 3a and the magnification set value of the magnification number selected at step 6a when the detected speed ωm is smaller than the predetermined value ωm_th. The gain is determined, and the adjustment processing operation of the first step processing unit 85 ends.
[0061]
The control parameters of the position control unit 4 and the speed control unit 5 are automatically adjusted by the adjustment processing operation of the first step processing unit 85 described above. By operating the first control parameter adjusting unit 8 in the first embodiment as described above, the control parameter with the shortest settling time is set without causing vibration or coin breakage, so that excellent responsiveness is obtained. It is possible to provide a motor position control device having the same.
In the adjustment operation of the first control parameter adjustment unit 8 according to the first embodiment, the proportional gain of the position control unit 4 when the detected speed ωm is smaller than the predetermined value ωm_th in the steps after step 5a shown in FIG. The set value Kpp1s may be larger than the proportional gain Kpp2 of the position control unit 4 when the detection speed ωm is equal to or more than the predetermined value ωm_th. In this case, the switching from the proportional gain Kpp2 to the proportional gain set value Kpp1s is gradually performed over a predetermined time. This is because if the difference between the proportional gain Kpp2 and the proportional gain set value Kpp1s is large, a change in the value becomes sharp at the time of switching, and a vibration component is likely to occur.
[0062]
As described above, the motor position control device according to the first embodiment of the present invention has control parameters including a proportional gain of the position control unit 4 and a proportional gain of the speed control unit 5 as a set, and sets an optimal control parameter. The adjustment is performed so as to select. For this reason, in the electric motor position control device of the first embodiment, the number of times of measuring the control responsiveness of the electric motor can be reduced, and the control parameters can be adjusted in a short time.
[0063]
Further, the position control device for the electric motor according to the first embodiment of the present invention adjusts the control parameter so as to switch the control parameter according to the operation state of the electric motor. It is possible to adjust the control parameter to approach zero in a shorter time.
[0064]
<< Embodiment 2 >>
Hereinafter, a motor position control device according to a second embodiment of the present invention will be described with reference to FIGS. FIG. 11 is a block diagram showing a configuration of a control system of a position control device for an electric motor according to Embodiment 2 of the present invention. In the description of the second embodiment, components having the same configurations and functions as those of the above-described first embodiment are denoted by the same reference numerals, and description thereof is omitted. The position control device for a motor according to the second embodiment is different from the configuration of the first embodiment in that a second control parameter adjustment unit 9 is provided instead of the first control parameter adjustment unit 8. It is.
[0065]
FIG. 12 is a block diagram showing the configuration of the second control parameter adjustment unit 9. As shown in FIG. 12, the second control parameter adjustment unit 9 includes a high-pass filter 81, a vibration duration measurement unit 82, a command start / completion detection unit, similarly to the first control parameter adjustment unit 8 in the first embodiment. 83 and a coin breakage / settling time measuring unit 84. The configuration of the second control parameter adjustment unit 9 differs from the configuration of the first control parameter adjustment unit 8 in that a second step processing unit 95 is provided instead of the first step processing unit 85. That is.
[0066]
Hereinafter, the second step processing unit 95 according to the second embodiment will be described.
Like the first step processing unit 85, the second step processing unit 95 has a plurality of sets of control parameters to which set numbers are assigned as shown in FIG. 5, for example. Further, the second step processing unit 95 has a magnification setting table as shown in FIG. 6, for example, similarly to the first step processing unit 85.
The adjustment processing operation of the second step processing unit 95 will be described with reference to the flowcharts shown in FIGS. The lowermost "A" in FIG. 13 is connected to the uppermost "A" in FIG.
[0067]
Steps 1b, 3b, 4b, 5b, and 6b in the adjustment processing operation of the second step processing unit 95 are steps 1a, 3a, 4a, 5a, and 5a described in the first embodiment, respectively. Since the same processing as in step 6a is performed, the description of those processing is omitted.
As shown in FIG. 13, step 2b following step 1b has two processing flows according to the detection result of the start of the position command.
[0068]
The first processing flow is a processing when the position command start is detected. This is the flowchart shown on the left side in step 2b of FIG. The position command start detection in step 2b-1 is performed by the command start / completion detection unit 83. When the position command start is detected, the number of operations n is increased by one. At the same time, the vibration duration t_vib of the vibration duration measuring unit 82 and the number of coin crossings n_cross of the coin breaking / settling time measuring unit 84 are reset to zero (step 2b-2).
[0069]
Next, in step 2b-3, it is determined whether the number of operations n has exceeded a predetermined number of times mv1. The predetermined number mv1 is set in advance. When the number of operations n exceeds the predetermined number of times mv1, the current set number and the flag states of the continuous oscillation flag, the short oscillation flag, and the coin break flag are stored in association with each other (step 2b-4). In step 2b-5, the next set is selected, the control parameters of the selected set are set, the continuous oscillation flag, the short oscillation flag, and the coin break flag are cleared, and the number of operations n is initialized (n = 1). )I do.
[0070]
The selection of the next set in step 2b-5 is performed as follows. This first processing flow is performed only when the continuous oscillation flag is not set. Processing when the continuous oscillation flag is set will be described later. Since the first processing flow is when the continuous oscillation flag is not set, selection of a set in step 2b-5 selects a set having a larger set number. Therefore, in the first processing flow, there is a possibility that responsiveness can be improved. Therefore, as the next set, the set number between the current set number and the smallest set number among the sets selected in the past and stored in which the sustain oscillation flag is set is selected. As the next set, in particular, a set number which is close to the center between the current set number and the smallest set number as described above is desirable. If there is no set that has been selected in the past and stores that the continuous oscillation flag is set, a set number between the current set number and the largest set number is selected. Also in this case, it is desirable to select a set number that is close to the center of the two set numbers.
[0071]
The flow of the second process in step 2b is the flow chart shown on the right side in step 2b in FIG. 13, and is the process when it is detected that the continuous oscillation flag has been set without detecting the start of the position command. The state of the continuous oscillation flag is input from the aforementioned vibration duration measuring unit 82. When it is detected that the continuous oscillation flag has been set (step 2b-6), the current set number is stored in association with the flag states of the continuous oscillation flag, the short oscillation flag, and the coin break flag (step 2b). -7). Next, in step 2a-8, set number 1 is selected, control parameters of the selected set are set, the continuous oscillation flag, the short oscillation flag, and the coin break flag are cleared, and the number of operations n is initialized ( n = 1), and resets the vibration duration t_vib of the vibration duration measuring unit 82 and the number of coin crossings n_cross of the coin break / settling time measuring unit 84 to zero. Then, set number 1 is selected, and the control parameters of the selected set are set. The control parameters of the selected set are set immediately after the detection of the continuation of the vibration, and is a process for quickly suppressing the vibration. The proportional gain Kvp of the speed controller 5 of the set number 1 is low and is most suitable for this processing. Then, the operations of the vibration duration measuring unit 82 and the number of coin breaks / settling time measuring unit 84 are temporarily stopped. This is because it is not necessary to set the continuous oscillation flag, the short oscillation flag, and the coin break flag in the oscillation convergence process. Thereafter, in step 2b-9, it is determined whether the number of operations n has exceeded a predetermined number mv2. If it is determined in step 2b-10 that the number of operations n has exceeded the predetermined number of times mv2, the next set is selected, the control parameters of the selected set are set, the continuous oscillation flag, the short oscillation flag, and the coin break flag are set. Is cleared, and the number of operations n is initialized (n = 1).
[0072]
The selection of the next set in step 2b-10 is performed as follows. The reason why the continuous oscillation flag was set is presumed to be that the control parameter was set too high. Therefore, it is assumed that the set number that operates stably is a smaller set. Therefore, as the next set, the set number when detecting that the continuous oscillation flag has been set, and the largest set among the sets selected in the past and stored without the continuous oscillation flag set, Select the set number between the numbers. In particular, a set number that is close to the center of the above two set numbers is desirable. If there is no set that has been selected in the past and memorizes that the continuous oscillation flag is not set, the set number at the time when the detection of the set of the continuous oscillation flag is set to the smallest set number Select the set number in between. Also in this case, it is desirable to select a set number that is close to the center of the two set numbers.
[0073]
As described above, in step 2b, if the processing when detecting the start of the position command and the special processing that detects that the continuous oscillation flag has been set are continued, a case where the next set to be selected does not exist may occur. (Step 2b-11). In this state, the process proceeds to step 3b.
[0074]
The adjustment processing operation after step 3b in the second embodiment is the same as the adjustment processing operation after step 3a in the first embodiment. That is, as shown in FIG. 14, the same processing as step 3a, step 4a, step 5a, step 6a in the first embodiment is performed in the order of step 3b → step 4b → step 5b → step 6b, and the second step processing The adjustment processing operation of the unit 95 ends.
As described above, in the second embodiment, the control parameters of the position control unit 4 and the speed control unit 5 are automatically adjusted. As a result, in the electric motor position control device of the second embodiment, since the control parameter with the shortest settling time is set without causing vibration or coin breakage, adjustment that achieves excellent responsiveness is realized. I have.
[0075]
Note that, in the adjustment processing operation of the second control parameter adjustment unit 9 in the second embodiment, in the steps after step 5b shown in FIG. 14, the proportionality of the position control unit 4 when the detected speed ωm is smaller than the predetermined value ωm_th. The gain setting value Kpp1s may be larger than the proportional gain Kpp2 of the position control unit 4 when the detection speed ωm is equal to or higher than the predetermined value ωm_th. In this case, the switching from the proportional gain Kpp2 to the proportional gain set value Kpp1s is gradually performed over a predetermined time. This is because if the difference between the proportional gain Kpp2 and the proportional gain set value Kpp1s is large, the change at the time of switching becomes sharp and a vibration component is likely to occur.
[0076]
As described above, the electric motor position control device according to the second embodiment of the present invention has a set of control parameters including a proportional gain of the position control unit and a proportional gain of the speed control unit, and selects an optimal set of control parameters. Therefore, the number of times of measuring the control responsiveness of the motor can be reduced, and the control parameters can be adjusted in a short time.
Further, the motor position control device according to the second embodiment of the present invention efficiently selects the next set to be selected in step 2b of measuring the response state of the electric motor 1 using the selected set of parameters. The number of sets to be selected can be reduced. As a result, in the second embodiment, control parameters can be adjusted in a short time.
[0077]
Further, the position control device for the electric motor according to the second embodiment of the present invention adjusts the control parameter so as to switch the control parameter according to the operation state of the electric motor. It is possible to adjust the control parameter to approach zero in a shorter time.
[0078]
<< Embodiment 3 >>
Hereinafter, a motor position control device according to a third embodiment of the present invention will be described with reference to FIGS. FIG. 15 is a block diagram showing a configuration of a control system of the electric motor position control device according to Embodiment 3 of the present invention. In the description of the third embodiment, components having the same configurations and functions as those of the above-described first embodiment are denoted by the same reference numerals, and description thereof is omitted. The position control device for a motor according to the third embodiment is different from the configuration of the first embodiment in that a third control parameter adjustment unit 10 is provided instead of the first control parameter adjustment unit 8. It is.
[0079]
FIG. 16 is a block diagram illustrating a configuration of the third control parameter adjustment unit 10. As shown in FIG. 16, similarly to the first control parameter adjusting unit 8 in the first embodiment, the third control parameter adjusting unit 10 includes a high-pass filter 81, a vibration duration measuring unit 82, a command start / completion detecting unit. 83 and a coin breakage / settling time measuring unit 84. The configuration of the third control parameter adjustment unit 10 differs from the configuration of the first control parameter adjustment unit 8 in that a third step processing unit 105 is provided instead of the first step processing unit 85. It is that you are.
[0080]
Hereinafter, the third step processing unit 105 according to the third embodiment will be described.
Like the first step processing unit 85, the third step processing unit 105 has a plurality of control parameter sets to which set numbers are assigned as shown in FIG. 5, for example. Further, the third step processing unit 105 has a magnification setting table as shown in FIG. 6, for example, as in the first step processing unit 85.
[0081]
The adjustment processing operation of the third step processing unit 105 will be described with reference to the flowchart shown in FIG.
As shown in FIG. 17, in the third embodiment, the adjustment processing is performed in the order of step 1c → step 2c → step 3c → step 4c → step 5c → step 6c. In this adjustment processing, steps 2c, 3c, 4c, 5c, and 6c are the same as steps 2a, 3a, 4a, 5a, and 6a described in the first embodiment. Since these processes are performed, descriptions of these processes are omitted.
[0082]
In the operation of the first step processing unit 85 in the first embodiment described above, the first set selection in step 1a is set to the lowest set number 1 of the speed control gain Kvp. However, for example, when the electric motor 1 and the load 8 driven by the electric motor 1 are both rigid bodies and are connected to each other with a large spring constant, there is no low resonance frequency. By setting the gain sufficiently high, high responsiveness can be obtained. Therefore, in such a case, if a set number in the middle is given when the first set is selected, a set with good responsiveness can be selected in a short time. Therefore, in the electric motor position control device according to the third embodiment, in step 1c of the adjustment processing operation, the start set number specified from the outside is selected as the first set, and the control parameters of the selected set are stored in the position control unit 4. And the speed control unit 5.
[0083]
As described above, the position control device for the electric motor according to the third embodiment has control parameters including the proportional gain of the position control unit and the proportional gain of the speed control unit as a set, and performs the adjustment processing operation from the start set number specified from the outside. Has begun. In the third embodiment, since the control parameter adjustment processing operation is performed as described above, the number of times of measurement of the control responsiveness of the electric motor can be reduced, and the control parameter can be adjusted in a short time.
[0084]
Further, the position control device for the electric motor according to the third embodiment of the present invention adjusts the control parameter so as to switch the control parameter according to the operation state of the electric motor. It is possible to adjust the control parameter to approach zero in a shorter time.
[0085]
<< Embodiment 4 >>
Hereinafter, a motor position control device according to a fourth embodiment of the present invention will be described with reference to FIGS. FIG. 18 is a block diagram showing a configuration of a control system of a motor position control device according to Embodiment 4 of the present invention. In the description of the fourth embodiment, components having the same configurations and functions as those of the above-described first to third embodiments are denoted by the same reference numerals, and description thereof will be omitted. The electric motor position control device according to the fourth embodiment is different from the above-described third embodiment in that a load configuration pattern input unit 11 is provided.
[0086]
Hereinafter, the load configuration pattern input unit 11 according to the fourth embodiment will be described with reference to the drawings.
The load configuration pattern input unit 11 has, for example, a table associating a device configuration with a start set number as shown in FIG. The device configuration indicates how the electric motor 1 and the load 8 driven by the electric motor 1 are connected. For example, as shown in FIG. 20, the load 7 is mounted on a ball screw 20, and the electric motor 1 is connected to a shaft of the ball screw 20 via a timing belt 21. The device configuration in this case is “ball screw + timing belt”. The table shown in FIG. 19 is created and stored in advance. As a method of creating such a table, for example, the starting set number is determined based on a general distribution of the resonance frequency in the case of the corresponding device configuration. When it is determined that the resonance frequency is high, the start set number is increased, and when it is determined that the resonance frequency is low, the start set number is decreased.
[0087]
The operation of the load configuration pattern input unit 11 outputs a start set number to the third control parameter adjustment unit 10k based on a table as shown in FIG. 19 when information on the device configuration is input from the outside. The third control parameter adjustment unit 10k performs the control parameter adjustment processing operation described in the third embodiment.
As described above, in the electric motor position control device according to the fourth embodiment, since the device configuration is configured to be input, the control parameter adjustment processing operation can be started from the associated start set. The number of times of measuring the responsiveness can be reduced, and the control parameters can be adjusted in a short time.
[0088]
<< Embodiment 5 >>
Hereinafter, a motor position control device according to a fifth embodiment of the present invention will be described with reference to FIGS. 21 and 22. FIG. 21 is a block diagram showing a configuration of a control system of a motor position control device according to Embodiment 5 of the present invention. In the description of the fifth embodiment, components having the same configuration and function as those of the above-described first embodiment are denoted by the same reference numerals, and description thereof will be omitted. The electric motor position control device according to the fifth embodiment is different from the above-described first embodiment in that a fourth control parameter adjustment unit 12 is provided instead of the first control parameter adjustment unit 8. It is.
[0089]
FIG. 22 is a block diagram showing a configuration of the fourth control parameter adjustment unit 12. As shown in FIG. 22, similarly to the first control parameter adjustment unit 8 in the first embodiment, the fourth control parameter adjustment unit 12 includes a high-pass filter 81, a vibration duration measurement unit 82, a command start / completion detection unit. 83 and a coin breakage / settling time measuring unit 84. The configuration of the fourth control parameter adjustment unit 12 is different from the configuration of the first control parameter adjustment unit 8 in that a fourth step processing unit 115 is provided instead of the first step processing unit 85. It is that you are.
[0090]
Hereinafter, the fourth step processing unit 115 according to the fifth embodiment will be described.
The fourth step processing unit 115 performs the same operation as that of the first step processing unit 85 in the above-described first embodiment, and also outputs a target specification whose measurement result is input from the outside in the process of measuring the response of the electric motor 1. When the condition is satisfied, the control processing set at that time is set as an adjustment result, and the adjustment processing operation is terminated.
As described above, in the fifth embodiment, during the control parameter adjustment processing operation, the adjustment processing operation ends when the target specification input from the outside is satisfied, so that the adjustment processing time can be reduced. Become.
[0091]
<< Embodiment 6 >>
Hereinafter, a motor position control device according to a sixth embodiment of the present invention will be described with reference to FIGS. FIG. 23 is a block diagram showing a configuration of a control system of a motor position control device according to Embodiment 6 of the present invention. In the description of the sixth embodiment, components having the same configurations and functions as those of the above-described first embodiment are denoted by the same reference numerals, and description thereof will be omitted. The position control device for a motor according to the sixth embodiment differs from the configuration of the first embodiment in that a notch filter 13, a notch frequency correction unit 14, and a notch frequency storage unit 15 are provided.
[0092]
The notch filter 13 receives the torque command τ1 *, which is the output of the speed control unit 5, and outputs the result of the filtering to the motor drive unit 6 as a new torque command τ2 *. The motor drive unit 6 drives the motor 1 according to the torque command τ2 *.
Further, the detected speed ωm is input to the notch frequency correction unit 14, and the notch frequency fn of the notch filter 13 is sequentially corrected so that the frequency components of a predetermined frequency or higher included in the detected speed ωm are reduced. The operation of the notch frequency storage unit 15 will be described later.
[0093]
An example of a specific operation of the notch frequency correction unit 14 will be described with reference to FIG. FIG. 24 is a block diagram illustrating an example of the configuration of the notch frequency correction unit 14. The notch frequency correction unit 14 includes a high-pass filter 141, a reference signal generation unit 142, a notch filter 143, and an adaptation unit 144. The notch filter 143 of the notch frequency correction unit 14 has the same configuration as the notch filter 13.
[0094]
Hereinafter, the operation of the notch frequency correction unit 14 configured as described above will be described.
When the detected speed ωm is input to the notch frequency correction unit 14, the detected speed ωm is passed through the high-pass filter 141, and the high-pass filter 141 outputs the vibration component dx included in the detected speed ωm to the adder 145. The reference signal generator 142 outputs the reference signal r. The reference signal r and the vibration component dx are input to the adder 145, and the added value x is input to the notch filter 143. Notch filter 143 outputs filtered signal y. Then, the signal y and the reference signal r from the notch filter 143 are input to the subtractor 146, and the deviation e of these is input to the adaptation unit 144. The adaptation unit 144 sequentially corrects the notch frequency fn so that the deviation e decreases. The correction of the notch frequency fn can be realized using, for example, a known gradient method. References describing the gradient method include Takashi Yahagi, “Theory of Digital Signal Processing 3”, First Edition, Corona Co., Dec. 10, 1986, There are p165-p166.
The notch frequency fn from the adaptation unit 144 is set in the notch filter 143 of the notch frequency correction unit 14 and also in the notch filter 13. The reference signal generation unit 142 outputs a signal indicating zero, which is a result of a decrease in the vibration component dx, for example.
[0095]
In the sixth embodiment, a method for setting a predetermined time T_vib1, which is a reference time for setting a continuous oscillation flag by a vibration duration measuring unit 82 (see FIG. 2), which is a component of the first control parameter adjusting unit 8, is described. 25 will be described.
[0096]
FIG. 25 shows a waveform when the notch frequency correction unit 14 operates. FIG. 25A shows a temporal change of the detected speed ωm, FIG. 25B shows a temporal change of the vibration component dx included in the detected speed ωm, and FIG. 25C shows a temporal change of the notch frequency fn. Since the notch frequency correction unit 14 starts the correction operation after the vibration component dx is generated, the vibration component dx always appears during the period until the correction operation is completed. The period during which the vibration component dx occurs as shown in FIG. 25B is the vibration duration t_vib. After the correction operation of the notch frequency correction unit 14 is completed, the vibration component dx is suppressed by the notch filter 13. Therefore, in the adjustment processing operation of the first control parameter adjustment unit 8, the set number may be further increased to increase the responsiveness. it can. However, as described in the first embodiment, when the vibration duration t_vib of the vibration component dx measured by the first control parameter adjustment unit 8 exceeds the predetermined time T_vib1, a continuous oscillation flag is set and the Responsiveness can not be raised more than the set. For this reason, it is necessary for the notch frequency correction unit 14 to ignore the vibration generated during the correction of the notch frequency fn. Therefore, it is desirable to check the correction operation time of the notch frequency correction unit 14 in advance and set a longer time as the predetermined time T_vib1.
[0097]
In addition, while the notch frequency correction unit 14 is correcting the notch frequency, the response state is disturbed, such as being oscillating, so that it cannot be determined that the set is in the steady state response state. Therefore, it is necessary to judge whether to set the short oscillation flag and whether to set the coin break flag during stable operation. The notch frequency correcting section 14 performs the notch frequency correcting operation when the control parameter changes. After changing the set, the first control parameter adjusting unit 8 selects the next set after an operation of a predetermined number of times mv1. After changing the set and before selecting the next set, after operating a predetermined number of times mv6 less than the predetermined number of times mv1, it is determined whether to set a short-time oscillation flag and whether to set a coin break flag. I do. This makes it possible to measure the steady-state response state of the set.
[0098]
Next, the operation of the notch frequency storage unit 15 will be described. In the notch frequency storage unit 15, the first step processing unit 85 (see FIG. 2) which is a component of the first control parameter adjustment unit 8 stores the state of each flag together with the set number in step 2a shown in FIG. When storing, the notch frequency fn set in the notch filter 13 at that time is stored in association with the set number. When the first step processing unit 85, which is a component of the first control parameter adjustment unit 8, selects a set in step 2a, if the notch frequency fn associated with the set is stored, the first notch frequency fn is stored. The notch frequency fn is set in the notch filter 13, the notch filter 143 of the notch frequency correction unit 14, and the adaptation unit 144. By setting the notch frequency fn in this way, the state of the notch filters 13 and 143 can be restored to the state previously stored in the set.
[0099]
Further, in the sixth embodiment, after the notch frequency fn is set in the notch filter 13, the notch filter 143 of the notch frequency correction unit 14, and the adaptation unit 144, the change of the notch frequency fn is prohibited until a predetermined time has elapsed. ing. The first control parameter adjustment unit 8 detects the vibration continuation state, and when the vibration is converged by driving once with the control parameter of the set number 1, the adaptive unit 144 reacts to the vibration component in the middle of the vibration convergence, and the notch filter 13, the notch frequency fn set in the notch filter 143 of the notch frequency correction unit 14 and the adaptation unit 144 may be corrected again. Therefore, after setting the notch frequency fn in the notch filter 13, the notch filter 143 of the notch frequency correction unit 14, and the adaptation unit 144, the change of the notch frequency fn is prohibited for a predetermined time, so that the notch frequency fn can be adjusted appropriately. Corrections can be made reliably.
[0100]
As described above, in the electric motor position control device according to the sixth embodiment of the present invention, the notch filter 13 that reduces the vibration component dx included in the detected speed ωm automatically functions, so that the resonance in the control system of the electric motor 1 Vibration can be suppressed without previously measuring frequency characteristics such as frequency. As a result, the first control parameter adjustment unit 8 can adjust the control parameters with good responsiveness in consideration of the resonance of the control target.
In the electric motor position control device according to the sixth embodiment, the input of the notch frequency correction unit 14 is the detected speed ωm, but the same effect can be obtained by inputting the detected position θm and the torque command τ1 *.
[0101]
<< Embodiment 7 >>
Hereinafter, an electric motor position control device according to a seventh embodiment of the present invention will be described with reference to FIGS.
The system configuration of the motor position control device of the seventh embodiment is the same as the system configuration of the first embodiment shown in FIG. In the first embodiment, the configuration has been described in which the amplitude of the vibration component dx included in the detection speed ωm is always measured. However, the configuration may be such that the amplitude of the vibration component dx is not measured for a predetermined period.
[0102]
This will be described below with reference to FIGS. 26, 27, and 28. In the description of the seventh embodiment, components having the same configurations and functions as those of the above-described first embodiment are denoted by the same reference numerals, and description thereof is omitted.
FIG. 26 shows (a) the position command value θm *, (b) the differential value of the position command value θm *, (c) the detected speed ωm, (d) the vibration component dx, and (e) the position command value in the seventh embodiment. It is a waveform diagram which shows the 1st example of the time change of the change of the acceleration of (theta) m *. FIG. 27 shows (a) position command value θm *, (b) differential value of position command value θm *, (c) detection speed ωm, (d) vibration component dx, and (e) position command value in the seventh embodiment. It is a waveform diagram which shows the 2nd example of a time change of the example of the change of the acceleration of (theta) m *. FIG. 28 shows (a) position command value θm *, (b) differential value of position command value θm *, (c) detection speed ωm, (d) vibration component dx, and (e) position command value in the seventh embodiment. It is a waveform diagram which shows the 3rd example of the time change of the change of the acceleration of (theta) m *.
[0103]
Assuming that the controlled motor can substantially follow the position command θm * at the position command value θm * as shown in FIG. 26A, the position command value θm * shown in FIG. And the detection speed ωm shown in FIG. 26C have substantially the same waveform.
The result of passing the detection speed ωm through a high-pass filter to extract the vibration component dx of the detection speed ωm is the waveform of the vibration component dx shown in FIG. 26C has no vibration component, but FIG. 26D has a vibration component dx. This is a result of extraction of a harmonic component included in the change point of the acceleration of the detection speed ωm, which is extracted. When the electric motor is controlled by the position command value θm * as shown in FIG. 26A and the control parameter adjustment processing operation described in the first embodiment is performed, the vibration component dx always included in the detected speed ωm Is being monitored. For this reason, there is a possibility that the harmonic component included in the change point of the acceleration of the detection speed ωm as shown in FIG.
[0104]
As shown in (d) and (e) of FIG. 26, the predetermined period from the time when the change in acceleration of the position command value θm * shows a large value coincides with the period in which the vibration component dx produces a large amplitude. I have. Therefore, erroneous determination can be prevented by monitoring only the vibration component dx included in the detected speed ωm in a period excluding the predetermined period from the change point of the acceleration of the position command value θm *.
Next, in the position command value θm * as shown in FIG. 27A, the case where the differential value of the position command value θm * is a square wave and noise is present as shown in FIG. Think.
Assuming that the controlled electric motor 1 can substantially follow the position command value θm *, the differential value of the position command value θm * shown in FIG. 27B and the detection value shown in FIG. The speed ωm has almost the same waveform. FIG. 27D shows the result of passing the detection speed ωm through a high-pass filter to extract the vibration component dx of the detection speed ωm. FIG. 27E shows the calculated change in the acceleration of the position command value θm *. Due to the influence of noise, it is difficult to correlate the change in acceleration of the position command value θm * with the vibration component d.
[0105]
As can be seen from FIGS. 27B and 27D, the predetermined periods from the start of the position command and the end of the position command coincide with the period in which the vibration component dx has a large amplitude. When the motor is controlled by the position command value θm * as shown in FIG. 27A and the control parameter adjustment processing operation described in the first embodiment is performed, the vibration component dx included in the detected speed ωm is constantly calculated. Monitoring. For this reason, there is a possibility that the harmonic component included in the change point of the acceleration of the detection speed ωm as shown in FIG. In such a case, it is possible to prevent an erroneous determination by monitoring only the vibration component dx included in the detection speed ωm during a period excluding a predetermined period from the position command start time and the position command end time.
[0106]
Next, in a position command value θm * as shown in FIG. 28A, a case is considered in which noise is superposed on the same position command value θm * as in FIG. 26A. Assuming that the motor to be controlled can substantially follow the position command θm *, the differential value of the position command value θm * shown in FIG. 28B and the detected speed ωm shown in FIG. Have almost the same waveform. FIG. 28D shows the result of passing the detection speed ωm through a high-pass filter in order to extract the vibration component dx of the detection speed ωm. FIG. 28E shows the calculated change in the acceleration of the position command value θm *. Due to the influence of noise, it is difficult to correlate the change in acceleration of the position command value θm * with the vibration component dx.
[0107]
As can be seen from the waveform of FIG. 28D, there is a period in which the vibration component dx has a large amplitude in a period in which the position command is given and a predetermined period from the end of the position command. When the electric motor is controlled by the position command value θm * as shown in FIG. 28A and the control parameter adjustment processing operation described in the first embodiment is performed, the vibration component dx included in the detected speed ωm is constantly calculated. Monitoring. For this reason, there is a possibility that the harmonic component included in the change point of the acceleration of the detection speed ωm as shown in FIG. In such a case, it is possible to prevent erroneous determination by monitoring only the vibration component dx included in the detection speed ωm during a period excluding a certain period of the position command and a predetermined period from the end of the position command.
By selecting the period for detecting the vibration component based on the command in this way, erroneous detection of the vibration component is eliminated, and the control parameter showing excellent responsiveness can be adjusted.
[0108]
Although the system configuration of the seventh embodiment is described as the same configuration as the control system of FIG. 1 described in the first embodiment, the same applies to the configuration of the control system of the sixth embodiment shown in FIG. The effect of is obtained.
[0109]
<< Embodiment 8 >>
Hereinafter, an electric motor position control device according to an eighth embodiment of the present invention will be described with reference to FIG. FIG. 29 is a block diagram showing a configuration of a control system of a position control device for an electric motor according to Embodiment 8 of the present invention. In the description of the eighth embodiment, components having the same configurations and functions as those of the above-described first embodiment are denoted by the same reference numerals, and description thereof will be omitted. The electric motor position control device according to the eighth embodiment is different from the above-described first embodiment in that an inertia estimating unit 16 and an inertia estimating temporary stop determining unit 17 are provided.
[0110]
Hereinafter, the operations of the inertia estimating unit 16 and the inertia estimating temporary stop determining unit 17 according to the eighth embodiment will be described.
The inertia estimating unit 16 receives the detected speed ωm and the torque command τ1 * for controlling the electric motor 1, and estimates and calculates the total inertia of the electric motor 1 and the load 7 driven by the electric motor 1. The total inertia estimated by the inertia estimating unit 16 is input to the speed control unit 5 and used for correcting the control parameters of the speed control unit 5.
[0111]
The inertia estimation temporary stop determination unit 17 receives the detected speed ωm and monitors the amplitude of the vibration component having a predetermined frequency or higher included in the detected speed ωm. When the inertia estimation temporary stop determination unit 17 detects that the amplitude of the vibration component equal to or higher than the predetermined frequency is equal to or higher than the predetermined value, the inertia estimation temporary stop determination unit 17 determines that the electric motor 1 is in the vibration state, and performs the inertia estimation calculation of the inertia estimation unit 16. Stop for a predetermined time. The vibration component having a frequency equal to or higher than the predetermined frequency included in the detection speed ωm can be obtained, for example, by passing the vibration component through a high-pass filter having a predetermined frequency as a cutoff frequency for the detection speed ωm.
Assuming that the electric motor 1 and the load 7 driven by the electric motor 1 are entirely formed of a rigid body, the relationship of the following equation (6) holds for the total inertia, applied torque τ, and detected speed ωm.
[0112]
(Equation 6)

[0113]
In the equation (6), J is the total inertia of the electric motor 1 and the load 7 driven by the electric motor 1. (Ωm) ′ is a differential value of the detected speed ωm, that is, an acceleration. Therefore, the total inertia J can be calculated from the applied torque τ and the acceleration (ωm) ′. By correcting the control parameters of the speed control unit 5 using the total inertia J calculated in this way, the response frequency can be kept constant, and the relationship with the control parameters of the position control unit 4 is kept in a stable state. be able to.
[0114]
In the case of the vibration state, if the vibration frequency is equal to or more than の of the control cycle for detecting the speed, aliasing occurs, so that the total inertia J cannot be correctly calculated by Expression (6). Therefore, when the control parameter of the speed control unit 5 is corrected using the value of the total inertia J calculated in the vibration state, the relationship with the control parameter of the position control unit 4 becomes unstable, and the vibration may not be suppressed. .
In the motor position control device according to the eighth embodiment, inertia estimation temporary stop determination unit 17 monitors the amplitude of the vibration component included in detected speed ωm, and detects that this amplitude has exceeded a predetermined value as a vibration state. are doing. At a predetermined time after detecting the vibration state, the inertia estimating unit 16 stops the inertia estimating calculation of the total inertia J. The total inertia value during stop holds the value immediately before stop. Then, when the vibration state is not detected after a predetermined time has elapsed, the inertia estimating unit 16 restarts the inertia estimating calculation of the total inertia J.
[0115]
As described above, the electric motor position control device of the eighth embodiment is configured to stop the inertia estimation calculation when the vibration state is detected, so that the inertia estimation unit 16 outputs only the correct inertia estimation calculation value. Therefore, the electric motor position control device according to the eighth embodiment can always keep the relationship between the control parameter of the speed control unit 5 and the control parameter of the position control unit 4 in a stable state.
[0116]
In the eighth embodiment, the position control device for the electric motor having the system configuration shown in FIG. 29 has been described as an example. However, the system configuration of the sixth embodiment shown in FIG. The same effect can be obtained even with the configuration in which the pause determination unit 17 is added.
[0117]
In the position control devices according to the first to eighth embodiments, the configuration has been described in which the detection speed ωm, which is the output of the speed detection unit 2, is passed through the integrator 3 to obtain the detection position θm. The present invention is not limited to this, and a configuration in which a position detection unit is provided instead of the speed detection unit 2 and the detection speed ωm is obtained from the detection position θm output from the position detection unit is the same as in the above-described embodiments. Is obtained.
[0118]
In the first to eighth embodiments, the first control parameter adjustment unit 8, the second control parameter adjustment unit 9, the third control parameter adjustment unit 10, and the fourth control parameter adjustment unit 12 are the same as those in FIG. And a plurality of sets of a proportional gain Kpp of the position control unit 4, a proportional gain Kvp of the speed control unit 5, and an integration time constant Tvi, and one of the sets of control parameters is set according to the response state of the motor. The example of the configuration for adjusting the selection has been described. The present invention is not limited to such a configuration, and any combination may be used as long as the set includes the proportional gain Kpp of the position control unit 4 and the proportional gain Kvp of the speed control unit 5.
[0119]
In the first to eighth embodiments, the first control parameter adjustment unit 8, the second control parameter adjustment unit 9, the third control parameter adjustment unit 10, and the fourth control parameter adjustment unit 12 perform step 4a. , Step 4b, or Step 4c, when the detected speed ωm is smaller than the predetermined value ωm_th, the proportional gain of the position control unit 4 is adjusted to set the control parameter. The present invention is not limited to such a configuration, and when the detected speed ωm is smaller than the predetermined value ωm_th, the control parameter is set by changing both the proportional gain of the position control unit 4 and the predetermined value ωm_th to adjust the control parameter. With this configuration, the same effects as those of the above-described embodiments can be obtained.
[0120]
In the first to eighth embodiments, the first control parameter adjustment unit 8, the second control parameter adjustment unit 9, the third control parameter adjustment unit 10, and the fourth control parameter adjustment unit 12 perform step 1a. The description has been given of the configuration in which the processing from step to step 6a, the processing from step 1b to step 6b, or the processing from step 1c to step 6c is performed. However, sufficient responsiveness can be obtained even in the processing from step 1a to step 4a, the processing from step 1b to step 4b, or the processing from step 1c to step 4c. For this reason, in the first control parameter adjustment unit 8, the second control parameter adjustment unit 9, the third control parameter adjustment unit 10, and the fourth control parameter adjustment unit 12, the processing from step 1a to step 4a is performed. , The processing may be terminated by the processing from step 1b to step 4b or the processing from step 1c to step 4c.
[0121]
Further, the electric motor used in Embodiments 1 to 8 is not limited to a specific type, and for example, a DC motor or a permanent magnet synchronous motor may be used. Further, the electric motor of the present invention is not limited to a rotary electric motor, and a linear motor may be used.
In the third and fourth embodiments, the third step processing unit 105, which is a component of the third parameter adjustment unit 10, describes the processing from step 2c to step 6c in the first embodiment. The description is the same as the processing from step 2a to step 6a. However, in the present invention, the processing from step 2c to step 6c is the same as the processing from step 2b to step 6b described in the second embodiment, and is the same as in the third and fourth embodiments. The effect is obtained.
[0122]
Further, in the fifth embodiment, the fourth step processing unit 115 which is a component of the fourth parameter adjustment unit 12 is the first step processing unit 115 which is a component of the first parameter adjustment unit 8 described in the first embodiment. The same operation as that of the step processing unit 85 is performed. The position control device according to the fifth embodiment of the present invention is not limited to such a configuration, and the first step processing unit 95 which is a component of the second parameter adjustment unit 9 described in the second embodiment. The same operation as described above may be performed.
[0123]
Further, in the fifth to eighth embodiments, the same effect can be obtained by replacing the first parameter adjustment unit 8 with the second parameter adjustment unit 9 described in the second embodiment.
Further, in the sixth to eighth embodiments, the first parameter adjustment unit 8 includes the third parameter adjustment unit 10, the third parameter adjustment unit 10k, and the fourth parameter adjustment unit 12 described in the third to fifth embodiments. The same effect can be obtained by replacing with any one of the above.
[0124]
As is apparent from the detailed description in the above embodiment, the motor position control device of the present invention has the following features.
The position control device for a motor according to the present invention calculates a speed of the motor from a detected position of the motor, or calculates a position of the motor from a detected speed of the motor,
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
It has a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit, and selects the set and the position when the electric motor is controlled using the selected set of control parameters. A control parameter adjusting unit that sequentially performs an operation of measuring a response state of the motor to a command and sets one set of control parameters according to the measured response result. The motor position control device of the present invention configured as described above changes the control parameters as a set, so that the number of adjustments can be reduced and the control parameters can be adjusted in a short time.
[0125]
Further, the control parameter adjustment unit in the motor position control device of the present invention,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. The measurement operation including the detection of, is configured to sequentially perform from the lower set of the proportional gain of the speed control unit to the higher set,
A response result measured from when the amplitude of the vibration component is equal to or greater than the first predetermined value is detected to be equal to or greater than a first predetermined time in a period from the start of the position instruction to the start of the next instruction. At
(1) A condition (1) in which a period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than the first predetermined time in a period from the start of the position instruction to the start of the next instruction.
(2) In the period from the start of the position command to the start of the next command, the period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a second predetermined time shorter than the first predetermined time. Condition (2), and
(3) In the period from the completion of the position command to the start of the next command, the number of times that the deviation between the position command value and the detected position intersects with a preset settling width is equal to or less than a first predetermined number. ),
One of the three conditions is selected from a set that satisfies at least one condition including at least the condition (1), and the control parameters of the selected set are set. The motor position control device of the present invention configured as described above stops measuring the response state at the time of detecting the vibration continuation, so that the number of adjustments can be reduced and the control parameters can be adjusted in a short time. it can.
[0126]
Further, the control parameter adjustment unit in the motor position control device of the present invention,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. It is configured to sequentially perform measurement operations including detection of
In selecting a set,
(A) In the period from the start of the position command to the start of the next command, if it is detected that the period during which the amplitude of the vibration component is equal to or larger than the first predetermined value is equal to or longer than the first predetermined time, the response state is already set. The proportional gain of the highest speed control unit in the set in which the time during which the amplitude of the vibration component is equal to or greater than the first predetermined value is not detected as being equal to or greater than the first predetermined time, or If there is no proportional gain of the speed control unit corresponding to the above condition, a speed having a value between the lowest proportional gain of the speed control unit of the whole set and the currently set proportional gain of the speed control unit. A first selection to next select a set having a proportional gain of the control unit,
(B) In the period from the start of the position command to the start of the next command, it is not detected that the period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is equal to or greater than the first predetermined time. The period in which the response state has already been measured and the period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is the lowest speed control unit among the sets in which it is detected that the amplitude is equal to or greater than the first predetermined time. If there is no proportional gain, or if there is no proportional gain of the speed control unit corresponding to the above condition, the proportional gain of the highest speed control unit in the whole set and the proportional gain of the speed control unit set at the present time The second selection of selecting the set having the proportional gain of the speed control unit having the next value is repeated.
In the selection, when the next set to be selected no longer exists, in the measured response result,
(1) A condition (1) in which a time during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than the first predetermined time in a period from the start of the position instruction to the start of the next instruction.
(2) In the period from the start of the position command to the start of the next command, the period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a second predetermined time shorter than the first predetermined time. Condition (2), and
(3) In the period from the completion of the position command to the start of the next command, the number of times that the deviation between the position command value and the detected position intersects with a preset settling width is equal to or less than a first predetermined number. ),
One of the three conditions is selected from a set that satisfies at least one condition including at least the condition (1), and the control parameters of the selected set are set. The electric motor position control device of the present invention configured as described above repeatedly selects a set, and when there are no more sets to be selected next, selects one preferable set based on the response results up to that point. Since the selected set of control parameters is set, the control parameters can be adjusted to the preferable control parameters in a short time.
[0127]
Further, the control parameter adjusting unit in the electric motor position control device of the present invention is configured to first select a start set specified from the outside. In the electric motor position control device of the present invention configured as described above, an arbitrary start set can be designated, so that the number of adjustments can be reduced and control parameters can be adjusted in a short time.
The position control device for an electric motor according to the present invention has a plurality of load configuration patterns associated with a start set, and a load configuration pattern input unit in which one of the plurality of load configuration patterns is externally designated. Has been
The control parameter adjustment unit is configured to first select a start set associated with the load configuration pattern input from the load configuration pattern input unit. In the motor position control device of the present invention configured as described above, since the optimal start set is determined for the input load configuration pattern, the number of adjustments can be reduced, and the control parameters can be adjusted in a short time. can do.
[0128]
Further, the control parameter adjusting unit in the position control device for the electric motor according to the present invention is characterized in that, during a period from the start of the position command to the start of the next command, the period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is the first Immediately after detecting that the predetermined time is equal to or longer than a predetermined time, a control parameter of a set having a proportional gain of the speed control unit lower than the current proportional gain of the speed control unit is set, and the electric motor is set to the second predetermined number of times. After controlling only, the next set is selected. In the motor position control device of the present invention configured as described above, even when vibration occurs during control parameter adjustment, the vibration can be surely converged in a short time, and the control parameter can be adjusted safely.
The control parameter adjusting unit in the motor position control device according to the present invention may include a proportional gain of the position control unit based on at least one of the position command value, the speed command value, the detected position, and the detected speed. A plurality of sets of control parameters including a control parameter and a proportional gain of a speed control unit, a set selection, and a measurement operation of a response state of the motor to a position command when the motor is controlled using the selected set of control parameters. Are sequentially performed, one of a set of control parameters is selected in accordance with the measured response state, and the control parameters of the selected set are set. In the electric motor position control device of the present invention configured as described above, the control parameter is adjusted based on at least one of the position command value, the speed command value, the detected position, and the detected speed. The control parameters can be adjusted so that control having excellent responsiveness can be realized.
[0129]
The position control device for a motor of the present invention calculates a speed of the motor from a detected position of the motor, or calculates a position of the motor from a detected speed of the motor,
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
A control parameter adjustment unit having a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit,
The control parameter adjustment unit,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. It is configured to sequentially perform the measurement operation including the detection of, in the measured result,
(1) A condition (1) in which a period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a first predetermined time in a period from the start of the position command to the start of the next command.
(2) A condition in which a period during which the amplitude of the vibration component is equal to or greater than a first predetermined value is less than a second predetermined time shorter than the first predetermined time in a period from the start of the position instruction to the start of the next instruction. (2), and
(3) In the period from the completion of the position command to the start of the next command, the number of times that the deviation between the position command value and the detected position intersects with a preset settling width is equal to or less than a first predetermined number. ),
Selecting one of a set that satisfies at least one condition including at least the condition (1) from among the three conditions, and setting the control parameter of the selected set by a third predetermined number of times from the time when the electric motor is set. When controlling that the period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is equal to or greater than the first predetermined time in the period from the start of the position instruction to the start of the next instruction. And newly selecting a set having the highest proportional gain of the speed control unit from among sets excluding the current set among sets satisfying at least one of the three conditions including at least the condition (1). Thus, it is configured to set a newly selected set of control parameters. The motor position control device of the present invention configured as described above is configured to set the selected set of control parameters and then control the motor a predetermined number of times to reconfirm whether or not vibration occurs. Therefore, stable control parameters can be reliably set.
[0130]
A position control device for a motor according to another aspect of the present invention calculates a speed of the motor from a detected position of the motor, or calculates a position of the motor from a detected speed of the motor,
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
A control parameter adjustment unit having a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit,
The control parameter adjustment unit,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. It is configured to sequentially perform the measurement operation including the detection of, and in the measured response result,
(1) A condition (1) in which, during a period from the start of the position command to the start of the next command, the time during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than the first predetermined time;
(2) In the period from the start of the position command to the start of the next command, the period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a second predetermined time shorter than the first predetermined time. Condition (2), and
(3) In the period from the completion of the position command to the start of the next command, the number of times that the deviation between the position command value and the detected position intersects with a preset settling width is equal to or less than a first predetermined number. ),
Selecting one of a set that satisfies at least one condition including at least the condition (1) among the three conditions, and setting a control parameter of the selected set;
Next, among the currently set control parameters, at least the proportional gain of the speed control unit is fixed, the remaining control parameters are changed, and according to a response state of the motor to a position command when the motor is controlled. , A parameter other than the fixed parameter is set. In the electric motor position control device of the present invention configured as described above, after adjusting the control parameters as a set, each control parameter is further adjusted individually, so that a highly responsive adjustment is possible. Become.
[0131]
A position control device for a motor according to another aspect of the present invention calculates a speed of the motor from a detected position of the motor, or calculates a position of the motor from a detected speed of the motor,
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
After completion of the position command, a control parameter adjustment unit configured to externally set a target value of a time until a deviation between the detected position and the position command value enters a preset set width,
In the operation of selecting the set and measuring the response state of the electric motor with the control parameters of the selected set, the control parameter adjusting unit sets the deviation between the detected position and the position command value to a settling width after the completion of the position command. When the time until the entry becomes equal to or less than the target value set from the outside, the selection of the set is stopped and the control parameter at that time is set. The motor position control device of the present invention thus configured stops adjusting the control parameters when the target index input from the outside is satisfied in the process of adjusting the control parameters, and adjusts the control parameters at that time. As a result, the control parameters can be adjusted in a short time.
[0132]
Further, the position control device of the electric motor of the present invention is disposed in either the position control system or the speed control system, and a notch filter having a variable notch center frequency,
The notch frequency of the notch filter to reduce the vibration component of a predetermined frequency or higher included in the detection position or the detection speed or the vibration component of a predetermined frequency or higher included in a torque command that is an input to the motor drive unit. And a notch frequency correction unit for sequentially correcting the notch frequency. In the electric motor position control device of the present invention configured as described above, the notch filter that suppresses oscillation due to the resonance frequency of the control target is automatically generated, so that the responsiveness is measured without measuring the frequency response of the control target. Adjustment of a high control parameter becomes possible.
[0133]
Further, the position control device of the electric motor of the present invention is disposed in either the position control system or the speed control system, and a notch filter having a variable notch center frequency,
The notch frequency of the notch filter is sequentially reduced so as to reduce a vibration component having a predetermined frequency or more included in the detection position or the detection speed or a vibration component having a predetermined frequency or more included in a torque command input to the motor drive unit. A notch frequency correction unit to correct,
When the selected set changes, the set immediately before the change and the notch frequency immediately before the change are stored in association with each other, and when the newly selected set is the same as the previously selected set, the previously selected set is changed. And a notch frequency storage unit for resetting the notch frequency stored in association with the notch frequency as the notch frequency of the notch filter. In the electric motor position control device of the present invention configured as described above, even when the notch frequency of the notch filter changes due to vibration or the like during control parameter adjustment, the notch frequency when controlled by the set selected in the past is used. Can be surely returned.
[0134]
Further, the position control device of the electric motor of the present invention is disposed in either the position control system or the speed control system, and a notch filter having a variable notch frequency,
The notch frequency of the notch filter is sequentially reduced so as to reduce a vibration component having a predetermined frequency or more included in the detection position or the detection speed or a vibration component having a predetermined frequency or more included in a torque command input to the motor drive unit. A notch frequency correction unit to correct,
When the selected set changes, the set immediately before the change and the notch frequency immediately before the change are stored in association with each other, and when the newly selected set is the same as the previously selected set, the previously selected set is added to the previously selected set. A notch frequency storage unit that resets the notch frequency stored in association with the notch frequency of the notch filter, and thereafter prohibits the change of the notch frequency of the notch filter for a fourth predetermined time. I have. In the electric motor position control device of the present invention configured as described above, the notch frequency of the notch filter is returned to the notch frequency at the time when the notch filter was controlled by the previously selected set, and then the notch frequency is set by the vibration during the vibration convergence. Can be prevented from being changed, so that the notch frequency can be reliably returned.
[0135]
Further, the control parameter adjustment unit in the motor position control device of the present invention,
Only during a period in which the position command satisfies the predetermined condition, a vibration component of a predetermined frequency or more included in the detected position or the detected speed of the motor is detected, or a vibration of a predetermined frequency or more included in the torque command input to the motor drive unit is detected. It is configured to detect the component. In the electric motor position control device of the present invention configured as described above, erroneous detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or the detected speed is eliminated, and a highly responsive control parameter can be adjusted.
[0136]
Further, a position control device for a motor according to another aspect of the present invention calculates a speed of the motor from a detected position of the motor, or calculates a position of the motor from a detected speed of the motor,
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
An inertia estimating unit that estimates a total inertia of the electric motor and a load driven by the electric motor based on the acceleration and the torque command value calculated from the detected speed;
The amplitude of a vibration component having a frequency equal to or higher than a predetermined frequency included in the detection position or the detection speed of the motor, or the amplitude of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit is equal to or higher than a predetermined value. From the time of detecting, the inertia estimation temporary stop determination unit to stop the inertia estimation calculation of the inertia estimation unit for a predetermined time,
A plurality of sets of control parameters including at least a proportional gain of the position control unit and a proportional gain of the speed control unit, a set is selected, and a position when the electric motor is controlled using the selected set of control parameters. A control parameter adjusting unit that measures a response state of the electric motor to the command and sets one set of control parameters according to the response state. The motor position control device of the present invention configured as above temporarily suspends the inertia estimating operation when detecting that the amplitude of the vibration component having the predetermined frequency or higher included in the detection position or the detection speed is equal to or higher than the predetermined value. Therefore, the inertia estimating operation can be stabilized, and a stable control parameter can be adjusted.
Although the invention has been described in terms of a preferred form with some detail, the present disclosure of the preferred form should vary in the details of construction, and any combination of elements or change in order will not affect the claimed invention. It can be realized without departing from the scope and spirit.
[0137]
【The invention's effect】
As is clear from the detailed description in the above embodiment, the motor position control device of the present invention has the following effects.
In the motor position control device according to the present invention, the control parameters are changed as a set, so that the number of adjustments can be reduced and the control parameters can be adjusted in a short time.
Further, since the position control device for the electric motor of the present invention is configured to stop measuring the response state at the time of detecting the vibration continuation, the number of adjustments can be reduced, and the control parameters can be adjusted in a short time. Can be.
In the electric motor position control device according to the present invention, by repeating the selection of the set, when there is no more set to be selected next, one preferable set is selected based on the response results up to that point and selected. Since the set of control parameters is set, it is possible to adjust the control parameters to a preferable one in a short time.
[0138]
Further, since the control parameter adjusting unit in the electric motor position control device of the present invention is configured to select the start set specified from the outside first, an arbitrary start set can be specified, so that the number of adjustments can be reduced. The control parameters can be adjusted in a short time.
In the electric motor position control device of the present invention, since the optimal start set is determined for the input load configuration pattern, the number of adjustments can be reduced, and the control parameters can be adjusted in a short time. .
Further, in the motor position control device of the present invention, even when vibration occurs during the control parameter adjustment, the vibration can be surely converged in a short time and the control parameter can be adjusted safely.
[0139]
Further, in the electric motor position control device of the present invention, the control parameters are adjusted based on at least one of the position command value, the speed command value, the detected position, and the detected speed, so that the position command is excellent with respect to the position command. The control parameters can be adjusted so that responsive control can be realized.
In addition, the motor position control device of the present invention is configured to set the control parameters of the selected set and then control the motor a predetermined number of times to reconfirm whether or not it vibrates. Control parameters can be set reliably.
In the electric motor position control device of the present invention, the control parameters are adjusted as a set, and then the individual control parameters are individually adjusted, so that a highly responsive adjustment is possible.
[0140]
Further, in the motor position control device of the present invention, in the process of adjusting the control parameter, when the target index input from the outside is satisfied, the adjustment of the control parameter is stopped, and the control parameter at that time is set as the adjustment result. With such a configuration, control parameters can be adjusted in a short time.
In the motor position control device of the present invention, a notch filter that suppresses oscillation due to the resonance frequency of the control target is automatically generated, so that a control parameter with high responsiveness can be obtained without measuring the frequency response of the control target. Adjustment is possible.
Further, in the motor position control device of the present invention, even when the notch frequency of the notch filter changes due to vibration or the like during control parameter adjustment, the notch frequency when controlled by the previously selected set is reliably returned to. be able to.
[0141]
Further, in the electric motor position control device of the present invention, after the notch frequency of the notch filter is returned to the notch frequency at the time when the notch filter was controlled by the previously selected set, the notch frequency is changed by the vibration during the vibration convergence. This can prevent the notch frequency from being returned.
Further, in the motor position control device according to the present invention, erroneous detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in the detection position or the detection speed is eliminated, and a highly responsive control parameter can be adjusted.
[0142]
Further, the electric motor position control device of the present invention is configured to temporarily stop the inertia estimating operation when detecting that the amplitude of the vibration component having a predetermined frequency or higher included in the detection position or the detection speed is equal to or higher than a predetermined value. Therefore, the inertia estimating operation can be stabilized, and a stable control parameter can be adjusted.
[Brief description of the drawings]
FIG. 1 is a block diagram showing a configuration of an electric motor position control device according to a first embodiment of the present invention.
FIG. 2 is a block diagram illustrating an example of a configuration of a first parameter adjustment unit according to the first embodiment of the present invention.
FIG. 3 is an operation waveform diagram for explaining an operation of a vibration duration measuring unit according to the first embodiment of the present invention.
FIG. 4 is an operation waveform diagram for explaining the operation of the coin breakage / settling time measuring unit according to the first embodiment of the present invention.
FIG. 5 is a table showing an example of a list of control parameter sets according to the first embodiment of the present invention.
FIG. 6 is a table showing an example of a list of magnification setting values according to the first embodiment of the present invention.
FIG. 7 is a first flowchart illustrating an operation of a first control parameter adjustment unit according to the first embodiment of the present invention.
FIG. 8 is a second flowchart showing the operation of the first control parameter adjustment unit according to the first embodiment of the present invention.
FIG. 9 is a table showing an example of a result of a set number and an evaluation condition according to the first embodiment of the present invention.
FIG. 10 is a table showing an example of a result of a magnification setting value and an evaluation condition according to the first embodiment of the present invention.
FIG. 11 is a block diagram illustrating a configuration of a motor position control device according to a second embodiment of the present invention.
FIG. 12 is a block diagram illustrating an example of a configuration of a second control parameter adjustment unit according to the second embodiment of the present invention.
FIG. 13 is a first flowchart illustrating an operation of a second control parameter adjustment unit according to the second embodiment of the present invention.
FIG. 14 is a second flowchart showing the operation of the second control parameter adjustment unit according to the second embodiment of the present invention.
FIG. 15 is a block diagram showing a configuration of an electric motor position control device according to a third embodiment of the present invention.
FIG. 16 is a block diagram illustrating an example of a configuration of a third control parameter adjustment unit according to the third embodiment of the present invention.
FIG. 17 is a flowchart illustrating an operation of a third control parameter adjustment unit according to the third embodiment of the present invention.
FIG. 18 is a block diagram illustrating a configuration of a motor position control device according to a fourth embodiment of the present invention.
FIG. 19 is a table showing an example of a list associating device configurations with start set numbers.
FIG. 20 is a configuration diagram illustrating an example of a device configuration.
FIG. 21 is a block diagram showing a configuration of a motor position control device according to a fifth embodiment of the present invention.
FIG. 22 is a block diagram illustrating an example of a configuration of a fourth control parameter adjustment unit according to the fifth embodiment of the present invention.
FIG. 23 is a block diagram showing a configuration of a motor position control device according to a sixth embodiment of the present invention.
FIG. 24 is a block diagram illustrating an example of a configuration of a notch frequency correction unit according to a sixth embodiment of the present invention.
FIG. 25 is a waveform diagram showing an example of a detection speed, a vibration component, and a time change of the notch frequency when the notch frequency correction unit operates according to the sixth embodiment of the present invention.
FIG. 26 is a waveform showing a first example of a temporal change in a position command value, a differential value of the position command value, a detection speed, a vibration component, and a change in acceleration of the position command value in the seventh embodiment of the present invention. FIG.
FIG. 27 is a waveform showing a second example of a temporal change in a change in the position command value, the differential value of the position command value, the detected speed, the vibration component, and the acceleration of the position command value in the seventh embodiment of the present invention. FIG.
FIG. 28 is a waveform showing a third example of a time change in a position command value, a differential value of the position command value, a detection speed, a vibration component, and a change in acceleration of the position command value in the seventh embodiment of the present invention. FIG.
FIG. 29 is a block diagram illustrating a configuration of a motor position control device according to an eighth embodiment of the present invention.
FIG. 30 is a block diagram showing a system configuration of a motor position control device according to a first related art.
FIG. 31 is a diagram showing a control configuration when a speed control unit in a position control device for an electric motor according to a first related art is set to P control.
FIG. 32 is a block diagram showing a control configuration when an integral gain of a speed control unit in a position control device for a motor according to the first related art is set to non-zero.
FIG. 33 is a block diagram showing a system configuration of a motor position control device according to a second conventional technique.
[Explanation of symbols]
1 Electric motor
2 Speed detector
3 Integrator
4 Position control unit
5 Speed control unit
6 Motor drive
7 Load
8 First control parameter adjustment unit
9 Second control parameter adjustment unit
10 Third control parameter adjustment unit
11 Load configuration pattern input section
12 Fourth control parameter adjustment unit
13 Notch filter
14 Notch frequency correction unit
15 Notch frequency storage
16 Inertia estimator
17 Estimation of inertia stoppage
81 High Pass Filter
82 Vibration duration measurement unit
83 Command start / completion detector
84 Coin break count / settling time measurement section
85 First Step Processing Unit
95 second step processing unit
105 third step processing unit
115 fourth step processing unit

Claims (33)

A position / speed calculation unit that calculates the speed of the motor from the detected position of the motor, or calculates the position of the motor from the detected speed of the motor;
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
It has a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit. A control parameter adjusting unit that sequentially performs a measurement operation of a response state of the electric motor to a command, and sets one set of control parameters according to the measured response result;
A position control device for an electric motor, comprising: The control parameter adjustment unit,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. The measurement operation including the detection of, is configured to sequentially perform from the lower set of the proportional gain of the speed control unit to the higher set,
In the measured response results,
(1) A condition (1) in which, during a period from the start of the position command to the start of the next command, the time during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than the first predetermined time;
(2) A condition in which a period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a second predetermined time shorter than the first predetermined time during a period from the start of the position instruction to the start of the next instruction. (2) and (3) In the period from the completion of the position command to the start of the next command, the number of times the deviation between the position command value and the detected position intersects with a preset set width is equal to or less than a first predetermined number. Condition (3),
2. The electric motor according to claim 1, wherein one of a set satisfying at least one condition including at least the condition (1) is selected from among the three conditions, and a control parameter of the selected set is set. 3. Position control device. The control parameter adjustment unit,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. The measurement operation including the detection of, is configured to sequentially perform from the lower set of the proportional gain of the speed control unit to the higher set,
A response result measured from when the amplitude of the vibration component is equal to or greater than the first predetermined value is detected to be equal to or greater than a first predetermined time in a period from the start of the position instruction to the start of the next instruction. At
(1) A condition (1) in which a period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than the first predetermined time in a period from the start of the position instruction to the start of the next instruction.
(2) In the period from the start of the position command to the start of the next command, the period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a second predetermined time shorter than the first predetermined time. Conditions (2) and (3) The first predetermined number of times that the deviation between the position command value and the detected position intersects with a preset settling width in the period from the completion of the position command to the start of the next command. Condition (3) that is:
2. The electric motor according to claim 1, wherein one of a set satisfying at least one condition including at least the condition (1) is selected from among the three conditions, and a control parameter of the selected set is set. 3. Position control device. The control parameter adjustment unit,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. It is configured to sequentially perform measurement operations including detection of
In selecting a set,
(A) In the period from the start of the position command to the start of the next command, if it is detected that the period during which the amplitude of the vibration component is equal to or larger than the first predetermined value is equal to or longer than the first predetermined time, the response state is already set. The proportional gain of the highest speed control unit in the set in which the time during which the amplitude of the vibration component is equal to or greater than the first predetermined value is not detected as being equal to or greater than the first predetermined time, or If there is no proportional gain of the speed control unit corresponding to the above condition, a speed having a value between the lowest proportional gain of the speed control unit of the whole set and the currently set proportional gain of the speed control unit. A first selection to next select a set having a proportional gain of the control unit,
(B) In the period from the start of the position command to the start of the next command, it is not detected that the period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is equal to or greater than the first predetermined time. The period in which the response state has already been measured and the period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is the lowest speed control unit among the sets in which it is detected that the amplitude is equal to or greater than the first predetermined time. If there is no proportional gain, or if there is no proportional gain of the speed control unit corresponding to the above condition, the proportional gain of the highest speed control unit in the whole set and the proportional gain of the speed control unit set at the present time The second selection of selecting the set having the proportional gain of the speed control unit having the next value is repeated.
In the selection, when the next set to be selected no longer exists, in the measured response result,
(1) A condition (1) in which a time during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than the first predetermined time in a period from the start of the position instruction to the start of the next instruction.
(2) In the period from the start of the position command to the start of the next command, the period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a second predetermined time shorter than the first predetermined time. Conditions (2) and (3) The first predetermined number of times that the deviation between the position command value and the detected position intersects with a preset settling width in the period from the completion of the position command to the start of the next command. Condition (3) that is:
2. The electric motor according to claim 1, wherein one of a set satisfying at least one condition including at least the condition (1) is selected from among the three conditions, and a control parameter of the selected set is set. 3. Position control device. 5. The electric motor position control device according to claim 2, wherein the control parameter adjustment unit is configured to first select a start set specified from the outside. A load configuration pattern input unit having a plurality of load configuration patterns associated with the start set, wherein one of the plurality of load configuration patterns is externally designated;
The position control of the electric motor according to any one of claims 2 to 4, wherein the control parameter adjusting unit is configured to first select a start set associated with the load configuration pattern input from the load configuration pattern input unit. apparatus. The control parameter adjustment unit sequentially performs a measurement operation of a response state of the motor to a position command when the motor is controlled using the set selection and the control parameters of the selected set,
It is configured to select a set having the highest proportional gain of the speed control unit from among sets satisfying at least one condition including at least the condition (1) among the three conditions, and to set control parameters of the selected set. The position control device for an electric motor according to any one of claims 2 to 4. The control parameter adjustment unit detects that a period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is equal to or greater than the first predetermined time in a period from the start of the position instruction to the start of the next instruction. At this time, immediately after setting a control parameter of a set having a proportional gain of the speed control unit lower than the proportional gain of the current speed control unit, controlling the electric motor for a second predetermined number of times, selecting the next set The position control device for an electric motor according to any one of claims 2 to 4, wherein the position control device is configured to: The control parameter adjustment unit includes at least a proportional gain of a position control unit and a proportional gain of a speed control unit based on at least one of the position command value, the speed command value, the detected position, and the detected speed. It has a plurality of control parameter sets, performs a selection operation of the set and a measurement operation of a response state of the motor to a position command when controlling the motor using the control parameters of the selected set, and sequentially performs a measurement response state. The position control device for an electric motor according to any one of claims 1 to 4, wherein one of a set of control parameters is selected accordingly, and the control parameter of the selected set is set. The control parameter adjustment unit includes: a proportional gain of the speed control unit; a proportional gain of the position control unit when the detected speed of the electric motor is greater than a second predetermined value after the completion of the position command; The position control of the electric motor according to any one of claims 1 to 4, wherein a plurality of sets of control parameters including at least a proportional gain of the position control unit when the detected speed of the electric motor is equal to or less than the second predetermined value are provided. apparatus. The control parameter adjustment unit,
The proportional gain of the speed control unit, the proportional gain of the position control unit when the detected speed of the motor is greater than a second predetermined value after the completion of the position command, and the detected speed of the motor after the completion of the position command. And a plurality of control parameter sets including at least a proportional gain of the position control unit when the value is equal to or less than the second predetermined value,
After the completion of the position command, in the switching of the proportional gain of the position control unit when the detected speed of the electric motor becomes equal to or less than the second predetermined value,
After the completion of the position command, the detected speed of the motor after the completion of the position command is equal to or less than the second predetermined value, than the proportional gain of the position control unit when the detected speed of the motor is greater than the second predetermined value. When the proportional gain of the position control unit at the time is larger, after the position command is completed, the electric motor is gradually switched over the third predetermined time from when the detected speed of the electric motor becomes equal to or less than the second predetermined value. The motor position control device according to any one of claims 1 to 4, wherein the position control device is a motor. A position / speed calculation unit that calculates the speed of the motor from the detected position of the motor, or calculates the position of the motor from the detected speed of the motor;
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
A control parameter adjustment unit having a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit,
The control parameter adjustment unit,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. It is configured to sequentially perform the measurement operation including the detection of, in the measured result,
(1) A condition (1) in which a period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a first predetermined time in a period from the start of the position command to the start of the next command.
(2) A condition in which a period during which the amplitude of the vibration component is equal to or greater than a first predetermined value is less than a second predetermined time shorter than the first predetermined time in a period from the start of the position instruction to the start of the next instruction. (2) and (3) In the period from the completion of the position command to the start of the next command, the number of times that the deviation between the position command value and the detected position intersects a preset set width is equal to or less than a first predetermined number. Condition (3),
Selecting one of a set satisfying at least one condition including at least the condition (1) from among the three conditions, and setting the control parameter of the selected set by a third predetermined number of times from the motor. When controlling that the period during which the amplitude of the vibration component is equal to or greater than the first predetermined value is equal to or greater than the first predetermined time in the period from the start of the position instruction to the start of the next instruction. A set having the highest proportional gain of the speed control unit is newly selected from sets excluding the current set among sets satisfying at least one of the three conditions including at least the condition (1). And an electric motor position control device configured to set a newly selected set of control parameters. A position / speed calculation unit that calculates the speed of the motor from the detected position of the motor, or calculates the position of the motor from the detected speed of the motor;
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
A control parameter adjustment unit having a plurality of control parameter sets including at least the proportional gain of the position control unit and the proportional gain of the speed control unit,
The control parameter adjustment unit,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between a detected position and a position command value after completion of the position command. It is configured to sequentially perform the measurement operation including the detection of, and in the measured response result,
(1) A condition (1) in which, during a period from the start of the position command to the start of the next command, the time during which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than the first predetermined time;
(2) In the period from the start of the position command to the start of the next command, the period in which the amplitude of the vibration component is equal to or greater than the first predetermined value is less than a second predetermined time shorter than the first predetermined time. Conditions (2) and (3) The first predetermined number of times that the deviation between the position command value and the detected position intersects with a preset settling width in the period from the completion of the position command to the start of the next command. Condition (3) that is:
Selecting one of a set that satisfies at least one condition including at least the condition (1) among the three conditions, and setting a control parameter of the selected set;
Next, among the currently set control parameters, at least the proportional gain of the speed control unit is fixed, and the remaining control parameters are changed. And a motor position control device configured to set parameters other than the fixed parameters. The control parameter adjustment unit,
At least a proportional gain of the speed control unit, a proportional gain of the position control unit when the detected speed of the motor is greater than a second predetermined value after completion of the position command, and a proportional gain of the motor after completion of the position command. A plurality of control parameter sets including a proportional gain of the position control unit when the detected speed is equal to or less than the second predetermined value,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between the position command value after completion of the position command and the detected position. It is configured to sequentially perform the measurement operation including the detection of, and in the measured response result,
(1) A condition (1) in which a period in which the amplitude of the vibration component is equal to or greater than a first predetermined value is less than a first predetermined time in a period from the start of the position command to the start of the next command.
(2) a condition in which a period during which the amplitude of the vibration component is equal to or greater than the predetermined value in a period from the start of the position instruction to the start of the next instruction is less than a second predetermined time shorter than the first predetermined time ( 2) and (3) the condition (3) that, after the completion of the position command, the number of times that the deviation between the position command value and the detected position intersects a preset set width is equal to or less than a predetermined value;
Selecting one of a set that satisfies at least one condition including at least the condition (1) among the three conditions, and setting a control parameter of the selected set;
Next, of the currently set control parameters, only the proportional gain of the position control unit when the detected speed of the electric motor is equal to or less than the second predetermined value after the completion of the position command is changed within a predetermined range. Measuring the response state when controlling the motor, and satisfying the conditions (2) and (3) among the three conditions in the measured response result, and after the completion of the position command, the detection position and the position 14. The position control device for an electric motor according to claim 13, wherein a proportional gain of the position control unit is set such that a time required for a deviation from a command value to enter a preset set width is the shortest. The control parameter adjustment unit,
At least, the proportional gain of the speed control unit, the proportional gain of the position control unit when the detected speed of the electric motor is greater than a predetermined value after the completion of the position command, and the detected speed of the electric motor after the completion of the position command. A plurality of sets of control parameters including a proportional gain of the position control unit when the value is equal to or less than a second predetermined value,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between the position command value after completion of the position command and the detected position. It is configured to sequentially perform the measurement operation including the detection of, and in the measured response result,
(1) A condition (1) in which a period in which the amplitude of the vibration component is equal to or greater than a first predetermined value is less than a first predetermined time in a period from the start of the position command to the start of the next command.
(2) a condition in which a period during which the amplitude of the vibration component is equal to or greater than the predetermined value in a period from the start of the position instruction to the start of the next instruction is less than a second predetermined time shorter than the first predetermined time ( 2) and (3) the condition (3) that, after the completion of the position command, the number of times that the deviation between the position command value and the detected position intersects a preset set width is equal to or less than a predetermined value;
Selecting one of a set that satisfies at least one condition including at least the condition (1) among the three conditions, and setting a control parameter of the selected set;
Next, among the currently set control parameters, only the proportional gain of the position control unit when the detected speed of the electric motor is equal to or less than the second predetermined value after the completion of the position command is set to a small value within a predetermined range. From the side, and measure the response state when controlling the motor,
After the completion of the position command, the change of the proportional gain of the position control unit is stopped when the number of times that the deviation between the detected position and the position command value intersects a preset set width is equal to or greater than a predetermined value,
Time at which the condition (2) and condition (3) among the above three conditions are satisfied at the time of stop and the deviation between the detected position and the position command value enters a preset stabilization width after completion of the position command. 14. The electric motor position control device according to claim 13, wherein the proportional gain of the position control unit having the shortest is set. The control parameter adjustment unit,
At least a proportional gain of the speed control unit, a proportional gain of the position control unit when the detected speed of the electric motor is greater than a second predetermined value after the completion of the position command, and a proportional gain of the electric motor after the completion of the position command. And a plurality of sets of control parameters including at least a proportional gain of the position control unit when the detected speed is equal to or less than the second predetermined value,
When the set is selected and the motor is controlled using the selected set of control parameters to sequentially measure the response state of the motor, a vibration component having a frequency equal to or higher than a predetermined frequency included in the detected position or detected speed of the motor. At least one of the following components: detection of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit; and detection of a deviation between the position command value after completion of the position command and the detected position. It is configured to sequentially perform the measurement operation including the detection of, and in the measured response result,
(1) A condition (1) in which a period during which the amplitude of the vibration component is equal to or more than a first predetermined value is less than a first predetermined time in a period from the start of the position command to the start of the next command.
(2) a condition in which a period during which the amplitude of the vibration component is equal to or greater than the predetermined value in a period from the start of the position instruction to the start of the next instruction is less than a second predetermined time shorter than the first predetermined time ( 2) and (3) the condition (3) that, after the completion of the position command, the number of times that the deviation between the position command value and the detected position intersects a preset set width is equal to or less than a predetermined value;
Selecting one of a set that satisfies at least one condition including at least the condition (1) among the three conditions, and setting a control parameter of the selected set;
Next, after the completion of the position command, the proportional gain of the position control unit when the detected speed of the electric motor is equal to or less than the second predetermined value, and the predetermined value of the detected speed that determines the proportional gain of the position control unit As a variable, each is changed within a different predetermined range, and a response state when the electric motor is controlled is measured. In the measured response result, the condition (2) and the condition (3) among the three conditions are satisfied; After the completion of the position command, the proportional gain of the position control unit and the proportional gain of the position control unit are determined in which the time until the deviation between the detected position and the position command value enters a preset set width is the shortest. 14. The position control device for an electric motor according to claim 13, wherein a predetermined value of the detected speed is set. A position / speed calculation unit that calculates the speed of the motor from the detected position of the motor, or calculates the position of the motor from the detected speed of the motor;
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
After completion of the position command, a control parameter adjustment unit configured to externally set a target value of a time until a deviation between the detected position and the position command value enters a preset set width,
In the operation of selecting a set and measuring the response state of the electric motor with the control parameters of the selected set, the control parameter adjusting unit sets the deviation between the detected position and the position command value to a settling width after the completion of the position command. A position control device for an electric motor configured to stop selection of a set when the time required to enter the operation becomes equal to or less than the target value set from the outside, and to set a control parameter at that time. The control parameter adjustment unit,
After setting the control parameters of the current set and controlling the motor for the third predetermined number of times, having a function of setting the control parameters of the next selected set;
Only after the control of the selected set is set and the control is performed a fourth predetermined number of times smaller than the third predetermined number of times, the condition (2) and the condition (3) of the three conditions are detected. The motor position control device according to any one of claims 1 to 4, wherein the position control device is a motor. The control parameter adjustment unit,
After setting the control parameters of the current set and controlling the motor for the third predetermined number of times, having a function of setting the control parameters of the next selected set;
Only after the control of the selected set is set and the control is performed a fourth predetermined number of times smaller than the third predetermined number of times, the condition (2) and the condition (3) of the three conditions are detected. The electric motor position control device according to any one of claims 11 to 16, wherein the position control device is a motor. A notch filter that is arranged in either the position control system or the speed control system and has a variable notch center frequency,
The notch frequency of the notch filter so as to reduce the vibration component having a predetermined frequency or higher included in the detection position or the detection speed, or the vibration component having a predetermined frequency or higher included in a torque command which is an input to the motor drive unit. The position control device for an electric motor according to any one of claims 1 to 4, further comprising a notch frequency correction unit that sequentially corrects the notch frequency. A notch filter that is arranged in either the position control system or the speed control system and has a variable notch center frequency,
The notch frequency of the notch filter is sequentially reduced so as to reduce a vibration component having a predetermined frequency or more included in the detection position or the detection speed or a vibration component having a predetermined frequency or more included in a torque command input to the motor drive unit. A notch frequency correction unit to correct,
When the selected set changes, the set immediately before the change and the notch frequency immediately before the change are stored in association with each other, and when the newly selected set is the same as the previously selected set, the previously selected set is changed. 5. The electric motor position control device according to claim 1, further comprising: a notch frequency storage unit that resets a notch frequency stored in association with the notch frequency as the notch frequency of the notch filter. A notch filter that is arranged in either the position control system or the speed control system and has a variable notch center frequency,
The notch frequency of the notch filter is sequentially reduced so as to reduce a vibration component having a predetermined frequency or more included in the detection position or the detection speed or a vibration component having a predetermined frequency or more included in a torque command input to the motor drive unit. A notch frequency correction unit to correct,
When the selected set changes, the set immediately before the change and the notch frequency immediately before the change are stored in association with each other. 18. The electric motor position control device according to claim 12, further comprising: a notch frequency storage unit that resets a notch frequency stored in association with the notch frequency of the notch filter. A notch filter that is arranged in either the position control system or the speed control system and has a variable notch frequency;
The notch frequency of the notch filter is sequentially reduced so as to reduce a vibration component having a predetermined frequency or more included in the detection position or the detection speed or a vibration component having a predetermined frequency or more included in a torque command input to the motor drive unit. A notch frequency correction unit to correct,
When the selected set changes, the set immediately before the change and the notch frequency immediately before the change are stored in association with each other, and when the newly selected set is the same as the previously selected set, the previously selected set is added to the previously selected set. A notch frequency storage unit for resetting the notch frequency stored in association with the notch frequency of the notch filter, and thereafter prohibiting the change of the notch frequency of the notch filter for a fourth predetermined time. The position control device for an electric motor according to claim 1. A notch filter that is arranged in either the position control system or the speed control system and has a variable notch frequency;
The notch frequency of the notch filter is sequentially reduced so as to reduce a vibration component having a predetermined frequency or more included in the detection position or the detection speed or a vibration component having a predetermined frequency or more included in a torque command input to the motor drive unit. A notch frequency correction unit to correct,
When the selected set changes, the set immediately before the change and the notch frequency immediately before the change are stored in association with each other, and when the newly selected set is the same as the previously selected set, the previously selected set is added to the previously selected set. A notch frequency storage unit for resetting the notch frequency stored in association with the notch frequency of the notch filter, and thereafter prohibiting the change of the notch frequency of the notch filter for a fourth predetermined time. An electric motor position control device according to claim 12. The control parameter adjustment unit,
Only during a period in which the position command satisfies the predetermined condition, a vibration component of a predetermined frequency or higher included in the detected position or the detected speed of the motor is detected, or a vibration of a predetermined frequency or higher included in the torque command input to the motor driving unit is detected. The position control device for an electric motor according to any one of claims 1 to 4, wherein the position control device is configured to detect a component. The control parameter adjustment unit,
Only during a period in which the position command satisfies the predetermined condition, a vibration component of a predetermined frequency or more included in the detected position or the detected speed of the motor is detected, or a vibration of a predetermined frequency or more included in the torque command input to the motor drive unit is detected. The position control device for an electric motor according to any one of claims 12 to 17, configured to detect a component. 5. The electric motor according to claim 1, wherein the period in which the position command satisfies the predetermined condition is a period excluding a period of a predetermined time from a time point at which a change in acceleration of the position command is equal to or more than a predetermined value. 6. Position control device. The electric motor according to any one of claims 12 to 17, wherein the period in which the position command satisfies the predetermined condition is a period excluding a period of a predetermined time from a time point at which a change in acceleration of the position command is equal to or more than a predetermined value. Position control device. During the period when the position command satisfies the predetermined condition,
(1) A time period from when the time change of the position command changes from 0 to non-zero to a predetermined time elapses, and (2) A time period from when the time change of the position command changes from non-zero to 0 to the predetermined time elapses The position control device for an electric motor according to any one of claims 1 to 4, wherein the position control device is configured to be a period excluding the period of (1). During the period when the position command satisfies the predetermined condition,
(1) A time period from when the time change of the position command changes from 0 to non-zero to a predetermined time elapses, and (2) A time period from when the time change of the position command changes from non-zero to 0 to the predetermined time elapses The position control device for an electric motor according to any one of claims 12 to 17, wherein the position control device is configured to be a period other than the period. During the period when the position command satisfies the predetermined condition,
(1) The period excluding the period in which the time change is non-zero in the position command, and (2) the period excluding the period from the time when the time change in the position command changes from non-zero to zero until a predetermined time elapses. The position control device for an electric motor according to claim 1. During the period when the position command satisfies the predetermined condition,
(1) A period excluding a period in which the time change is non-zero in the position command, and (2) a period excluding a period until a predetermined time elapses from the time when the time change in the position command changes from non-zero to zero. An electric motor position control device according to any one of claims 12 to 17. A position / speed calculation unit that calculates the speed of the motor from the detected position of the motor, or calculates the position of the motor from the detected speed of the motor;
A position control unit that causes the detection position to follow a position command value,
A speed control unit that causes the detected speed to follow a speed command value according to the output of the position control unit,
A motor drive unit that drives the motor based on a torque command value according to the output of the speed control unit,
An inertia estimating unit that estimates a total inertia of the electric motor and a load driven by the electric motor based on the acceleration and the torque command value calculated from the detected speed;
The amplitude of a vibration component having a frequency equal to or higher than a predetermined frequency included in the detection position or the detection speed of the motor, or the amplitude of a vibration component having a frequency equal to or higher than a predetermined frequency included in a torque command input to the motor drive unit is equal to or higher than a predetermined value. From the time of detecting, the inertia estimation temporary stop determination unit to stop the inertia estimation calculation of the inertia estimation unit for a predetermined time,
A plurality of sets of control parameters including at least the proportional gain of the position control unit and the proportional gain of the speed control unit are selected, the set is selected, and the position when the electric motor is controlled using the control parameters of the selected set. A control parameter adjusting unit that measures a response state of the electric motor to a command, and sets one set of control parameters according to the response state;
A position control device for an electric motor, comprising:

Images