(57)【要約】【課題】負荷モータの回転子イナーシャを瞬時的に推定する回転子イナーシャ推定方法を提供する。【解決手段】モデルモータの電流信号に応じて適応フィルタの入力信号３０１を決定する段階と、適応フィルタの目標信号３０２を決定する段階と、入力信号３０１に応じて遅延信号３０４を得て、遅延信号３０４に対して、それぞれ対応する重みを乗じて、重み付け済み出力信号３０７を出力する段階と、重み付け済み出力信号３０７とフィルタリング済み目標信号３０８との間の偏差３０９を決定する段階と、適応フィルタによって、最小二乗平均法を用いて入力信号３０１と目標信号３０２に応じたサーバ制御系の回転子イナーシャを決定する段階とを有する。【選択図】            図４
2004229490.tif 000002
【特許請求の範囲】
【請求項１】
制御対象物を備えるサーボ制御系で用いられる負荷モータの回転子イナーシャを瞬時的に推定する回転子イナーシャ推定方法であって、
モデルモータを参照して、モデルモータの電流信号に応じて適応フィルタの入力信号を決定する段階と、
駆動モータの電流信号と前記モデルモータの電流信号との間の偏差に応じて適応フィルタの目標信号を決定する段階と、
前記入力信号に応じて複数の遅延信号を得て、当該複数の遅延信号に対して、それぞれ対応する重みを乗じて、重み付け済み出力信号を出力する段階と、
前記重み付け済み出力信号と前記目標信号との間の偏差を決定する段階と、
前記適応フィルタによって、最小二乗平均法を用いて前記入力信号と前記目標信号に応じた前記サーボ制御系の前記回転子イナーシャを決定する段階と、を有することを特徴とする回転子イナーシャ推定方法。
【請求項２】
前記モデルモータの回転子イナーシャは既知であることを特徴とする請求項１に記載の回転子イナーシャ推定方法。
【請求項３】
さらに、前記遅延信号を得る段階の前に、前記入力信号をバンドパスフィルタに通してフィルタリングし、フィルタリング済みの入力信号を得る段階を有することを特徴とする請求項１に記載の回転子イナーシャ推定方法。
【請求項４】
さらに、前記偏差を決定する段階の前に、前記目標信号をバンドパスフィルタに通してフィルタリングし、フィルタリング済みの目標信号を得る段階を有することを特徴とする請求項１に記載の回転子イナーシャ推定方法。
【請求項５】
前記重みは時間的に変化することを特徴とする請求項１に記載の回転子イナーシャ推定方法。
【請求項６】
次の時点での重みは、ゲイン要素、前記入力信号、および前記偏差を掛け合わせて２倍した結果と、現在の時点での重みとの和で与えられることを特徴とする請求項５に記載の回転子イナーシャ推定方法。
【請求項７】
前記ゲイン要素は、前記適応フィルタのゲイン要素であることを特徴とする請求項６に記載の回転子イナーシャ推定方法。
【請求項８】
前記サーボ制御系の前記回転子イナーシャは、負荷モータの回転子イナーシャと駆動モータ回転子イナーシャとの和と、前記モデルモータの回転子イナーシャとの比で与えられることを特徴とする請求項１に記載の回転子イナーシャ推定方法。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、回転子イナーシャを推定する方法に関し、特に、交流サーボ駆動部の負荷回転子イナーシャを即時に推定する推定方法に関する。
【０００２】
【従来の技術】
交流永久磁石型同期モータの基本構造は、通常の同期モータの構造と類似している。固定子側は、三相のコイルの組を有し、回転子側は、磁界を発生するために永久磁石を有する。交流永久磁石型同期モータは、磁界励起回路、スライドリング、および電気ブラシを備える必要がない。かかるモータは、体積当たりの出力が高く、高効率であり、さらにトルク振動が小さいという利点を有している。したがって、このようなモータは、たとえば、高精密で、かつ高い応速度を要求される機械加工装置のような精密サーボ機構の駆動部として好適に応用される。
【０００３】
広く使用されているサーボ制御システムのなかで、負荷モータの回転子イナーシャは、サーボ設計上の重要なパラメータといえる。そして、正確なサーボ制御を行うためには、このパラメータを正確に推定しなければならない。
【０００４】
デジタル信号処理装置の急速な発展によって、交流サーボドライバ（駆動部）は、インテリジェント化の傾向を呈している。インテリジェント化によれば、交流サーボドライバが、自機およびその周辺環境の変化を理解し、最適な運転を行うことができるようになる。インテリジェント機能によって、人間によって設定しなければならない事項を更に少なくすることができ、この結果、ユーザによる操作がさらに容易なものとなる。しかし、本当にインテリジェントな交流サーボ駆動部を得るためには、回転子イナーシャが正確に推定されなければならない。幾つかの駆動部設計では、ユーザから負荷モータの回転子イナーシャが入力される設計が採用されている。
【０００５】
【発明が解決しようとする課題】
しかしながら、ユーザによって負荷モータの回転子イナーシャを入力するといった上記の方法は、柔軟ではない。仮に、負荷モータの回転子イナーシャが意味するところをユーザが知らない場合には、十分に調整を行うことができず、その製品は他のインテリジェント型の製品に対抗することが難しくなる。
【０００６】
したがって、サーボ制御系においてインテリジェントな動作を行うという目標を真の意味で達成するためには、負荷モータの回転子イナーシャの推定方法を提供することが非常に重要である。
【０００７】
このように、本発明の目的は、負荷モータの回転子イナーシャを瞬時的に推定する推定方法を提供することである。駆動モータによって駆動される制御対象のモータの回転子イナーシャが瞬時的に推定されて、この結果、駆動モータの出力を調整される。これによって、即時の推定と正確な制御という目標が達成される。
【０００８】
【課題を解決するための手段】
上記目的は、以下の構成により達成される。
【０００９】
（１）本発明の回転子イナーシャ推定方法は、制御対象物を備えるサーボ制御系で用いられる負荷モータの回転子イナーシャを瞬時的に推定する回転子イナーシャ推定方法であって、モデルモータを参照して、モデルモータの電流信号に応じて適応フィルタの入力信号を決定する段階と、駆動モータの電流信号と前記モデルモータの電流信号との間の偏差に応じて適応フィルタの目標信号を決定する段階と、前記入力信号に応じて複数の遅延信号を得て、当該複数の遅延信号に対して、それぞれ対応する重みを乗じて、重み付け済み出力信号を出力する段階と、前記重み付け済み出力信号と前記目標信号との間の偏差を決定する段階と、前記適応フィルタによって、最小二乗平均法を用いて前記入力信号と前記目標信号に応じた前記サーボ制御系の前記回転子イナーシャを決定する段階と、を有することを特徴とする。
【００１０】
（２）上記のモデルモータの回転子イナーシャは既知である。
【００１１】
（３）上記の方法は、さらに、前記遅延信号を得る段階の前に、前記入力信号をバンドパスフィルタに通してフィルタリングし、フィルタリング済みの入力信号を得る段階を有する。
【００１２】
（４）上記の方法は、さらに、前記偏差を決定する段階の前に、前記目標信号をバンドパスフィルタに通してフィルタリングし、フィルタリング済みの目標信号を得る段階を有する。
【００１３】
（５）上記の重みは時間的に変化する。
【００１４】
（６）次の時点での重みは、ゲイン要素、前記入力信号、および前記偏差を掛け合わせて２倍した結果と、現在の時点での重みとの和で与えられる。
【００１５】
（７）上記のゲイン要素は、前記適応フィルタのゲイン要素である。
【００１６】
（８）上記のサーボ制御系の前記回転子イナーシャは、負荷モータの回転子イナーシャと駆動モータ回転子イナーシャとの和と、前記モデルモータの回転子イナーシャとの比で与えられる。
【００１７】
【発明の実施の形態】
本実施の形態で開示される方法は、モデル系と実際の系とを比較し、相対的な信号を得る。適応フィルタおよび最小二乗平均（Ｌｅａｓｔ  Ｍｅａｎ  Ｓｑｕａｒｅ：ＬＭＳ）法が、制御対象のパラメータを得るために使用される。
【００１８】
開示される方法によれば、モータ機構制御回路が、仮想的に回転子イナーシャが既知である理想的なモデルモータとみなされる。このモデルモータでの速度コントローラ出力が、適応フィルタへの入力信号の一つとなる。また、結合系における駆動モータでの速度コントローラ出力と、上記のモデルモータでの速度コントローラ出力とが比較され、両者の間の偏差の量が適応フィルタの目標信号として決定される。負荷モータの回転子イナーシャは、所定のアルゴリズムを用いて適応フィルタによって推定される。
【００１９】
上述の目標を達成するために開示される方法を具体的に説明すれば、この方法は、適応フィルタのための２つの入力信号として、モデルモータの電流信号に応じた入力信号と、サーボ制御システムからの目標信号とを決定する。モデルモータの電流信号に応じた入力信号は、少なくとも一つの遅延信号（遅延入力信号）を得るために少なくとも一つの遅延部を通過する。各遅延信号には、対応する重みが乗じられて、重み付け済み出力信号としてシンセサイザによって出力される。重み付け済み出力信号と上記の目標信号との間の偏差が決定され、次の時点での新たな重みを決定するためにフィードバックされる。この開示される方法は、入力信号と目標信号を用いる適応フィルタでの重みを算出するためにＬＭＳ法を用いる。これらのパラメータから、本発明は、モデルモータ、駆動モータ、および負荷モータ間での回転子イナーシャの比率を決定する。
【００２０】
本発明は、以下の詳細な説明から十分に理解される。以下の記述は、説明のために与えられるものであって、本発明は、これらの場合に限定されるものではない。以下、本発明の好適な実施の形態について説明する。
【００２１】
最初に、負荷モータの回転子イナーシャ（ｒｏｔｏｒ  ｉｎｅｒｔｉａ）を推定するために本発明で用いられる適応フィルタおよび最小二乗平均（Ｌｅａｓｔ  Ｍｅａｎ  Ｓｑｕａｒｅ：ＬＭＳ）法を説明する。この適応フィルタは、負荷モータのイナーシャを推定するための主要構成要素である。ＬＭＳ法は、この適応フィルタによって用いられる主要なアルゴリズムである。
【００２２】
最初に、単一入力の適応トランスバーサルフィルタを考慮する。
【００２３】
【数１】
2004229490.tif 000003
【００２４】
ここで、ｙｋは、実際の出力信号であり、ｘｋは、実際の入力信号であり、さらに、ｗｌｋは、信号の重みである。
【００２５】
図１に示されているように、第１遅延入力信号Ｘｋ−１は、入力信号Ｘｋが遅延部１１を通過した後の信号である。第２遅延入力信号Ｘｋ−２は、第１遅延入力信号Ｘｋ−１が遅延部１２を通過した後の信号である。信号Ｘｋ−Ｌは、第Ｌ番目の遅延部１３を経て処理された後の第Ｌ番目の遅延入力信号である。上記の式（１）は、複数の遅延信号と、単一入力の適応トランスバーサルフィルタのための対応する「重み」の内積を示している。そして、シンセサイザ１４は、複数の遅延信号と、出力のための対応づけられている「重み」を結びつける。したがって、上式では、実際の入力信号ベクトルを表すために、Ｘｋ＝〔ｘｋ  ｘｋ−１  …  ｘｋ−Ｌ〕Ｔを用い、実際の信号重みベクトルを表すために、Ｗｋ＝〔ｗ０ｋ  ｗ１ｋ  …  ｗＬｋ〕Ｔを用いている。
【００２６】
次に、遅延信号に乗じられる重み、目標信号（目標出力）ｄｋ、および偏差（目標信号と重み付け済みの出力信号との差）ｅｋ＝ｄｋ−ｙｋを決定する方法を説明する。複数の遅延信号に対する「重み」ｗ０ｋ，ｗ１ｋ，ｗ２ｋ，…，およびｗＬｋは、最小二乗平均（ＬＭＳ）法を用いて得られる。偏差信号ｅｋは、出力信号ｙｋと目標出力ｄｋとを結びつけることによってシンセサイザ１５によって得られる。図面に示されるとおり、偏差信号ｅｋは、次式で与えられる。
【００２７】
【数２】
2004229490.tif 000004
【００２８】
複数の偏差信号は、実際の各出力信号ｙｋと各目標出力信号ｄｋとの間の偏差の二乗をとって最小となるように、最小二乗平均（ＬＭＳ）法を用いて推定される。
【００２９】
遅延信号の重みに関する偏差の二乗の微分は、次式のように定義される。
【００３０】
【数３】
2004229490.tif 000005
【００３１】
この式において、最急降下法（ｓｔｅｅｐｅｓｔ−ｄｅｓｃｅｎｔ  ｍｅｔｈｏｄ）を用いて、一般解を、以下のように表現することができる。
【００３２】
【数４】
2004229490.tif 000006
【００３３】
ここで、μは、適応フィルタの安定性および収束速度を決定するためのゲイン要素（ゲインファクタ）であり、Ｌをフィルタレベルとしたときに、次の関係を満たす。
【００３４】
【数５】
2004229490.tif 000007
【００３５】
また、式（３）を式（４）に代入することによって、次の式が得られる。
【００３６】
【数６】
2004229490.tif 000008
【００３７】
これが要求されるＬＭＳアルゴリズムである。換言すれば、目標信号と出力信号との間の偏差の信号は、次の時点の信号の重みを推定するためにフィードバックされる。したがって、次の時点に処理が移ったとき、遅延信号と関連づけられる「重み」も時間的に変化する。一旦、システムが定常状態に達すると、負荷モータの回転子イナーシャを推定することができる。
【００３８】
入力信号とサーボ制御システムからの目標信号（要求信号）を適応フィルタの入力として得るために、適応フィルタの性質を用いることができる。最小二乗平均（ＬＭＳ）法を用いて、遅延信号と遅延部の後の関連付けられる「重み」とが結合されて、この結果、負荷の回転子イナーシャが推定される。
【００３９】
図２に示されるとおり、次式のための目標信号ｄｋと出力信号を得ることが必要である。
【００４０】
【数７】
2004229490.tif 000009
【００４１】
目標信号は、既知の回転子イナーシャを有するモデルモータを参照して得られる。図２に示されるとおり、モデルモータの速度信号１０４は、数学モデル２１によって模擬的に作られる。速度信号１０４は、シンセサイザ３１にフィードバックされる。シンセサイザ３１は、命令信号１００と速度信号１０４とに応じて偏差信号１０１を出力する。偏差信号１０１がゲイン制御器（ゲインコントローラ）４１を通過することによって増幅されてゲイン信号１０２が得られる。一方、ゲイン制御器４２は、ゲイン信号１０２を電流信号１０３に変換する。電流信号１０３は、モデルモータの処理を制御するために数式モデル２１に入力される。既知の回転子イナーシャを有するモデルモータは、既知のパラメータを持ったシステムモデルに相当する。このシステムモデルにおいて実際のシステムと比較するために既知のパラメータを用いることができる。入力信号３０１は、ゲイン制御器４１から出力されたゲイン信号１０２であり、バンドパスフィルタ５１に出力される。
【００４２】
目標信号の供給源は、図３に示される。駆動モータの数学モデル２２から出力された速度信号１１１（第１速度信号）と、負荷モータの数学モデル２３から出力された速度信号１１２（第２速度信号）は、シンセサイザ３６によって結合されて合成速度信号１１４となる。合成速度信号１１４は、それからゲイン制御器４７によって増幅されてゲイン信号１１５となり、このゲイン信号１１５は、シンセサイザ３５および３７へフィードバックされる。
【００４３】
シンセサイザ３５が、ゲイン信号１０９とゲイン信号１１５とを結合させた後に、合成信号１１０は、駆動モータの数学モデル２２において速度を制御するために出力される。同様に、シンセサイザ３７は、ゲイン信号１１５とゲイン信号１１６とを結合して、負荷モータ２３を駆動するために合成信号１１３を出力する。ゲイン信号１１６は、ゲイン信号１０９と同様である。
【００４４】
目標信号は、シンセサイザ３４の合成信号１０８から生じる。合成信号１０８は、ゲイン信号１０７と図２で上述したゲイン信号１０２とを結合することによって得られる。ゲイン制御器４６を通過した後に、合成信号１０８は、ゲイン信号１０９として出力される。一方、ゲイン信号１０７は、ゲイン制御器４５によって出力される。このように、目標信号は、ゲイン信号１０２とゲイン信号１０７とを結合することによってシンセサイザ３４によって出力された合成信号１０８から得られる。なお、ゲイン信号１０７は、偏差信号１０５から生じる。ここで、偏差信号１０５は、モデルモータの数学モデル２１から出力される速度信号１０４と、駆動モータの数学モデル２２から出力される速度信号１１１とに関係付けられており、シンセサイザ３２によって出力される。この偏差信号１０５は、最初に比例制御器（Ｐコントローラ）４３および積分制御器（Ｉコントローラ）４４に分配された後に、それぞれがシンセサイザ３３に入力される。この結果、合成信号１０６が形成される。合成信号１０６は、ゲイン制御器４５によってゲイン信号１０７として出力される。この結果、シンセサイザ３４は、ゲイン信号１０２に対してゲイン信号１０７を結合して、出力のための目標信号３０２を形成することができる。目標信号３０２は、負荷モータの回転子イナーシャを推定するためにバンドパスフィルタ５２に出力される。
【００４５】
本システムが、図２に示されるように入力信号３０１を決定するとともに、図３に示されるように目標信号３０２を決定した後に、負荷回転子イナーシャの推定が実行される。図４は、負荷回転子イナーシャを推定するためのシステムのブロック図を示している。図２に示される適応フィルタの出力信号は、まず１または複数の遅延器からそれぞれの遅延信号を得て、次に、それらの遅延信号に対して対応する重みを乗じることによって算出される。図４の実施例では、推定のために１つの遅延器が用いられている場合が示されるが、好適には複数の遅延器が用いられる。
【００４６】
入力信号３０１がバンドパスフィルタ５１を通過して、フィルタリング済み入力信号３０３が送出される。そして、遅延入力信号３０４は、遅延器５３によって出力される。図では、２つの乗算器５４，５３が存在する。これらは、重み付け済み出力信号３０７を出力する。具体的には、フィルタリング済み入力信号３０３と遅延入力信号３０４は、それぞれ対応する「重み」が乗じられて重み付けされ、重み付け済み入力信号３０５と重み付け済み遅延入力信号３０６になる。入力信号３０５と重み付け済み遅延入力信号３０６は、シンセサイザ３８によって結合されて、上記の重み付け済み出力信号３０７が生成される。重み付け済み入力信号３０５は、Ｘｋ信号に対応する「重み」を乗ずることによって得られる。重み付け済み遅延入力信号（遅延信号）３０６は、（Ｘｋ−１）信号に対応する重みを乗ずることによって得られる。複数の遅延信号がある場合には、複数の遅延信号に対して、それぞれ対応する重みを乗じて、最終的に重み付け済み出力信号を出力する。
【００４７】
一方、目標信号３０２はバンドパスフィルタ５２に入力されることによって、フィルタリング済み目標信号３０８として送出される。シンセサイザ３９は、重み付け済み出力信号３０７をフィルタリング済み目標信号３０８に結合させて、両者の間の偏差である合成信号３０９を出力する。合成信号３０９は、式（６）を利用して次の時点での「重み」ｗ１，ｗ２を算出するために使われるべく、乗算器５４，５５にそれぞれフィードバックされる。入力信号３０１と目標信号３０２は、推定されるべき信号を得るためにバンドパスフィルタに送出される。
【００４８】
したがって、駆動モータが負荷モータを駆動するとき、入力信号であるモデルモータ電流信号３０１が得られるとともに、駆動モータ電流信号とモデルモータ電流信号とを合成して求められた両者の偏差である目標信号３０２が得られる。適応フィルタは、現在の時点での出力から次の時点での電流を決定するために、次の時点での「重み」ｗ１，ｗ２をチューニングして合成信号３０９を調整することによって、合成信号３０９を推定して出力する。次の時点での「重み」は、ゲイン要素、入力信号３０１、および合成信号３０９（重み付け済み出力信号と目標信号との間の偏差）を掛け合わせて２倍した結果と、現在の時点での「重み」との和で与えられる。換言すれば、フィルタリング済み入力信号３０３の重みは、ｗ１（ｋ＋１）＝ｗ１（ｋ）＋２＊ｃ＊ｘ１（ｋ）＊ｅ（ｋ）であり、遅延信号３０４の重みは、ｗ２（ｋ＋１）＝ｗ２（ｋ）＋２＊ｃ＊ｘ２（ｋ）＊ｅ（ｋ）である。
【００４９】
開示された本実施の形態の方法は、たとえば、５０＊２＊ｐｉ／（ｓ＋５０＊２＊ｐｉ）＊ｓ／（ｓ＋２＊２＊ｐｉ）の特性因子を有するバンドパスフィルタを用いている。この収束定数は、０．５よりも小さい。
【００５０】
以下に、シミュレーションおよび実験を行ったいくつかの実施例を提供する。図５は、速度指令入力の時間応答図である。図６は、外部トルク摂動の時間応答図である。この試験状態は、アタッチメント１および２でのものに一致しており、Ｊは、駆動モータの回転子イナーシャであり、Ｊｍは、モデルモータの回転子イナーシャであり、ＪＬは、負荷モータの回転子イナーシャであり、Ｇは交流サーボドライバの速度制御電流ゲインである。
【００５１】
（第１の実施例）
Ｊ＝９ｅ−５，Ｇ＝１，Ｊｍ＝２Ｊ，およびＪＬ＝Ｊである。推定結果は、Ｗ１＋Ｗ２≒０．８であり、図７に示される時間応答図を有する。
【００５２】
第２の実施例
Ｊ＝９ｅ−５，Ｇ＝１，Ｊｍ＝２Ｊ，およびＪＬ＝１０Ｊである。推定結果は、Ｗ１＋Ｗ２≒４．５であり、図８に示される時間応答図を有する。
【００５３】
第３の実施例
Ｊ＝９ｅ−５，Ｇ＝１０，Ｊｍ＝２Ｊ，およびＪＬ＝Ｊである。推定結果は、Ｗ１＋Ｗ２≒０．９であり、図９に示される時間応答図を有する。
【００５４】
第４の実施例
Ｊ＝９ｅ−５，Ｇ＝１０，Ｊｍ＝２Ｊ，およびＪＬ＝１０Ｊである。推定結果は、Ｗ１＋Ｗ２≒５であり、図１０に示される時間応答図を有する。
【００５５】
上記の４つの実施例から、負荷モータイナーシャの推定が実行可能なように、速度指令の周波数と外部の摂動とは、ほとんど同じに設定することができることがわかる。４つの実施例を比較すると、制御部のゲインは、推定結果に大きな影響を持たないことがわかる。
【００５６】
開示された方法は、回転子の負荷応力を直ちに推定するために適応ＬＭＳ法を用いることができる。したがって、この方法は、多くの利用性と実施の価値を持つ。
【００５７】
以上のように、本発明の好適な実施の形態について説明したが、本発明の思想および範囲内において、当業者によって種々の変形が可能であることは明らかである。
【００５８】
【発明の効果】
以上説明した本発明によれば、負荷回転子の回転子イナーシャを即時に推定する推定方法を提供することができる。駆動モータによって駆動される回転子イナーシャは、この駆動モータの出力を調整するために即時に推定され、これによって、即時の推定と正確な制御という目標が達成される。
【図面の簡単な説明】
【図１】適応フィルタシステムのブロック図である。
【図２】本発明で使用されるモデルモータのシステムブロック図である。
【図３】駆動モータおよび負荷モータのシステムブロック図である。
【図４】負荷回転子イナーシャを推定するためのシステムブロック図である。
【図５】速度指令入力の時間応答図である。
【図６】外部トルク摂動の時間応答図である。
【図７】開示された第１の実施の形態での時間応答図である。
【図８】開示された第２の実施の形態での時間応答図である。
【図９】開示された第３の実施の形態での時間応答図である。
【図１０】開示された第４の実施の形態での時間応答図である。
【符号の説明】
５１，５２…バンドパスフィルタ、
５３…遅延部、
５４，５５…乗算器、
３０１…入力信号、
３０２…目標信号、
３０３…フィルタリング済み入力信号、
３０４…遅延入力信号、
３０５…重み付け済み入力信号、
３０６…重み付け済み遅延入力信号、
３０７…重み付け済み出力信号、
３０８…フィルタリング済み目標信号、
３０９…偏差（合成信号）。
【図１】
2004229490.tif 000010
【図２】
2004229490.tif 000011
【図３】
2004229490.tif 000012
【図４】
2004229490.tif 000013
【図５】
2004229490.tif 000014
【図６】
2004229490.tif 000015
【図７】
2004229490.tif 000016
【図８】
2004229490.tif 000017
【図９】
2004229490.tif 000018
【図１０】
2004229490.tif 000019