(57)【要約】【課題】サーボモータを駆動するサーボ制御装置における振動抑制フィルタの設定方法において、振動抑制フィルタ設定後、振動の大きさを確認し、適切なＱ値を設定できる方法を提供する。【解決手段】  サーボ制御装置運転中に発生する振動を検出し、振動から周波数成分の大きい周波数を抽出し、周波数が所定値より低い場合は振動抑制フィルタとして周波数以上の帯域を遮断するローパスフィルタを適用し、周波数が所定値以上の場合は振動抑制フィルタとして周波数近傍の帯域を遮断するノッチフィルタを適用し、ノッチフィルタを適用する場合には、一旦ノッチフィルタのＱ値を設定後、Ｑ値を大きくしながら振動の抑制効果を確認し、適切なＱ値を設定する。【選択図】図１
2006288113.tif 000002
【特許請求の範囲】
【請求項１】
サーボモータを駆動するサーボ制御装置における振動抑制フィルタの設定方法であって、
前記サーボ制御装置運転中に発生する振動を検出し、
前記振動から周波数成分の大きい周波数を抽出し、
前記周波数が所定値より低い場合は振動抑制フィルタとして前記周波数以上の帯域を遮断するローパスフィルタを適用し、
前記周波数が所定値以上の場合は振動抑制フィルタとして前記周波数近傍の帯域を遮断するノッチフィルタを適用し、
前記ノッチフィルタを適用する場合には、一旦前記ノッチフィルタのＱ値を設定後、前記Ｑ値を大きくしながら前記振動の抑制効果を確認し、適切な前記Ｑ値を設定することを特徴とする振動抑制フィルタの設定方法。
【請求項２】
前記Ｑ値を大きくする過程において前記振動の抑制効果がない場合、再度前記振動の周波数を測定して前記周波数近傍以外の帯域を遮断するノッチフィルタを適用し、Ｑ値を設定することを特徴とする請求項１に記載の振動抑制フィルタの設定方法。
【請求項３】
前記Ｑ値を大きくする過程において、前記振動の周波数と前記サーボ制御装置の速度制御ゲインとの干渉を考慮して前記Ｑ値を設定することを特徴とする請求項１に記載の振動抑制フィルタの設定方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、サーボモータを駆動するサーボ制御装置において、機械などの振動を抑制する振動抑制フィルタを設定する方法に関する。
【背景技術】
【０００２】
サーボ制御装置の運転中に発生する振動の周波数を求めるために、従来は図８に示すように周波数解析装置（または高速フーリエ変換（ＦＦＴ）解析装置）１２とサーボ制御装置を接続し、周波数解析装置１２からサーボ制御装置へ速度指令などの指令を与え、その結果であるサーボモータ６の回転速度などを周波数解析装置１２へフィードバックする構成をとっていた。
周波数解析装置１２は周波数を掃引した信号をサーボ制御装置へ出力する一方、サーボ制御装置により駆動されるサーボモータ６の速度波形をＦＦＴ解析し、振動周波数を求めていた。または、掃引波形とサーボモータ６の速度波形のＦＦＴ解析結果から機械系の周波数特性を求め、振動周波数を特定していた。
このようにして求めた振動周波数から、共振を発生させる周波数を遮断する振動抑制フィルタ（ノッチフィルタや低減通過（ローパス）フィルタなど）のパラメータを設定していた。
例えば、図５（ａ）のような周波数応答のグラフから共振周波数ｆ０を求め、フィルタの遮断周波数を図５（ｂ）のようにｆ０より低い値に設定していた（例えば特許文献１参照）。
あるいは、サーボモータの検出速度を２次以上のハイパスフィルタに通しさらにノッチフィルタに通した出力が所定値以上となった場合にノッチフィルタのノッチ周波数を修正し、その周波数を振動抑制のための別のノッチフィルタのノッチ周波数として設定するという手法が用いられていた（例えば特許文献２参照）。
このように、従来は周波数解析装置などの測定器で測定を行い、手動にて振動抑制フィルタの設定を行っていた。
【０００３】
【特許文献１】特開２００３−９５６２号公報
【特許文献２】特開２００３−５２１８８号公報
【発明の開示】
【発明が解決しようとする課題】
【０００４】
しかしながら、特許文献１の方法では機械系の周波数特性を求めるために専用の測定器が必要で、周波数掃引する周波数、速度指令信号を用い適当な振幅などの条件を人が設定する必要があった。
条件を間違えて設定して速度指令信号が小さくなると正しく測定できず、逆に速度指令信号が大きいと大きな共振が発生して機械を壊してしまうといった問題があった。またＱ値は別途調整しなければならないという問題があった。
一方、特許文献２の方法では構成が複雑であったり、Ｑ値の調整ができなかったりするという問題があった。
本発明はこのような問題点に鑑みてなされたものであり、振動抑制フィルタ設定後、振動の大きさを確認し、適切なＱ値を設定できる方法を提供することを目的とする。
【課題を解決するための手段】
【０００５】
上記問題を解決するため、本発明は、次のようにしたのである。
請求項１に記載の発明は、サーボモータを駆動するサーボ制御装置における振動抑制フィルタの設定方法であって、前記サーボ制御装置運転中に発生する振動を検出し、前記振動から周波数成分の大きい周波数を抽出し、前記周波数が所定値より低い場合は振動抑制フィルタとして前記周波数以上の帯域を遮断するローパスフィルタを適用し、前記周波数が所定値以上の場合は振動抑制フィルタとして前記周波数近傍の帯域を遮断するノッチフィルタを適用し、前記ノッチフィルタを適用する場合には、一旦前記一旦前記ノッチフィルタのＱ値を設定後、前記Ｑ値を大きくしながら前記振動の抑制効果を確認し、適切な前記Ｑ値を設定することを特徴とする。
また、請求項２に記載の発明は、前記Ｑ値を大きくする過程において前記振動の抑制効果がない場合、再度前記振動の周波数を測定して前記周波数近傍以外の帯域を遮断するノッチフィルタを適用し、Ｑ値を設定することを特徴とする。
また、請求項３に記載の発明は、前記Ｑ値を大きくする過程において、前記振動の周波数と前記サーボ制御装置の速度制御ゲインとの干渉を考慮して前記Ｑ値を設定することを特徴とする。
【発明の効果】
【０００６】
請求項１に記載の発明によると、振動抑制フィルタの振動抑制効果を確認することができ、さらに効果を上げるためＱ値を最適な値に調整することができる。
また、請求項２に記載の発明によると、振動抑制効果がない場合に再度振動周波数を測定してＱ値を設定することができる。
また、請求項３に記載の発明によると、速度制御ゲインや制御周波数などとの干渉を防止することができる。
【発明を実施するための最良の形態】
【０００７】
以下、本発明の方法の具体的実施例について、図に基づいて説明する。
【実施例１】
【０００８】
図１は、本発明の方法を実施するサーボ制御装置の構成を示す構成図である。
実際のサーボ制御装置には様々な機能や手段が内蔵されているが、図には本発明に関係する機能や手段のみを記載し説明することとする。
図１において１は振動検出手段、２はマイクロコンピュータ、３は電流アンプ、４はベースドライブ回路、５はパワートランジスタモジュール、６はモータ、７はエンコーダ、８はモータ６の負荷、９はデータトレース手段、１０は周波数解析手段である。
マイクロコンピュータ２内は、振動抑制フィルタを適用する振動抑制フィルタ部１１を備える。
以上のように構成された装置について、その動作を説明する。まずマイクロコンピュータ２は位置や速度といった指令を外部のコントローラから受け取る。
例えば速度指令であれば、マイクロコンピュータ２は速度指令から速度フィードバックを差し引き、ゲインを乗じて速度制御を行い、電流アンプ３はマイクロコンピュータ２が出力する電流指令に従って電流制御を行い、ベースドライブ回路４を介してパワートランジスタモジュール５を駆動してモータ６を制御する。
【０００９】
ここでデータトレース手段９は、モータ６が定速運転のような通常の運転中、モータ６の指令速度と実際の速度との差や、トルクといったデータを図２のようにトレースする。
早送り速度中に振動が発生した場合には振動検出手段１にて検出する。ここで、振動検出手段１はモータ６へのトルク指令（電流指令）あるいはモータ６からフィードバックされる速度信号中に含まれる振動成分が予め定めたレベルを超えた場合に振動として検出するものとする。
検出レベルは例えば図３のように、実際に運転させた時の振動振幅を検出して決定する。図３では通常運転時のモータ６へのトルク指令の振動振幅の最大値を検出しており、例えばこの通常時の振動レベルの３倍程度を検出レベルとする。
振動が検出されると、その時のトレースデータを周波数解析手段１０にて周波数解析する。解析結果のうち、スペクトル分の大きい周波数成分または振動エネルギーに相当するものが大きい周波数（周波数とその時の振動振幅との積、またはその２乗値が大きい周波数）を選択する。図４の例では図４（ｂ）にてｆ０を選択している。
【００１０】
周波数解析により選択した振動周波数ｆ０を、マイクロコンピュータ２にて振動抑制フィルタ（例えばノッチフィルタ）のノッチ周波数として設定し、マイクロコンピュータ２による信号処理としてフィルタリングを行うと図５（ａ）のような共振と反共振特性を持った機械系の周波数特性を、図５（ｂ）のように共振を抑えた特性に制御することができる。
ノッチフィルタは図６に示すような特性を持ち、その入力信号から不要な周波数を除去すると同時にその他の周波数に与える影響は少なくするために使用される。ノッチ周波数とは、図６のｆｃに当たる。
あるいはｆ０をもとにローパスフィルタの遮断周波数を設定しても同等の効果を得ることができる。この場合はローパスフィルタの遮断周波数はｆ０を予め設定した定数倍したものとすればよい。
【００１１】
振動抑制フィルタとしてノッチフィルタを用いる場合には、図６に示すようにそのノッチ周波数ｆｃ付近でしか振動抑制の効果がなく、ピンポイントで設定しなければならない。ノッチ周波数と振動周波数とが一致していないと振動抑制の特性が劣ったり、逆効果になったりする。そこでＱ値や深さなどを変化させて適当なノッチ周波数へと絞り込むことにより、振動抑制効果を確認することができる。これはノッチ周波数を絞り込んでも振動抑制効果がない場合は、周波数がずれているということで、逆効果になってしまうからである。
Ｑ値とはフィルタの周波数応答の変化の鋭さを示す尺度であり、図６に示すような特性のノッチフィルタにてＱ値を大きくすると、そのノッチ周波数付近の帯域でしか振動抑制効果はなくなる。図６において、３[ｄＢ]遮断周波数ｆｃ１とノッチ周波数ｆｃとの関係は次式のとおりである。
【００１２】
【数１】
2006288113.tif 000003
【００１３】
例えばｆｃ＝１０００[Ｈｚ]、Ｑ＝０．７の場合、ｆｃ１＝５１５[Ｈｚ]となるが、Ｑ値を大きくしてＱ＝２．０とするとｆｃ１＝７８１[Ｈｚ]となり、振動抑制効果が発揮される帯域が狭くなるのが分かる。
【００１４】
振動抑制フィルタの設定の一連の工程を図７に示すフローチャートにて説明する。まずステップ１でデータトレース手段９にてトルク指令または検出速度をトレースする。次にステップ２で、振動検出手段１にて振動が発生したか確認する。振動が発生した場合、ステップ３でデータトレース手段９のデータを周波数解析手段１０にて解析する。
次にステップ４で振動周波数の判定を行う。前述したようにスペクトル分の大きい周波数成分または振動エネルギーに相当するものが大きい周波数を選択する。
また振動発生中に数回に渡ってデータを採って振動周波数を判定する場合であれば数回分のデータから振動エネルギーに相当するものが大きい周波数を選択するようにすると判定しやすい。
次にステップ５にて、振動周波数が制御系の性能によって決まる周波数以上であると判定された場合は、ステップ６−１のように振動周波数近傍を遮断するような振動抑制フィルタ（例えばノッチフィルタ）を選択し、後述のＱ値などを設定するステップへ移る。
振動周波数が低い場合は、ステップ６−２のようにその振動周波数以上を遮断するような振動抑制フィルタ（例えばローパスフィルタ）を選択してフィルタの時定数などを設定する。
制御能力によって決まる周波数は、例えば「振動周波数が４００[Ｈｚ]以下の場合は制御ゲインに影響を及ぼす可能性があるのでローパスフィルタを使用する」など、制御能力や制御ゲインに応じて後述の式（３）より算出するか、あるいは予め求めておく。
【００１５】
振動抑制フィルタとして一次のローパスフィルタを用いる場合には、速度制御ゲインＫｖと遮断周波数ｆｃ１との関係は例えば次式のようにする。
【００１６】
【数２】
2006288113.tif 000004
【００１７】
ノッチフィルタを用いる場合には、式（１）、式（２）より、次式のようにする。ここで、ノッチ周波数ｆｃをステップ４にて求めた振動周波数とする。
【００１８】
【数３】
2006288113.tif 000005
【００１９】
例えば式（３）にてｆｃ＝１０００[Ｈｚ]、Ｑ＝０．７とすると式（１）よりｆｃ１＝５１５[Ｈｚ]となるのでＫｖは１２９[Ｈｚ]以上１７２[Ｈｚ]以下となる。
このようにして本発明では、速度制御ゲインＫｖとの干渉を考慮してＱ値を設定することができる。また、速度制御ゲインＫｖの上限、下限の範囲（式（２）における１／４〜１／３のような係数）は制御遅れやマージンを考慮して決定する。
そしてノッチフィルタを用いる場合、ステップ７でＱ値を変え、ステップ８で振動データをトレースし、振動レベルを確認し、振動が小さくなるならばＱ値を大きくする。
振動抑制の効果があるならばそのノッチ周波数とＱ値を採用し、効果がない場合はノッチ周波数が適切でないと判断して再設定を行う。
【００２０】
このように機械系に振動、共振や共鳴が発生した際に、必要な振動抑制フィルタを設定することができる。また連続して解析したものとは異なり、共振周波数のみ得られるので制御系の振動成分と分けることができる。
解析するデータは機械系の振動を反映するものであればモータの検出速度と推定速度との差以外のもの、例えばトルクなどでもよい。推定速度としては、トルク指令から負荷を考慮して算出した速度やオブサーバにより推定した速度を使用する。
また、振動検出手段１、データトレース手段９や周波数解析手段１０はマイクロコンピュータ２で行ってもよい。
【産業上の利用可能性】
【００２１】
本発明は、モータを駆動するサーボ制御装置での機械系の振動抑制用途に広く適用できる。
【図面の簡単な説明】
【００２２】
【図１】本発明の方法を適用するサーボ制御装置の構成を示す図
【図２】通常運転した時の速度指令、速度、トルクの波形と振動レベルの測定タイミングを示す図
【図３】振動波形の例を示す図
【図４】ＦＦＴによる周波数解析の例を示す図
【図５】ノッチフィルタまたはローパスフィルタを適用した例を示す図
【図６】ノッチフィルタの周波数特性を示す図
【図７】本発明の振動抑制フィルタ設定手順を示すフローチャート
【図８】従来の振動抑制フィルタの設定方法を示す構成図
【符号の説明】
【００２３】
１  振動検出手段
２  マイクロコンピュータ
３  電流アンプ
４  ベースドライブ回路
５  パワートランジスタモジュール
６  モータ
７  エンコーダ
８  負荷
９  データトレース手段
１０  周波数解析手段
１１  振動抑制フィルタ部
１２  周波数特性解析手段
【図１】
2006288113.tif 000006
【図２】
2006288113.tif 000007
【図３】
2006288113.tif 000008
【図４】
2006288113.tif 000009
【図５】
2006288113.tif 000010
【図６】
2006288113.tif 000011
【図７】
2006288113.tif 000012
【図８】
2006288113.tif 000013