(57)【特許請求の範囲】
【請求項１】
サーボモータで駆動される送り軸を有する工作機械の制御装置において、
サーボモータの速度指令値を作成する速度指令作成部と、
サーボモータのトルク指令値を作成するトルク指令作成部と、
サーボモータの速度を検出する速度検出部と、
前記速度指令作成部、前記トルク指令作成部、及び前記速度検出部を含む速度制御ループと、
前記速度制御ループの制御ゲインを設定する速度制御ループゲイン設定部と、
前記速度制御ループへの正弦波掃引を行う正弦波外乱入力部と、
正弦波を前記速度制御ループへ入力したときの速度制御ループの出力から、速度制御ループ入出力信号の利得と位相を推定する周波数特性算出部と、
送り軸の規範的な周波数特性を作成する規範特性作成部と、
前記速度制御ループゲインを調整するゲイン調整部と、を具備し、
前記ゲイン調整部は、前記規範特性作成部が作成する規範的な周波数特性と前記周波数特性算出部が算出する実測の周波数特性とを用いて、実測の周波数特性に対する周波数掃引毎の評価関数値を計算し、所望の評価関数値を実現する前記速度制御ループゲインへの調整をオンラインで実行する、
ことを特徴とするサーボ制御装置。
【請求項２】
前記規範特性作成部は、送り軸の構成に応じて変更可能な規範特性を作成する、請求項１に記載のサーボ制御装置。
【請求項３】
前記ゲイン調整部は、目標とする所望の評価関数値と実際の掃引に対する評価関数値との差に基づいて前記速度制御ループゲインの調整量を決定する、請求項１に記載のサーボ制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、サーボ制御装置に関し、特に評価関数によって制御ゲインをオンラインで最適化する機能を有するサーボ制御装置に関する。
【背景技術】
【０００２】
サーボ制御装置の制御系の周波数特性の測定にかかわる装置や手法は数多く提案され、工作機械の送り軸における伝達特性の計測においても広く活用されている。一般的には分析対象を加振装置で強制的に振動させた場合（周波数掃引）の応答振動を測定し、その時系列データを大容量メモリにロギングした後、種々の信号処理技術によって周波数伝達関数を求める。簡易的な測定を行う場合は、アクチュエータ自体を加振源とした場合の応答振動を測定・ロギングして信号処理を行う。電気回路や光学系の場合は加振回路が用いられる。
【０００３】
制御ゲインを最適化するシステムとして、時系列信号をフィッティングして規範モデルの基本形関数を定義し、その関数に調整パラメータを含めたものを規範モデルに選ぶ方法が提案されている（例えば、特許文献１）。この従来技術では、時系列データとして取得して定量化可能な複数の指標（オーバシュートや立上り時間）の加重和を評価関数としてＰＩＤパラメータの調整を行っている。評価関数の意味については問わないがプラント制御の補償器の最適化ができるというものである。
【０００４】
また、実測の時系列データと規範応答の時系列データとの誤差を使って制御特性の評価値を算出する方法も提案されている（例えば、特許文献２）。この従来技術では、近似モデルを調整装置内に持ち、この近似モデルに対する調整を行った後に実際の制御対象へ調整結果を適用する。
【０００５】
しかしながら、これらの従来技術は時間領域での応答への曲線適合を狙った規範モデルフィッティングが基礎となっている。オンラインで取得可能な周波数特性を用いて、周波数領域で直接的に規範伝達関数との差異を定量評価する方法に関してはこれまでに提案されていなかった。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２０１５−０７６０２４号公報
【特許文献２】特開平９−１３１０８７号公報
【発明の概要】
【発明が解決しようとする課題】
【０００７】
本発明は、制御特性を数理的に定義した最適化問題として取り扱うことで、安定性と高速応答性との両立が原則的に確立できるサーボ制御装置を提供することを目的とする。
【課題を解決するための手段】
【０００８】
本発明の一実施例に係るサーボ制御装置は、サーボモータで駆動される送り軸を有する工作機械の制御装置において、サーボモータの速度指令値を作成する速度指令作成部と、サーボモータのトルク指令値を作成するトルク指令作成部と、サーボモータの速度を検出する速度検出部と、速度指令作成部、トルク指令作成部、及び速度検出部を含む速度制御ループと、速度制御ループの制御ゲインを設定する速度制御ループゲイン設定部と、速度制御ループへの正弦波掃引を行う正弦波外乱入力部と、正弦波を速度制御ループへ入力したときの速度制御ループの出力から、速度制御ループ入出力信号の利得と位相を推定する周波数特性算出部と、送り軸の規範的な周波数特性を作成する規範特性作成部と、速度制御ループゲインを調整するゲイン調整部と、を具備し、ゲイン調整部は、規範特性作成部が作成する規範的な周波数特性と周波数特性算出部が算出する実測の周波数特性とを用いて、実測の周波数特性に対する周波数掃引毎の評価関数値を計算し、所望の評価関数値を実現する速度制御ループゲインへの調整をオンラインで実行する、ことを特徴とする。
【発明の効果】
【０００９】
本発明の一実施例に係るサーボ制御装置によれば、安定性と高速応答性との両立が原則的に確立できるサーボ制御装置を提供することができる。
【図面の簡単な説明】
【００１０】
【図１】本発明の実施例に係るサーボ制御装置の構成図である。
【図２】本発明の実施例に係るサーボ制御装置における、正弦波周波数、入力信号、出力信号、並びに利得及び位相の周波数特性のそれぞれの時間的変化を表す図である。
【図３】本発明の実施例に係るサーボ制御装置における、正弦波周波数、周波数特性の実測値及び規範となる周波数特性、並びに評価関数値のそれぞれの時間的変化を表す図である。
【図４】本発明の実施例に係るサーボ制御装置における、大型機用の規範特性及び小型機用の規範特性を用いた場合の利得の周波数特性、並びに大型機用の規範特性及び小型機用の規範特性を用いた場合の位相の周波数特性を表す図である。
【図５】本発明の実施例に係るサーボ制御装置の動作手順を説明するためのフローチャートである。
【発明を実施するための形態】
【００１１】
以下、図面を参照して、本発明の実施例に係るサーボ制御装置について説明する。
【００１２】
図１は本発明の実施例に係るサーボ制御装置の構成を示すブロック図である。本発明の実施例に係るサーボ制御装置１００は、サーボモータ２０で駆動される送り軸を有する工作機械の制御装置において、サーボモータ２０の速度指令値を作成する速度指令作成部１と、サーボモータ２０のトルク指令値を作成するトルク指令作成部２と、サーボモータの速度を検出する速度検出部３と、速度指令作成部１、トルク指令作成部２、及び速度検出部３を含む速度制御ループ４と、速度制御ループ４の制御ゲインを設定する速度制御ループゲイン設定部５と、速度制御ループ４への正弦波掃引を行う正弦波外乱入力部６と、正弦波を速度制御ループ４へ入力したときの速度制御ループ４の出力から、速度制御ループ入出力信号の利得と位相を推定する周波数特性算出部７と、送り軸の規範的な周波数特性を作成する規範特性作成部８と、速度制御ループゲインを調整するゲイン調整部９と、を具備し、ゲイン調整部９は、規範特性作成部８が作成する規範的な周波数特性と周波数特性算出部７が算出する実測の周波数特性とを用いて、実測の周波数特性に対する周波数掃引毎の評価関数値を計算し、所望の評価関数値を実現する速度制御ループゲインへの調整をオンラインで実行する、ことを特徴とする。
【００１３】
次に、本発明の実施例に係るサーボ制御装置の動作について説明する。まず、速度指令作成部１がサーボモータ２０を駆動するための速度指令値を作成し、加算器１０へ出力する。加算器１０は、正弦波外乱入力部６から入力された正弦波外乱を速度指令値に加算すると共に、速度検出部３が検出したサーボモータ２０の速度検出値を減算し、計算結果を速度ループゲイン設定部５へ出力する。
【００１４】
速度制御ループゲイン設定部５は、ゲイン調整部９によって調整された速度制御ループ４の制御ゲインを設定する。
【００１５】
トルク指令作成部２は、加算器１０の計算結果に速度制御ループゲインを乗算した値を取得し、トルク指令を出力しサーボモータ２０を駆動する。サーボモータ２０は伝達機構３０を介して駆動体（図示せず）を動作させる。
【００１６】
速度制御ループ４は、速度指令作成部１、トルク指令作成部２、及び速度検出部３を含むように構成されている。
【００１７】
正弦波外乱入力部６は速度制御ループ４への正弦波掃引を行う。即ち、正弦波外乱入力部６は、速度制御ループ４へ正弦波外乱を入力する。
【００１８】
周波数特性算出部７は、正弦波外乱をサーボ制御装置１００の速度制御ループ４へ入力したときの速度制御ループ４の出力から、速度制御ループ入出力信号の利得と位相を推定する。さらに、周波数特性算出部７は、正弦波外乱入力部６からの外乱入力周波数を基本周波数とした、任意の項数からなるフーリエ級数によって速度制御ループ４の出力を表現し、そのフーリエ級数の基本波成分の振幅と位相を算出することで周波数特性をオンラインで算出する。
【００１９】
規範特性作成部８は、送り軸の規範的な周波数特性を作成する。
【００２０】
ゲイン調整部９は、速度制御ループゲインを調整する。ゲイン調整部９は、目標とする所望の評価関数値と実際の掃引に対する評価関数値との差に基づいて速度制御ループゲインの調整量を決定することが好ましい。
【００２１】
本発明の実施例に係るサーボ制御装置１００は、サーボ制御系に速度制御用のループ構造を持つ。速度制御ループ４はサーボモータ２０に接続している伝達機構３０の機械的特性を直接的に反映する。
【００２２】
周波数特性の算出方法を問題にする場合はこの速度制御ループの構造自体は重要ではなく、図１に示した破線部を１つの入出力関係をもつシステムと捉えれば十分である。したがって速度制御ループ４の入力信号と出力信号との間の対応関係のみを考えればよい。周波数掃引を行う場合は、入力信号の正弦波周波数を段階的に増やしていくときの出力信号の定常応答を調べることで周波数特性が得られる。
【００２３】
次に、本発明の実施例に係るサーボ制御装置の動作の動作について説明する。図２（ａ）に正弦波外乱入力部６から速度制御ループ４に加える外乱入力である正弦波の周波数の時間的変化を示す。図２（ａ）において、時刻ｔ0からｔ1に渡って正弦波周波数を増加させ、時刻ｔ1で初期値に戻す。同様に、時刻ｔ1からｔ2に渡って正弦波周波数を増加させ、時刻ｔ2で初期値に戻す。以下同様にして正弦波周波数を変化させる。ここで、時刻ｔ0からｔ1までの期間を第１期間、時刻ｔ1からｔ2までの期間を第２期間、時刻ｔ2からｔ3までの期間を第３期間とする。
【００２４】
図２（ｂ）に速度制御ループ４の入力信号の時間的変化を示し、図２（ｃ）に速度制御ループ４の出力信号の時間的変化を示す。周波数特性算出部７は、正弦波を速度制御ループ４へ入力したときの速度制御ループの出力から、速度制御ループ入出力信号の利得と位相を推定する。周波数特性算出部７が推定した利得（実線）と位相（点線）の時間的変化を図２（ｄ）に示す。本実施例ではゲイン調整部９が速度制御ループゲインのハイゲイン化調整を行っているため、第１期間、第２期間、第３期間と時間を追うごとに利得が増大している。
【００２５】
次に、本発明により制御系の周波数特性を逐次計測し、規範特性と実測特性とで構成する評価関数によって制御パラメータをオンラインで最適化する方法について説明する。図３（ａ）に正弦波外乱入力部６から速度制御ループ４に加える外乱入力である正弦波の周波数の時間的変化を示す。
【００２６】
周波数特性算出部７は、正弦波を速度制御ループ４へ入力したときの速度制御ループ４の出力から、当該周波数での周波数特性、即ち、速度制御ループ入出力信号の利得と位相を推定する。そして、規範特性作成部８が、送り軸の規範的な周波数特性を計算する。図３（ｂ）に周波数特性の実測値（実線）及び規範となる周波数特性（点線）の時間的変化を示す。入力信号の正弦波周波数が最大値に達すると、ゲイン調整部９が、掃引に対する評価関数値を計算する。
【００２７】
次に、ゲイン調整部９が、規範特性作成部８が作成する規範的な周波数特性と周波数特性算出部７が算出する実測の周波数特性とを用いて、実測の周波数特性に対する周波数掃引毎の評価関数値を計算する。評価関数Ｓjは下記の式（１）のように表される。
【００２８】
【数１】
0006050865.tif 000002
ただし、
ω：周波数
kv：速度制御ループゲイン
W(ω)：周波数特性に対する重み付け
Gmodel(ω)：規範特性
Gexperimental(ω)：実測特性
である。
式（１）は重みつき最小二乗法による計算式である。Ｓjが最小となる速度制御ループゲインkvを逐次掃引で算出する。このようにして、最適な速度制御ループゲインkvを求めることができる。
【００２９】
上記の式（１）は評価関数値の算出式の一例であって、他の評価関数を用いることもできる。例えば、下記の式（２）のように表した評価関数を用いてもよい。
【００３０】
【数２】
0006050865.tif 000003
式（２）に従って評価関数Ｓjを用いる場合、Ｓjが０に近いほど速度制御ループゲインkvが目標値に近くなる。また、Ｓjが負の場合はゲインが過剰であることを示す。
【００３１】
評価関数値の時間的変化を図３（ｃ）に示す。第１期間（時刻：ｔ0〜ｔ1）の評価関数値は時刻ｔ1において算出される。時刻ｔ1において、１期間前の評価関数値と比較され、差分がゲイン調整量に反映される。第２期間、第３期間においても同様に評価関数値が計算され、評価関数値が目標値に到達するまで繰り返される。このようにして、ゲイン調整部９は、所望の評価関数値を実現する速度制御ループゲインへの調整をオンラインで実行する。また、ゲイン調整部９は、目標とする所望の評価関数値と実際の掃引に対する評価関数値との差に基づいて速度制御ループゲインの調整量を決定することが好ましい。図３（ｃ）においては、時刻ｔ3において、評価関数値が目標値に到達する例を示している。
【００３２】
なお、規範特性作成部８は、送り軸の構成に応じて変更可能な規範特性を作成することが好ましい。例えば、制御の対象となる機械が大型機であるか小型機であるかに従って、規範特性を変えることができる。図４（ａ）は、大型機用の規範特性に基づく利得の周波数特性と、小型機用の規範特性に基づく利得の周波数特性を示し、図４（ｂ）は、大型機用の規範特性に基づく位相の周波数特性と、小型機用の規範特性に基づく位相の周波数特性を示す。評価関数の値を正しく見積もるためには、共振周波数の高低を意識して規範特性（理想的な特性）を想定しておく必要がある。ここでは、理想的な特性として、大型機用の特性は制御帯域が狭く、小型機用の特性は制御帯域が広いものと定義している。小型機ではノミナルな特性として共振周波数が高くなる傾向にあるので、帯域を比較的容易に広くすることができる（ゲインを高くしてもよい）。一方、大型機では共振周波数が低くなる傾向にあるので帯域を広くすることは難しくなる（ゲインをあまり高くできない）。このように、制御対象の機械が大型機であるか小型機であるかに基づいて規範特性を変えることによって、上述のような共振特性の違いを背景にして、ハイゲイン化の目安を含めて評価関数値をより正確に計算できる。
【００３３】
以上説明したように、本発明の実施例によるサーボ制御装置においては、自らが加振入力可能なシーケンサとして働いてオンラインで周波数特性を測定する。計測を繰返し行うたびに評価関数計算を実行し、規範特性へ近づけるようにコントローラのパラメータ調整を逐次的に実行することで、制御装置自身がオンラインで最適な制御特性を実現するようなパラメータを取得することができる。
【００３４】
次に、本発明の実施例に係るサーボ制御装置の動作手順について図５に示したフローチャートを用いて説明する。まず、ステップＳ１０１において、正弦波外乱入力部６（図１参照）が入力周波数を初期化する。次に、ステップＳ１０２において、正弦波外乱入力部６が速度制御ループ４に正弦波外乱を入力する。次に、ステップＳ１０３において、速度検出部３がサーボモータ２０の速度を検出する。
【００３５】
次に、ステップＳ１０４において、トルク指令作成部２が、速度指令値、速度検出値、及び速度制御ループゲインからトルク指令値を作成する。次に、ステップＳ１０５において、周波数特性算出部７が、当該周波数での周波数特性を算出する。次に、ステップＳ１０６において、規範特性作成部８が、周波数毎に規範となる周波数特性を計算する。次に、ステップＳ１０７において、正弦波外乱入力部が入力周波数を更新する。
【００３６】
次に、ステップＳ１０８において、入力信号の正弦波周波数が最大値に達したか否かを判断する。入力信号の正弦波周波数が最大値に達していない場合はステップＳ１０１からステップＳ１０８の各ステップを繰り返す。入力信号の正弦波周波数が最大値に達した場合は、ステップＳ１０９において、ゲイン調整部９が、掃引に対する評価関数値を計算する。評価関数値の計算方法は上述した通りである。
【００３７】
次に、ステップＳ１１０において、評価関数値が目標値に到達したか否かを判断する。評価関数値が目標値に到達していない場合は、ステップＳ１１１において、評価関数値が目標値に近づくようにゲイン調整部９が速度制御ループゲインを変更し、ステップＳ１０１からステップＳ１１０までの各ステップを繰り返す。
【００３８】
評価関数の値が目標値に到達した場合は、ステップＳ１１２において、ゲイン調整部９が最終的な速度制御ループゲインを確定する。以上のようにして、オンラインで取得可能な周波数特性を用いて、周波数領域で直接的に規範伝達関数との差異を定量評価することができる。
【００３９】
以上説明したように、本発明の実施例に係るサーボ制御装置によれば、制御系の周波数特性を逐次計測し、規範特性と実測特性とで構成する評価関数によって制御パラメータをオンラインで最適化することができる。
【符号の説明】
【００４０】
１    速度指令作成部
２    トルク指令作成部
３    速度検出部
４    速度制御ループ
５    速度制御ループゲイン設定部
６    正弦波外乱入力部
７    周波数特性算出部
８    規範特性作成部
９    ゲイン調整部
１０    加算器
２０    サーボモータ
【要約】
【課題】本発明は、数理的に定義した最適化問題として取り扱うことで、安定性と高速応答性との両立が原則的に確立できるサーボ制御装置を提供することを目的とする。
【解決手段】本発明の一実施例に係るサーボ制御装置は、速度指令作成部と、トルク指令作成部と、速度検出部と、速度制御ループと、速度制御ループゲイン設定部と、速度制御ループへの正弦波掃引を行う正弦波外乱入力部と、正弦波を速度制御ループへ入力したときの速度制御ループの出力から、速度制御ループ入出力信号の利得と位相を推定する周波数特性算出部と、送り軸の規範的な周波数特性を作成する規範特性作成部と、速度制御ループゲインを調整するゲイン調整部と、を具備し、ゲイン調整部は、規範的な周波数特性と実測の周波数特性とを用いて周波数掃引毎の評価関数値を計算し、所望の評価関数値を実現する速度制御ループゲインへの調整をオンラインで実行する、ことを特徴とする。
【選択図】図１【図１】
0006050865.tif 000004
【図２】
0006050865.tif 000005
【図３】
0006050865.tif 000006
【図４】
0006050865.tif 000007
【図５】
0006050865.tif 000008