(57)【要約】【課題】制御対象の周波数特性を求めるには専用の測定器等が必要であり、掃引周波数や速度信号による適当な加振条件の設定が困難、測定結果の解析処理が複雑、測定結果に応じた適切なフィルタの設定が困難等、の問題がある。【解決手段】制御系の振動を検出する手段と、振動振幅の山、谷、山と計測して振動周波数を測定する手段とを備え、所定の大きさのステップ状の模擬外乱トルクで繰り返し加振し、加振ごとに制御ゲインを上げていく処理を、所定の振動検出レベルになる迄繰り返し行ない、前記振動検出レベルの到達を検出した時に、前記振動周波数測定手段で振動周波数を測定し、前記振動周波数で振動抑制フィルタの周波数を設定する。【選択図】　　図１
2004086702.tif 000002
【特許請求の範囲】
【請求項１】
サーボモータを駆動するサーボ制御装置において、
制御系の振動振幅より振動を検出する振動検出手段と、振動振幅の山、谷、山と計測して振動周波数を測定する手段を備え、機械等の振動を発生する状況を作る為に振動が発生する迄制御ゲインを上げたところで、あるレベルの振動を与えるようなステップ状の模擬外乱トルクをトルク指令に加える加振手段を持ち、加振の大きさを調整し加振し前記振動検出手段で振動検出を行い、振動を検出するまで前記の制御ゲインを上げ模擬外乱トルクを加える処理をある振動レベルになる迄繰り返し、前記振動検出手段が振動を検出した時に、前記振動周波数測定手段で振動周波数を測定し、前記振動周波数で振動抑制フィルタの周波数を設定することを特徴とする振動抑制フィルタの自動設定方法。
【請求項２】
前記振動抑制フィルタの自動設定方法において、
前記振動検出手段が振動を検出した振動周波数が制御能力で決まる周波数帯域以上では、振動周波数近傍を遮断するようなフィルタを選択し振動周波数が制御能力で決まる周波数帯域以内では、振動周波数以上を遮断するようなフィルタを選択することを特徴とする振動抑制フィルタの自動設定方法。
【請求項３】
前記振動抑制フィルタの自動設定方法において、
前記振動検出手段が振動を検出した時に機械の振動を抑えるため制御ゲインを下げる等することを特徴とする振動抑制フィルタの自動設定方法。
【請求項４】
サーボモータを駆動するサーボ制御装置において、
制御系の振動振幅より振動を検出する振動検出手段と振動振幅の山、谷、山と計測して振動周波数を測定する手段を備え、通常運転中振動が発生した時にある振動レベルを超えた場合振動と検出し、前記振動検出手段が振動を検出した時に、前記振動周波数測定手段で振動周波数を測定し、前記振動周波数で振動抑制フィルタの周波数を設定することを特徴とする振動抑制フィルタの自動設定方法。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明はサーボモータを駆動するサーボ制御装置において、機械等を加振手段により計測できるような振動状況を作り上げ振動させて、或いは振動する状況で振動を検出した時に、その振動振幅を山、谷、山と時間を計測してその周波数を得て、その時定数分のフィルタを決定する方法に関する。
【０００２】
【従来の技術】
従来、図８のようにサーボの指令入力（例えば速度指令）に周波数解析装置（あるいはＦＦＴ解析装置）の信号出力を接続し、サーボの検出出力（例えばモータ速度）を周波数解析装置に入力する。
周波数解析装置は周波数を掃引した信号をサーボへ出力し、サーボで駆動されたモータの速度波形をＦＦＴ解析し、振動の周波数を求める。あるいは、掃引波形とモータ速度波形のＦＦＴ解析結果からサーボ系の周波数特性を求め、振動周波数を特定する。
このようにして求めた、振動周波数から、共振する周波数を遮断するような振動抑制フィルタ（例えば、ノッチフィルタや低域通過フィルタ等）のパラメータを設定していた。
例えば、図６（ｉ）のグラフから共振周波数ｆ０を求め、フィルタの遮断周波数をｆ０に合わせて、図６（ｉｉ）のようにする。
また、特開平０５−３４６８１３号公報のように振幅一定で周波数を変化させた信号をサーボへ加え、モータ速度信号あるいは機械の可動テーブルの位置信号等を周波数分析し、共振する周波数を求め、これをカットするようにフィルタのパラメータを決めていた。
【０００３】
【発明が解決しようとする課題】
ところが従来の技術では、周波数特性を求めるために、専用の測定器等が必要で周波数掃引する周波数、速度信号を用い適当な振幅等の適する条件を人が設定する必要があり、例えば条件設定を間違えて信号が小さい場合正しく測定できず、信号が大きいと大きな共振が発生して機械を壊す等の可能性があった。
またその結果のＦＦＴ解析をするのは処理が大変なのと、測定したデータに幾つかピークがある場合必要なものを抽出する必要があった。　更にその振動の周波数よりどのようなフィルタが必要か人が選択してその周波数の逆数の時定数分のフィルタをサーボに設定しなければならず、到底自動でできなかった。
周波数特性の測定では計測器が機械的に周波数掃引を行うので、１度振動すると非常停止する迄マシンが振動し続ける問題もあった。またその場合マシンの振動状態は直ぐに収まらないので、暫く続く可能性があった。
そこで本案は、特別な処理の必要としない簡単な方法で、かつ機械の振動を極力抑えた安全な方法で制御装置が自動的に振動周波数を検出して、どのようなフィルタが必要かを判断してフィルタを設定すること等を目的とする。
【０００４】
【課題を解決するための手段】
上記課題を解決するため、機械等の振動を発生する状況を作る為に振動が発生する迄サーボの制御ゲインを上げたところで、あるレベルの振動を与えるようなステップ状の模擬外乱トルクをトルク指令に加えて振動させる或いは通常運転中振動検出手段である振動レベルを超えた場合振動を検出する。その振動振幅の最大、最小、最大とピークを計測して周波数を測定する。振動させる場合、加振の大きさを調整し加振し前記振動検出手段で振動検出を行い、振動を検出するまで前記の制御ゲインを上げ模擬外乱トルクを加える処理をある振動レベルになる迄繰り返し、或いは通常運転中振動が発生した時にある振動レベルを超えた場合振動と検出し、前記振動検出手段が振動を検出した時に、前記振動周波数測定手段で振動周波数を測定し、前記振動周波数でその周波数以上又はその近傍をカットするように帯域のフィルタを振動周波数及び制御能力より選択する。振動を検出した場合、模擬外乱トルクをトルク指令に加える動作は終了し上げていた制御ゲインは下げ、機械の振動を抑える動作を行う。
【０００５】
上記手段により、簡単な方法で設定でき、振動する制御ゲインを調整するのでこれ以上ゲインを上げてはいけない、なるべく振動させたくない測定等に使用できる。またサーボ制御装置単体で機械の特性や制御能力に応じて判断して自動的に設定することができる。
【０００６】
【発明の実施の形態】
以下、本発明の具体的実施例を図１に示して説明する。
図１においては１は振動周波数測定手段、２はマイクロコンピュータ、３は電流アンプ、４はヘ゛ースドライブ回路、５はパワートランジスタモジュール、６はモータ、７はエンコーダ、８は負荷、９は振動検出回路である。
以上のように構成された回路において、その動作を図２の制御ブロック図及び図７の概略フローチャートを用いて説明する。
まずマイクロコンピュータ２は位置や速度といった指令を外部のコントローラ等から受取る。そして例えば速度指令の場合は速度制御を行い、その出力の電流指令で電流制御を行い、ベースドライブ駆動回路４を通してパワートランジスタ５を駆動してモータを制御する。
ここでマイクロコンピュータ２は、通常の制御以外に、図２のブロックに関して、下記の制御処理を実行する。
まず最初に位置ループや速度ループといった制御系のゲインを低ゲインとしておき、図３のように通常運転、或いは運転して機械特有の運転時の振動レベルを検出する。この図では通常運転でのトルクの振動振幅の最大値を検出している。　図７のフローチャートの処理１を行う。
次に位置ループや速度ループといった制御系のゲインを低ゲインとしておき、図２の制御ブロック図のトルク指令τｒｅｆに模擬外乱トルクをステップ状に加えて、位置偏差あるいは速度等の応答をあるレベル以上あることを確認する。
図７のフローチャートの２から３の処理を行う。ここで、あるレベル以上の応答がなければ、加えた模擬外乱トルクが機械負荷を超えられなかったと考え、模擬外乱トルクを大きくする。
あらかじめ定めたレベルまで、応答が大きくなるように模擬外乱トルクを大きくする。この応答のレベルは前記図７のフローチャートの処理１のように例えば通常の運転中の振動振幅の最大値を２倍等にする。
そして模擬外乱トルクがあるレベルまで大きくしても応答が大きくならない場合、応答の検出レベルを下げる。
このようにして模擬外乱トルクの大きさとその応答の検出レベルを調整する。
模擬外乱トルクの大きさを決めた後で、次に図４に示すような時間タイミングで段階的にゲインを上げる。
図７のフローチャート４〜６の処理のようにゲインを上げたところで、トルク指令に模擬外乱トルクを加え振動検出回路９にて、振動を確認する。振動検出回路９は図４のように例えばトルク又は速度等の振幅を振動検出レベルと比較し、大きい場合振動として検出する。振動レベルは前に調整した応答レベルの１．５倍等する。振動の発生はこれに限ったことではなく通常運転でマシンが振動した時に、振動を検出しても良い。
通常、停止中や運転中では制御ゲインを上げてもマシンはなかなか発振等はしない。これは負荷や摩擦等でそれ以上の大きなトルクによる外乱がかからないといけないのと多くの場合マシン自体が振動を抑えるように働くからである。停止中では弾性系のものが負荷や摩擦等で抑えられ、走行中では負荷、摩擦や運動の
慣性等で振動しようとするトルクが抑えられる。但し、抑えられるトルクより大きな外乱等が発生又は振動により発生すると発振する。本案ではこの模擬外乱トルクをマシンの振動を与えるようなレベルで加振して外すことによりトリガーとして働き、振動を誘発させるものである。図５は実際の機械である程度ゲインを上げ、模擬外乱トルクをかけた時の速度とトルクの応答波形である。振動成分はあるが収束していることが分かる。この機械も更にゲインを上げ模擬外乱トルクをかけて外すと発振する。
模擬外乱トルクを加えた後にあるレベルを超えて振動を検出又は通常運転中に振動を検出したら、振動周波数測定手段１にて、振動周期を測定する。例えば、図５のように振動波形の振幅の最小値から次の最小値まで、あるいは最大値から次の最大値までの時間を測定し、振動の周期を測定する。
測定精度を向上するためには、前記の最小値についてのｎ周期分の時間を測定し、ｎ周期の平均を計算することにより正確に周期を測定すれば良い。例えば図５のように２周期観測して平均の周期Ｔを求め、この周期Ｔの逆数を周波数ｆ０とする。
次に図７のフローチャート６の処理で振動検出回路９にて振動を検出すると図４のようなタイミングで模擬外乱トルクを加えるのは停止し、ゲインを振動しないレベル迄下げる（例えば、振動したゲインの半分あるいは、最初に設定した低いゲイン等）。あるいは、確実に振動を止めるため、トルク指令を絞るか、位置偏差を一瞬ゼロにする。図７のフローチャート７の処理を行う。
測定した振動周波数ｆ０を、振動抑制フィルタ、例えばノッチフィルタのノッチ周波数として設定すると、例えば、図６（ｉ）のような共振と反共振を持ったマシンの周波数応答を図６（ｉｉ）のように共振を抑えた特性に制御することができる。あるいはｆ０によって、低域通過フィルタの遮断周波数を設定しても同等な効果を得ることができる。この場合、低域通過フィルタの遮断周波数は、測定したｆ０のあらかじめ設定した定数倍とすれば良い。図７のフローチャート８の処理のように振動周波数が制御能力で決まる周波数より高い場合、図７のフローチャート９−１の処理のように周波数近傍を遮断するような振動抑制フィルタ、例えばノッチフィルタを選択し振動周波数が低い場合、図７のフローチャート９−２の処理のように周波数以上を遮断するような振動抑制フィルタ、例えば低域通過フィルタを選択しフィルタの時定数等を設定する。制御能力で決まる周波数は例えば４００Ｈｚ程度迄は制御ゲインに影響を及ぼす可能性があるので低域通過フィルタ等を使用する等の理由で、制御能力等に応じて決める。
また振動周波数測定手段１や振動検出回路９は、マイクロコンピュータ２で行っても良い。
【０００７】
【発明の効果】
以上述べたように本発明によれば、簡単な方法で機械の特性や制御能力に応じて判断して設定でき、振動する制御ゲインを調整し模擬外乱トルクによる加振と振動検出手段が独立に持っているため振動の検出で、即制御ゲインを下げる等することができる。これにより、これ以上ゲインを上げてはいけない測定等に使用できるという効果がある。
【０００８】
【図面の簡単な説明】
【図１】本発明の具体的実施例の構成図である。
【図２】制御ブロック図である。
【図３】通常運転した時の速度指令、速度、トルクの波形と振動レベルの測定タイミング図である。
【図４】ゲインを上げて振動を発生及び振動発生時のゲイン低下、振動周波数測定タイミング図である。
【図５】振動波形の例である。
【図６】マシンの周波数特性である。
【図７】本案の振動抑制フィルタを設定する概略フローチャートである。
【図８】従来の実施例の構成図である。
【符号の説明】
１　振動周波数測定手段
２　マイクロコンピュータ
３　電流アンプ
４　ヘ゛ースドライブ回路
５　パワートランジスタモジュール
６　モータ
７　エンコーダ
８　負荷
９　振動検出回路
１１　周波数特性ＦＦＴ解析測定器
１２　サーボ制御装置
１３　モータ
１４　エンコーダ
１５　負荷
【図１】
2004086702.tif 000003
【図２】
2004086702.tif 000004
【図３】
2004086702.tif 000005
【図４】
2004086702.tif 000006
【図５】
2004086702.tif 000007
【図６】
2004086702.tif 000008
【図７】
2004086702.tif 000009
【図８】
2004086702.tif 000010