JPH1056790A - 電動機制御方法及び電動機制御装置 - Google Patents

Abstract

(57)【要約】 【課題】 電動機によって駆動される機械系が共振特性
を有する場合に安定性を確保した上での振動抑制と高速
な外乱抑制を行い、機械系に無理を与えない範囲での動
作の指令値に対する高速応答を得るような制御系の自動
調整が可能な電動機制御装置を得ることを目的とする。 【解決手段】 機械系の総イナーシャと反共振周波数と
制御対象の周波数応答を推定する部分28ａを備え、全体
速度フィードバックゲインを、推定した総イナーシャと
反共振周波数の積よりも少し小さい値と、安定が保たれ
る最大ゲインの推定値との小さい方に自動的に調整す
る。また、目標値応答を良好に制御するフィードフォワ
ード回路12ｂの目標値応答速度を調整するパラメータ
を、反共振周波数と予め設定した定数との積に自動的に
調整する。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】この発明は、例えば、工作機
械におけるテーブルや産業ロボットのアームのような負
荷機械を駆動する、直流電動機、誘導電動機、同期電動
機など電動機の回転位置あるいは回転速度を制御する電
動機制御装置及び電動機の制御方法に関するもので、特
に、負荷機械が機械共振特性を有する場合の電動機制御
方法及び電動機制御装置に関するものである。

【０００２】

【従来の技術】図１５は従来の電動機位置制御装置の一
例（第一の従来例）で、「計測と制御」ｖｏｌ．３２，
Ｎｏ１２ Ｄｅｃ．１９９３、ｐ１０１０〜１０１３に
記載された電動機制御装置のブロック図である。図にお
いて、101は電動機トルクτMによって回転する電動機、
102は電動機によって駆動される負荷機械、103は電動機
101と負荷機械102をつなぐトルク伝達部、104は電動機
回転位置ｘMおよび電動機回転速度ｖMを検出する回転検
出器、105は電動機１と負荷機械102とトルク伝達部103
と回転検出器104を併せた機械系、106は電動機トルクτ
Mをトルク指令信号τrに一致させるトルク制御回路、10
7は機械系105とトルク制御回路106を併せた制御対象、1
08は電動機101および負荷機械102に対する位置指令信号
ｘrを発生する位置指令信号発生回路、109ａは速度補償
回路、110ａは位置補償回路、111ａは速度補償回路109
ａと位置補償回路110ａとを含んだフィードバック補償
回路、112ａは位置指令信号ｘrを入力とし、フィードフ
ォワードトルク信号τfと応答目標位置信号ｘfと応答目
標速度信号ｖfを出力するフィードフォワード回路、113
ａはフィードバック補償回路111ａとフィードフォワー
ド回路112ａを含んだ全体の位置制御回路、114は負荷機
械102に入力する負荷外乱トルクτd、115は機械系105の
総イナーシャを推定するイナーシャ推定回路、116ａは
位置制御回路113ａの制御パラメータを調整するための
制御パラメータ調整信号である

【０００３】次に、図１６は図１５中フィードフォワー
ド回路112ａの詳細を示すブロック図である。図１５と
同一符号は同一部分を表す。117ａは機械系105の動作を
模擬しモデル速度信号ｖaを出力する剛体イナーシャモ
デル回路、118はモデル速度信号ｖaを積分してモデル位
置信号ｘaを出力する積分回路、119ａはモデル速度信号
ｖaを模擬的に制御するモデル速度制御回路、120ａはモ
デル位置信号ｘaを模擬的に制御するモデル位置制御回
路である。

【０００４】次に第一の従来技術の動作について説明す
る。まず、制御対象107と位置制御回路113ａからなる制
御系の動作について説明する。位置指令信号発生回路10
8は位置指令信号ｘrを発生する。フィードフォワード回
路112ａは位置指令信号ｘrを入力し、位置指令信号ｘr
に対する電動機の動作の応答目標信号として応答目標位
置信号ｘfと応答目標速度信号ｖfと、電動機101の動作
が応答目標信号に一致するようにフィードフォワード的
に演算されるトルク信号をフィードフォワードトルク信
号τfとして出力する。フィードフォワード回路112ａで
は位置指令信号ｘrに対して剛体イナーシャモデル回路1
17ａの動作を模擬的に制御しており、剛体イナーシャモ
デル回路117ａはモデルトルクτaを入力し、機械系105
のイナーシャ推定値Ｊeを用いて次の（式１）の演算に
よってモデル速度信号ｖaを出力し、積分回路118はモデ
ル速度信号ｖaを入力して積分したモデル位置信号ｘaを
出力することにより、機械系105の動作を模擬する。

【０００５】

【数１】

【０００６】（式１）においてｓはラプラス演算子を表
し、ｖa(ｓ)、τa(ｓ) はそれぞれｖa、τaのラプラス
変換を表わし、以下の式においても同様に表記する。

【０００７】次に、モデル位置制御回路120ａは位置指
令信号ｘrとモデル位置信号ｘaの差信号を入力し、モデ
ル位置ゲインＫrpを乗じてモデル速度指令信号ｖraを出
力する。モデル速度制御回路119ａはモデル速度指令信
号ｖraとモデル速度信号ｖaの差信号を入力し、モデル
速度ゲインＫrvを乗じてモデルトルク信号τaを出力す
ることにより、モデル位置信号ｘaは位置指令信号ｘrに
対して望ましい応答をするように制御される。フィード
フォワード回路112ａは、位置指令信号ｘrに対する電動
機の応答目標信号として、モデル速度信号ｖａを応答目
標速度信号ｖfとして、モデル位置信号ｘaを応答目標位
置信号ｘfとして出力するとともに、制御対象107の伝達
特性がイナーシャ推定値Ｊeに等しいイナーシャの剛体
機械と同じである場合は、電動機101が応答目標信号と
同じ動作をするためのトルク指令信号として、モデルト
ルク信号τaをフィードフォワードトルク信号τfとして
出力する。

【０００８】次に位置制御回路113ａでは、応答目標位
置信号ｘfと実際の電動機回転位置ｘMとの差信号を補償
位置信号ｘcとして、また応答目標速度信号ｖfと実際の
電動機回転速度ｖMとの差信号を補償速度信号ｖcとして
それぞれフィードバック補償回路111ａに入力する。

【０００９】フィードバック補償回路111ａは、位置補
償回路110ａは補償位置信号ｘcを入力し、位置ゲインＫ
p、位置積分ゲインＫpIを用いて次の（式２）で表され
るＰＩ演算を行うことにより位置補償速度信号ｖcxを出
力し、速度補償回路109ａは位置補償速度信号ｖcxと補
償速度信号ｖcの和信号を入力し、速度ゲインＫvを乗じ
て補償トルク信号τcを出力する。

【００１０】

【数２】

【００１１】次に位置制御回路113ａは、フィードフォ
ワードトルク信号τfと補償トルク信号τcの和信号をト
ルク指令信号τrとしてトルク制御回路106に入力し、ト
ルク制御回路105は電動機トルクτMがトルク指令信号τ
rに一致するように制御することにより電動機の動作を
制御する。

【００１２】ここで、この第一の従来技術の電動機制御
装置では、制御対象107の伝達特性がイナーシャ推定値
Ｊeと等しいイナーシャの剛体機械と一致している場合
には、位置指令信号ｘrに対してはフィードフォワード
トルク信号τfのみが働いて電動機を駆動し、補償トル
ク信号τcは負荷外乱トルクτdや制御対象107と剛体イ
ナーシャモデル回路117ａの誤差に対する補償のみを行
う役割をする。従って、この第一の従来技術は、位置指
令信号ｘrに対する応答についてはフィードフォワード
回路112ａを調整し、外乱やモデルの誤差を補償する応
答についてはフィードバック補償回路111ａを調整する
二自由度制御装置となっている。

【００１３】次に、この従来の電動機制御装置の調整方
法について説明する。まず、フィードフォワード回路11
2ａの調整方法は、位置指令信号ｘrに対する応答目標位
置信号ｘfと電動機回転位置ｘMの応答ができるだけ一致
するように剛体イナーシャモデル回路117ａのパラメー
タであるイナーシャ推定値Ｊeを機械系105の総イナーシ
ャに一致させる。次に、位置指令信号ｘrに対する応答
目標位置信号ｘfの応答が良好になるようにモデル位置
制御回路120ａのモデル位置ゲインＫrpとモデル速度制
御回路119ａのモデル速度ゲインＫrvを調整する。ここ
で、剛体イナーシャモデル回路117ａの入力点で切り開
かれるループをモデル制御ループと呼ぶ。このとき、位
置指令信号ｘrに対する目標値応答の速さを決めるため
の調整パラメータすなわち目標値応答速度調整パラメー
タとしてモデル制御ループの交差周波数ωcr［ｒａｄ／
ｓｅｃ］が決められたとすると、上記Ｋrvと上記Ｋrpを
次の（式３）、（式４）のように調整すれば、位置指令
信号ｘrからモデル位置信号ｘaまでの伝達特性は（式
５）のように実重根を持つ形になり、オーバーシュート
の無い良好な応答をする。

【００１４】

【数３】

【００１５】ここで、位置指令信号ｘrに対する目標値
応答速度調整パラメータであるモデル制御ループの交差
周波数ωcrの決定方法としては、速い応答を得たい場合
はなるべく大きい値に調整されるが、機械系105が機械
共振特性を有する場合には振動を励起せず、機械系105
に無理を与えない範囲でできるだけ速い応答が得られる
ような試行錯誤を要する。

【００１６】次に、フィードバック補償回路111ａの調
整方法について説明する。ここで、制御対象107の入力
点で切り開かれるループをフィードバックループと呼
ぶ。外乱に対する応答の速さを決めるための調整パラメ
ータとしてフィードバックループの交差周波数ωc［ｒ
ａｄ／ｓｅｃ］が決定されたとすると、制御対象107の
伝達特性が剛体機械に近似可能とし、そのイナーシャＪ
が分かっているとすると、速度補償回路109ａの速度ゲ
インＫvおよび位置補償回路の位置ゲインＫp，位置積分
ゲインＫpIを例えば以下の（式６）、（式７）、（式
８）のように調整することにより良好な外乱応答の形が
得られる。

【００１７】

【数４】

【００１８】ここで、フィードバックループの交差周波
数ωcは、機械系105が完全な剛体の場合には、トルク制
御回路106や制御装置の計算機サンプリングによる位相
遅れなどのモデル誤差に対して応答が不安定にならない
範囲で大きく選ばれるものであり、上記の位相遅れの特
性がわかっておれば自動的に設定することも可能であ
る。しかしながら、機械系105が機械共振特性を有する
場合には、高精度な応答を得るためには機械系105の振
動を抑制する必要があり、そのためには別の調整が必要
となる。また機械系105が機械共振特性を有する場合に
は剛体の場合に比べて高周波数領域でゲイン特性が増大
するようなモデル誤差があるため、剛体の場合と同じよ
うに速度ゲインＫvを大きくすると制御系が不安定にな
る。従って、機械系105が機械共振特性を有する場合の
調整は人手で試行錯誤的に行う必要があるが、モデル誤
差に対する安定を保ちながら振動を抑制し外乱に対する
応答を速くするような調整は人手でも難しい。

【００１９】次に、この第一の従来技術の自動調整方法
について説明する。イナーシャ推定回路115はフィード
フォワードトルク信号τfと補償速度信号ｖcを入力し、
補償速度信号ｖcが正ならば実際の機械系105の総イナー
シャＪがイナーシャ推定値Ｊeより大きいと判断してイ
ナーシャ推定値Ｊeを大きくし、逆に補償速度信号ｖcが
負の場合には実際の機械系105の総イナーシャＪがイナ
ーシャ推定値Ｊeより小さいと判断してイナーシャ推定
値Ｊeを小さくすることにより、補償速度信号ｖｃが零
に近づくようにイナーシャ推定値Ｊeを補正し、推定さ
れたイナーシャ推定値Ｊeだけを制御パラメータ調整信
号116ａとして出力し、フィードフォワード回路112ａの
剛体イナーシャモデル回路117ａが内蔵するイナーシャ
推定値Ｊeを調整する。また、速度補償回路109ａの速度
ゲインＫvを計算する（式６）におけるイナーシャＪの
代わりにイナーシャ推定値Ｊeを用いて調整することも
可能である。しかしながら、特に機械系105が機械共振
特性を有する場合には、位置指令信号ｘrに対する応答
の速さを調整するパラメータである上記モデル制御ルー
プの交差周波数ωcrと外乱に対する応答の速さを調整す
るパラメータである上記フィードバックループの交差周
波数ωcは人手によって調整する必要があるため、モデ
ル速度制御回路119ａ、モデル位置制御回路120ａ、速度
補償回路109ａ、位置補償回路110ａは人手によって調整
する必要がある。

【００２０】このように、従来では機械系105のイナー
シャのみを推定して自動調整を行うため、機械系105が
機械共振特性を有する場合には、自動的に安定で高速高
精度な応答を得るような調整を行うことは不可能であ
る。

【００２１】次に、第二の従来技術として、機械系105
が機械共振特性を有する場合に機械振動を抑制する機能
を有した電動機の速度を制御する電動機制御装置につい
て説明する。図１７は、平成６年電気学会産業応用部門
全国大会講演論文集S.311〜S.314に記載された電動機の
速度を制御する電動機制御装置のブロック図である。図
において101〜107、114は第一の従来技術と同じである
ので説明を省略する。121は速度指令信号発生回路であ
る。122は速度制御回路である。123は機械系105が剛体
機械に近似できると仮定して負荷外乱トルクτdを推定
する外乱推定回路である。124は外乱推定回路123の出力
を系数倍してトルク指令信号τrに加算する推定外乱増
幅器である。125は速度制御回路の出力である速度制御
トルク信号τvの位相を等価的に進める効果を有する位
相進め増幅器である。

【００２２】次に動作について説明する。まず、速度指
令信号発生回路108は速度指令信号ｖrを出力する。次
に、速度制御回路122は速度指令信号ｖrと電動機回転速
度ｖMとの差信号を入力し、ＰＩ制御などの適当な演算
により速度制御トルク信号τｖを出力し、速度制御トル
ク信号τｖをトルク指令信号τrに加えることにより電
動機速度ｖMを制御する。

【００２３】次に、まず外乱推定回路123の動作を位相
進め増幅器125のゲインｋ2は零であると仮定してその効
果を無視して説明する。外乱推定回路123は電動機回転
速度ｖMと電動機トルクτMを入力し、機械系105全体の
イナーシャ推定値Ｊeと外乱推定回路123の推定帯域ωo
をパラメータとした（式９）の演算により、機械系105
が剛体に近似可能と仮定た場合の負荷外乱トルクτdを
推定し、推定外乱信号τdeとして出力する。

【００２４】

【数５】

【００２５】次に、推定外乱増幅器124は推定外乱信号
τdeを入力し、０乃至１の定数ｋ1を乗じた信号を出力
してトルク指令信号τrに加えることにより、外乱に対
する電動機速度ｖMの変動を抑制する効果を有する。こ
こで、外乱推定回路123の推定帯域ωoは、機械系105が
剛体に近似可能な周波数として、最も低い反共振周波数
より小さい値が選ばれることにより、機械系105が有す
る機械共振特性に対して振動を抑制する効果を有する。

【００２６】次に、上記の推定外乱信号τdeをｋ1倍し
た信号と速度制御トルク信号τvの和信号をトルク指令
信号τrとして制御対象107に入力することにより、振動
を抑制しながら電動機回転速度ｖMを制御するのが、こ
の第二の従来技術の目的であるが、外乱推定回路123を
用いて機械系105の機械共振特性に減衰を与えた結果、
速度制御トルク信号τvから電動機回転速度ｖMまでの伝
達特性が、外乱推定回路123を用いない場合に比べて、
共振周波数より低周波数での位相遅れが大きくなる。そ
の結果、速度制御回路122と外乱推定回路123をそのまま
同時に用いると問題を生じるため、位相進め増幅器125
のゲインｋ2を０より大きくすることにより、等価的に
速度制御トルク信号τvの位相を進め、位相進め増幅器1
25のゲインｋ2を調整して上記の位相遅れを補償する必
要がある。

【００２７】このように、第二の従来技術では制御パラ
メータとして、振動を抑制する目的から外乱推定回路12
3におけるイナーシャ推定値Ｊeと推定帯域ωoと推定外
乱増幅器124のゲインｋ1を調整し、電動機回転速度ｖM
の応答を調整するために速度制御回路122の制御パラメ
ータを調整し、外乱推定回路123と速度制御回路122の両
方を用いるために位相進め増幅器125のゲインｋ2を調整
する必要があるが、上記の制御パラメータのうち、イナ
ーシャ推定値Ｊeと、推定帯域ωo以外はパラメータの調
整方法は明確ではない。また、電動機回転速度ｖMが、
振動を抑制する目的で外乱推定回路123を通ってフィー
ドバックされるのと同時に、電動機速度ｖMを制御する
目的で速度制御回路122を通ってフィードバックされて
いるが、これらの効果はそれぞれ独立ではあり得ない。
したがって、振動の抑制と、外乱に対する応答の高速性
と、モデル誤差に対する安定性を同時に考慮した最適な
制御パラメータの調整を行うには、複数のパラメータを
試行錯誤的に調整する必要があるため、全部の制御パラ
メータを自動的に調整するのは難しい。

【００２８】

【発明が解決しようとする課題】上記のように、第一の
従来技術では、制御対象が剛体機械としたときのイナー
シャのみを推定するものであり、機械系が機械共振特性
を有することが十分考慮されていないため、機械系が機
械共振特性を有する場合には、モデル誤差に対する安定
を保ちながら振動を抑制し、外乱に対する応答を速くす
るような調整は人手によって試行錯誤的に行う必要があ
り難しいといった問題があった。また、位置指令信号に
対する応答の速さも、機械系の振動を励起しなく、機械
系に無理を与えないように人手によって試行錯誤的に調
整する必要があるという問題があった。

【００２９】また、第二の従来技術は、振動抑制を目的
とした特定の構造を持つ制御装置の例だが、振動抑制を
目的とした外乱推定回路と速度制御を目的とした速度制
御回路とが別個にある構造をしており、これらは独立で
ないため、振動の抑制と外乱や指令信号に対する応答の
高速性とモデル誤差に対する安定性を同時に考慮した最
適な調整方法は明確でない。また調整パラメータも多い
ため、制御パラメータの全部を自動的に調整するのは難
しいという問題があった。

【００３０】この発明は、上記の問題点を解決するため
になされたもので、電動機によって駆動される機械系が
機械共振特性を有する場合にも、制御装置の構造には依
存せず、剛体を制御するときと同様な簡単な構造の制御
装置であっても、振動の抑制と、外乱に対する応答の高
速性と、モデル誤差に対する安定性と、振動を励起しな
く機械系に無理を与えない範囲で動作の指令信号に対す
る応答の高速性を同時に考慮した、最適な制御パラメー
タの調整を自動的に行うような電動機制御方法及び電動
機制御装置を得ることを目的とする。

【００３１】

【課題を解決するための手段】この発明の請求項１に係
る電動機制御方法は、電動機の回転速度あるいは回転位
置を検出し、上記電動機の回転速度あるいは上記電動機
の回転位置の微分信号を比例倍した信号を元に生成され
たトルク指令信号により、上記電動機の回転トルクを制
御して、電動機の回転速度あるいは回転位置を制御する
電動機制御方法において、上記電動機の回転速度あるい
は上記電動機の回転位置の微分信号を比例倍した信号を
元にトルク指令信号を生成する速度比例フィードバック
回路の全体のゲインをＫvとし、上記電動機の回転トル
クで駆動する機械系の総イナーシャＪの推定値である推
定イナーシャをＪe、上記機械系の最も小さい反共振周
波数ωzの推定値である推定反共振周波数をωze、二慣
性系最適ゲインをＫoptとした時、 Ｋopt＝ｎ×Ｊe×ωze 但し、０．５≦ｎ≦１（ｎは定数）により記載される二
慣性系最適ゲインＫoptを用いて上記速度比例フィード
バック回路の全体のゲインＫvを調整するものである。

【００３２】この発明の請求項２に係る電動機制御方法
は、請求項１において、二慣性系最適ゲインＫoptを記
述する定数ｎが、 ０．７≦ｎ＜１ であることを規定するものである。

【００３３】この発明の請求項３に係る電動機制御方法
は、電動機の回転速度あるいは回転位置を検出し、上記
電動機の回転速度あるいは上記電動機の回転位置の微分
信号を比例倍した信号を元に生成されたトルク指令信号
により、上記電動機の回転トルクを制御して、電動機の
回転速度あるいは回転位置を制御する電動機制御方法に
おいて、上記電動機の回転速度あるいは上記電動機の回
転位置の微分信号を比例倍した信号を元にトルク指令信
号を生成する速度比例フィードバック回路の全体のゲイ
ンをＫvとし、上記トルク指令信号から上記電動機の回
転速度あるいは上記電動機の回転位置の微分信号までの
制御対象の周波数応答を推定し、０以上の定数である設
定位相余裕θmと１以上の定数である設定ゲイン余裕Ｇm
を用いて、上記推定された制御対象の周波数応答の位相
が（−１８０＋θm）［ｄｅｇ］となる最も低い周波数
より高周波数領域における上記制御対象の周波数応答の
最大ゲインをＧmaxを求め、次に上記最大ゲインＧmaxと
上記設定ゲイン余裕Ｇmの積の逆数から限界ゲインＫmax
を求め、上記速度比例フィードバック回路の全体のゲイ
ンＫvを上記限界ゲインＫmaxを用いて調整するものであ
る。

【００３４】この発明の請求項４に係る電動機制御方法
は、電動機の回転速度あるいは回転位置を検出し、上記
電動機の回転速度あるいは上記電動機の回転位置の微分
信号を比例倍した信号を元に生成されたトルク指令信号
により、上記電動機の回転トルクを制御して、電動機の
回転速度あるいは回転位置を制御する電動機制御方法に
おいて、上記電動機の回転速度あるいは上記電動機の回
転位置の微分信号を比例倍した信号を元にトルク指令信
号を生成する速度比例フィードバック回路の全体のゲイ
ンをＫvとする時、上記電動機の回転トルクで駆動する
機械系の総イナーシャＪの推定値である推定イナーシャ
をＪe、上記機械系の最も小さい反共振周波数ωzの推定
値である推定反共振周波数をωze、二慣性系最適ゲイン
をＫoptとし、 Ｋopt＝ｎ×Ｊe×ωze 但し、０．５≦ｎ≦１（ｎは定数）により記述される二
慣性系最適ゲインＫoptを求め、上記トルク指令信号か
ら上記電動機の回転速度あるいは上記電動機の回転位置
の微分信号までの制御対象の周波数応答を推定し、０以
上の定数である設定位相余裕θmと１以上の定数である
設定ゲイン余裕Ｇmを用いて、上記推定された制御対象
の周波数応答の位相が（−１８０＋θm）［ｄｅｇ］と
なる最も低い周波数より高周波数領域における上記制御
対象の周波数応答の最大ゲインをＧmaxを求め、上記最
大ゲインＧmaxと上記設定ゲイン余裕Ｇmとの積の逆数か
ら限界ゲインＫmaxを求め、上記求められたＫoptとＫma
xとを比較して、小さい方を用いて上記速度比例フィー
ドバック回路の全体のゲインＫvを調整するものであ
る。

【００３５】この発明の請求項５に係る電動機制御方法
は、電動機の回転速度あるいは回転位置を制御するため
の指令信号を元に生成されたトルク指令信号により、上
記電動機の回転トルクを制御して、電動機の回転速度あ
るいは回転位置を制御する電動機制御方法において、上
記電動機の回転速度あるいは回転位置が上記指令信号に
追従して応答する速さを調整するための調整パラメータ
である目標値応答速度調整パラメータを、少なくとも電
動機の回転トルクで駆動する機械系の最も小さい反共振
周波数ωzの推定値である推定反共振周波数ωzeを用い
て決定するものである。

【００３６】この発明の請求項６に係る電動機制御装置
は、少なくとも電動機の回転トルクをトルク指令信号に
追従させるトルク制御回路と、電動機の回転速度あるい
は回転位置を検出する電動機回転検出器と、上記電動機
の回転速度あるいは上記電動機の回転位置の微分信号を
比例倍した信号を上記トルク指令信号にフィードバック
して加える単数あるいは複数の速度比例フィードバック
回路を有して電動機の回転速度あるいは回転位置を制御
する電動機制御装置において、上記速度比例フィードバ
ック回路のゲインを調整する手段と、電動機の回転トル
クで駆動する機械系の総イナーシャＪの推定値である推
定イナーシャＪeと上記機械系の最も小さい反共振周波
数ωzの推定値である推定反共振周波数ωzeを出力する
機械パラメータ推定手段とを備え、上記機械パラメータ
推定部から出力された上記推定イナーシャをＪe、上記
推定反共振周波数をωzeとする時、 Ｋopt＝ｎ×Ｊe×ωze 但し、０．５≦ｎ≦１（ｎは定数）により、二慣性系最
適ゲインＫoptは記述され、上記速度比例フィードバッ
ク回路のゲインを調整する手段は、上記の単数あるいは
複数の速度比例フィードバック回路の全体のゲインＫv
を上記二慣性系最適ゲインＫoptに調整するものであ
る。

【００３７】この発明の請求項７に係る電動機制御装置
は、少なくとも電動機の回転トルクをトルク指令信号に
追従させるトルク制御回路と、電動機の回転速度あるい
は回転位置を検出する電動機回転検出器と、上記電動機
の回転速度あるいは上記電動機の回転位置の微分信号を
比例倍した信号を上記トルク指令信号にフィードバック
して加える単数あるいは複数の速度比例フィードバック
回路を有して電動機の回転速度あるいは回転位置を制御
する電動機制御装置において、上記速度比例フィードバ
ック回路のゲインを調整する手段と、上記トルク指令信
号から上記電動機の回転速度あるいは上記電動機の回転
位置の微分信号までの制御対象の周波数応答を推定する
周波数応答推定手段とを備え、０以上の定数である設定
位相余裕θmと１以上の定数である設定ゲイン余裕Ｇmを
用いて、上記周波数応答推定手段が出力した制御対象の
周波数応答の位相が（−１８０＋θm）［ｄｅｇ］とな
る最も低い周波数より高周波数領域における上記制御対
象の周波数応答の最大ゲインをＧmaxとし、上記最大ゲ
インＧmaxと上記設定ゲイン余裕Ｇmの積の逆数を限界ゲ
インＫmaxとすると、上記速度比例フィードバック回路
のゲインを調整する手段は上記の単数あるいは複数の速
度比例フィードバック回路の全体のゲインＫvを上記限
界ゲインＫmaxに調整するものである。

【００３８】この発明の請求項８に係る電動機制御装置
は、少なくとも電動機の回転トルクをトルク指令信号に
追従させるトルク制御回路と、電動機の回転速度あるい
は回転位置を検出する電動機回転検出器と、上記電動機
の回転速度あるいは上記電動機の回転位置の微分信号を
比例倍した信号を上記トルク指令信号にフィードバック
して加える単数あるいは複数の速度比例フィードバック
回路を有して電動機の回転速度あるいは回転位置を制御
する電動機制御装置において、上記速度比例フィードバ
ック回路のゲインを調整する手段と、電動機の回転トル
クで駆動する機械系の総イナーシャＪの推定値である推
定イナーシャＪeと上記機械系の最も小さい反共振周波
数ωzの推定値である推定反共振周波数ωzeを出力する
機械パラメータ推定手段と、上記トルク指令信号から上
記電動機の回転速度あるいは上記電動機の回転位置の微
分信号までの制御対象の周波数応答を推定する周波数応
答推定手段とを備え、上記機械パラメータ推定部から出
力された上記推定イナーシャをＪe、上記推定反共振周
波数をωzeとする時、 Ｋopt＝ｎ×Ｊe×ωze 但し、０．５≦ｎ≦１（ｎは定数）により、二慣性系最
適ゲインＫoptは記述され、０以上の定数である設定位
相余裕θmと１以上の定数である設定ゲイン余裕Ｇmを用
いて、上記周波数応答推定手段が出力した制御対象の周
波数応答の位相が（−１８０＋θm）［ｄｅｇ］となる
最も低い周波数より高周波数領域における上記制御対象
の周波数応答の最大ゲインをＧmaxとし、上記最大ゲイ
ンＧmaxと上記設定ゲイン余裕Ｇmの積の逆数を限界ゲイ
ンＫmaxとすると、上記速度比例フィードバック回路の
ゲインを調整する手段は、上記二慣性系最適ゲインＫop
tと上記限界ゲインＫmaxとを比較する手段を備え、上記
の単数あるいは複数の速度比例フィードバック回路の全
体のゲインＫvを上記二慣性系最適ゲインＫoptと上記限
界ゲインＫmaxとの小さい方に調整するものである。

【００３９】この発明の請求項９に係る電動機制御装置
は、少なくとも電動機の回転トルクをトルク指令信号に
追従させるトルク制御回路と、少なくとも電動機の回転
速度あるいは回転位置に対する指令信号を入力して電動
機の動作が上記指令信号に追従して応答するようにフィ
ードフォワードトルク信号を演算して出力し上記トルク
指令信号に加算するフィードフォワード回路を備えた電
動機制御装置において、電動機の回転速度あるいは回転
位置が上記指令信号に追従して応答する速さを調整する
ための上記フィードフォワード回路の調整パラメータで
ある目標値応答速度調整パラメータを調整する手段と、
電動機の回転トルクで駆動する機械系の最も小さい反共
振周波数ωzの推定値である推定反共振周波数ωzeを出
力する機械パラメータ推定手段を備え、上記目標値応答
速度調整パラメータを調整する手段は、上記目標値応答
速度調整パラメータを上記推定反共振周波数ωzeに予め
設定した定数を乗じた値に調整するものである。

【００４０】

【発明の実施の形態】

実施の形態１．この発明の一実施の形態を図を用いて説
明する。図１は本発明の実施の形態１による電動機制御
装置の構成を示したブロック図である。図において、１
は電動機トルクτMによって回転する電動機、２は電動
機によって駆動される負荷機械、３は電動機１と負荷機
械２をつなぐトルク伝達部、４は電動機回転位置ｘMお
よび電動機回転速度ｖMを検出する回転検出器、５は電
動機１と負荷機械２とトルク伝達部３と回転検出器４を
併せた機械系、６は電動機トルクτMをトルク指令信号
τrに一致させるトルク制御回路、７は機械系５とトル
ク制御回路６を併せた制御対象、８は電動機１および負
荷機械２に対する位置指令信号ｘrを発生する位置指令
信号発生回路、９ｂは速度補償回路、10ｂは位置補償回
路、11ｂは速度補償回路９ｂと位置補償回路10ｂとを含
んだフィードバック補償回路、12ｂは位置指令信号ｘr
を入力とし、フィードフォワードトルク信号τfと応答
目標位置信号ｘfと応答目標速度信号ｖfを出力するフィ
ードフォワード回路、13ｂはフィードバック補償回路11
ｂとフィードフォワード回路12ｂを含んだ全体の位置制
御回路、14は負荷機械２に入力する負荷外乱トルクτd
である。ここで、９ｂ、10ｂ、11ｂ、12ｂ、13ｂはそれ
ぞれ第一の従来技術の図１５の109ａ、110ａ、111ａ、1
12ａ、113ａと制御系の構成は同じであるが、その調整
方法は異なる。16ｂは制御パラメータ調整信号である。
26はスイッチ、27は駆動試験用トルク指令信号発生回
路、28ａは自動調整回路である。

【００４１】次に、図２はフィードフォワード信号演算
回路12ｂの詳細を示すブロック図である。フィードフォ
ワード回路12ｂは第一の従来技術のフィードフォワード
回路112ａと制御系の構成は同じであるが、調整方法は
異なる。図１と同一符号は同一部分を表す。17ｂは機械
系５の動作を模擬しモデル速度信号ｖaを出力する剛体
イナーシャモデル回路、18は積分回路、19ｂはモデル速
度信号ｖaを模擬的に制御するモデル速度制御回路、20
ｂはモデル位置ｘaを模擬的に制御するモデル位置制御
回路である。ここで、17ｂ、18、19ｂ、20ｂはそれぞれ
第一の従来技術の図１６の117ａ、118、119ａ、120ａと
制御系の構成は同じであるが、その調整方法は異なる。

【００４２】次に、図３は自動調整回路28ａの詳細を表
す図である。図１と同一符号は同一部分を表す。29は高
次モデル同定部、30ａは機械系５の総イナーシャＪと反
共振周波数ωzを推定する機械パラメータ推定部、31は
二慣性系最適ゲイン計算部、32は周波数応答推定部、33
は限界ゲイン推定部、34ａは制御パラメータ決定部であ
る。

【００４３】上記のように、本発明においては、装置構
成上、自動調整回路を用いて、各パラメータを演算する
という点が特徴である。

【００４４】次に動作を説明する。まず、電動機１の位
置を制御するときはスイッチ26をａ）に切り替えて位置
指令信号発生回路８および位置制御回路13ｂを用いて制
御対象７を制御する。位置指令信号発生回路８は位置指
令信号ｘrを発生する。フィードフォワード回路12ｂは
位置指令信号ｘｒを入力し、位置指令信号ｘrに対する
電動機の動作の応答目標信号として応答目標位置信号ｘ
fと応答目標速度信号ｖfと、電動機１の動作が応答目標
信号に一致するようにフィードフォワード的に演算され
るトルク信号をフィードフォワードトルク信号τfとし
て出力する。フィードフォワード回路12ｂでは位置指令
信号ｘrに対して剛体イナーシャモデル回路17ｂの動作
を模擬的に制御しており、剛体イナーシャモデル回路17
ｂはモデルトルクτaを入力し、機械系５のイナーシャ
推定値Ｊeを用いて次の（式１０）の演算によってモデ
ル速度信号ｖaを出力し、積分回路18はモデル速度信号
ｖaを入力して積分したモデル位置信号ｘaを出力するこ
とにより、機械系５の動作を模擬する。

【００４５】

【数６】

【００４６】次に、モデル位置制御回路20ｂは位置指令
信号ｘrとモデル位置信号ｘaの差信号を入力し、モデル
位置ゲインＫrpを乗じてモデル速度指令信号ｖraを出力
する。モデル速度制御回路19ｂはモデル速度指令信号ｖ
raとモデル速度信号ｖaの差信号を入力し、モデル速度
ゲインＫrvを乗じてモデルトルク信号τaを出力するこ
とにより、モデル位置信号ｘaは位置指令信号ｘrに対し
て望ましい応答をするように制御される。フィードフォ
ワード回路12ｂは、位置指令信号ｘrに対する電動機の
応答目標信号として、モデル速度信号ｖａを応答目標速
度信号ｖfとして、モデル位置信号ｘaを応答目標位置信
号ｘfとして出力するとともに、制御対象７の伝達特性
がイナーシャ推定値Ｊeに等しいイナーシャの剛体機械
と同じである場合は、電動機１が応答目標信号と同じ動
作をするためのトルク指令信号として、モデルトルク信
号τaをフィードフォワードトルク信号τfとして出力す
る。

【００４７】次に位置制御回路13ｂでは、応答目標位置
信号ｘfと実際の電動機回転位置ｘMとの差信号を補償位
置信号ｘcとして、また応答目標速度信号ｖfと実際の電
動機回転速度ｖMとの差信号を補償速度信号ｖcとしてそ
れぞれフィードバック補償回路111ａに入力する。

【００４８】フィードバック補償回路111ａは、位置補
償回路110ａは補償位置信号ｘcを入力し、位置ゲインＫ
p、位置積分ゲインＫpIを用いて次の（式１１）で表さ
れるＰＩ演算を行うことにより位置補償速度信号ｖcxを
出力し、速度補償回路109ａは位置補償速度信号ｖcxと
補償速度信号ｖcの和信号を入力し、速度ゲインＫvを乗
じて補償トルク信号τcを出力する。

【００４９】

【数７】

【００５０】次に位置制御回路13ｂは、フィードフォワ
ードトルク信号τfと補償トルク信号τcの和信号をトル
ク指令信号τrとしてトルク制御回路６に入力し、トル
ク制御回路５は電動機トルクτMがトルク指令信号τrに
一致するように制御することにより電動機の動作を制御
する。

【００５１】次に、機械系５が機械共振特性を有する場
合の位置制御回路13ｂの調整方法について説明する。機
械系５が機械共振特性を有するとき、電動機トルクτM
から電動機回転速度ｖMまでの伝達関数は、低周波側か
ら反共振特性と共振特性が交互に表れる特性を有する。
通常は最も低周波にある共振特性の振動が最も問題にな
るため、機械系５が、共振特性が一つだけある二慣性系
である場合を代表として説明する。すなわち機械系５と
して、イナーシャＪMの電動機１とイナーシャＪLの負荷
機械２が、イナーシャが理想的に零で減衰の無いバネで
あるトルク伝達部３でつながれているとして説明する。
このとき、機械系５の電動機トルクτMから電動機回転
速度ｖMまでの伝達関数をＧM（ｓ）、電動機トルクτM
から負荷機械２の回転速度までの伝達関数をＧL（ｓ）
と表記すると、ＧM（ｓ）およびＧL（ｓ）はそれぞれ次
の（式１２）、（式１３）で表される。

【００５２】

【数８】

【００５３】ここで、ωzは反共振周波数、ωpは共振周
波数である。Ｊは機械系の総イナーシャであり、二慣性
系の場合は電動機１のイナーシャＪMと負荷機械２のイ
ナーシャＪLの和である。

【００５４】次に、機械系５が上記の二慣性系とし、さ
らにトルク制御回路６の伝達特性は理想的に１であると
して説明する。まず、第一の従来技術と同様に総イナー
シャＪを用いて次の（式１４）でフィードバックループ
の交差周波数ωcを定義しておく。

【００５５】

【数９】

【００５６】図４は、機械系５が上記のように二慣性系
である場合に、フィードバック補償回路11ｂに本発明の
調整方法を施した場合のフィードバックループの一巡伝
達関数のゲイン線図を折れ線近似で表す。二慣性系の振
動を抑制することを目的とすると、電動機回転速度ｖM
を比例フィードバックすることにより振動成分がフィー
ドバックされ振動を減衰させる効果がある。しかしなが
ら、速度比例ゲインを無限大に大きくすると電動機の動
きを固定することになり、負荷機械だけが振動するよう
な現象を起こす。したがって振動を減衰させるには速度
比例ゲインが小さすぎず、また大きすぎない範囲にある
必要がある。その範囲は、フィードバックループの一巡
伝達関数のゲイン特性において、共振周波数付近のピー
ク特性が０［ｄＢ］より大きく、反共振周波数付近のノ
ッチ特性が０［ｄＢ］より小さくなるような範囲であ
る。

【００５７】図５は簡単のために位置ゲインＫpと位置
積分ゲインＫpIを０にし、速度ゲインＫvを変化させた
ときの振動の減衰率を示している。図５では、横軸とし
てフィードバックループの交差周波数ωcの反共振周波
数ωzに対する比（ωc／ωz）をとり、負荷機械２のイ
ナーシャＪLの電動機１のイナーシャＪMに対する慣性比
ｒ（＝ＪL／ＪM）を変えて示している。図５においてω
c／ωzが１のときは反共振のノッチの根元が０［ｄＢ］
となるときであり、図中で○を付した点は共振ピークの
根元が０［ｄＢ］となる点である。図５より、振動の減
衰が最大となるのはωcがωzの１倍より小さい範囲であ
ることが分かる。また、慣性比ｒが大きい場合には反共
振周波数ωzと共振周波数ωpの距離が大きくなるため振
動の減衰が大きく得られる範囲も広くなるが、ωcをωz
の０．５倍より小さくしても振動の減衰がより大きくな
ることはないことがわかる。また、外乱に対する応答を
考えるとωcはなるべく大きい方が良い。従って、振動
抑制と外乱に対する応答の両方を考慮すると、速度補償
回路９の速度ゲインＫvは０．５以上１以下の定数ｎω
を用いて次の（式１５）の二慣性系最適ゲインＫoptに
調整することにより、振動抑制と外乱に対する応答の高
速性を同時に考慮した調整がなされる。

【００５８】

【数１０】

【００５９】さらにｎωの値に関しては、慣性比ｒが２
より小さい場合においても、できるだけ大きな減衰が得
られるような汎用性、また外乱に対する応答をなるべく
速くすることを考慮すると、図５より０．７以上、１未
満の値が望ましい。このため、本実施の形態ではｎωを
０．８とし、このＫoptを二慣性系最適ゲインと呼ぶこ
ととする。

【００６０】また、位置補償回路の制御パラメータであ
る位置ゲインＫpと位置積分ゲインＫpIの調整方法は第
一の従来技術と同様にし、次の（式１６）、（式１７）
を用いるとする。

【００６１】

【数１１】

【００６２】次に、上記の説明ではトルク制御回路６の
伝達特性が理想的に１であるとしたが、実際には位相遅
れなどのモデル誤差が存在するため上記の二慣性系最適
ゲインを選ぶと不安定になる場合もある。したがって、
安定な制御を行うためには位相遅れの影響で不安定にな
らないための限界を確認する必要がある。ナイキストの
安定定理よりフィードバックループの一巡伝達関数の周
波数応答において、位相が−１８０［ｄｅｇ］以下とな
る周波数領域でゲインが０［ｄＢ］以下ならば安定は保
証される。したがって制御対象７のトルク指令信号τr
から電動機回転速度ｖMまでの伝達関数をＧ（ｓ）と表
記し、Ｇ（ｓ）の周波数応答が分かったとすると、予め
設定した０以上の設定位相余裕θmと１以上の設定ゲイ
ン余裕Ｇmを用いて、上記Ｇ（ｓ）の位相が−１８０＋
θm［ｄｅｇ］となる最も低い周波数を安定限界周波数
ωstと呼ぶとし、安定限界周波数ωstより高周波領域に
おけるＧ（ｓ）の最大ゲインＧmaxを用いて、速度比例
ゲインが次の（式１８）で表される限界ゲインＫmaxよ
り小さければ制御系の安定は保証される。

【００６３】

【数１２】

【００６４】したがって上記二慣性系最適ゲインＫopt
と限界ゲインＫmaxとを比較し、小さい方を速度ゲイン
Ｋvに選択することにより、モデル誤差に対する安定が
保たれる範囲でなるべく振動抑制効果と外乱に対する応
答の高速性が得られるような制御の調整が可能になる。

【００６５】次に、フィードフォワード回路12ｂの調整
方法について説明する。フィードフォワード回路12ｂの
制御系の構成は第一の従来技術と全く同じもので、フィ
ードフォワード回路12ｂは剛体イナーシャモデル回路17
ｂを有し、制御対象７の伝達特性が剛体機械と一致する
場合に電動機回転位置ｘMを位置指令信号ｘrに対して任
意に調整した速さで良好な形に応答させることが可能な
ものだが、機械系５が二慣性系の場合でも、フィードフ
ォワード回路12ｂでイナーシャ推定値Ｊeに機械系５の
総イナーシャＪを用いると、負荷機械２の動作を位置指
令信号ｘrに追従させることを目的とすると、フィード
フォワード回路12ｂをそのまま用いて、反共振周波数ω
zより高い周波数帯域まで負荷機械２を比較的良好に追
従させることが可能である。また、どのような制御装置
を用いても、負荷機械２の動作を反共振周波数ωzより
高い周波数帯域まで追従させようとすると、電動機１と
負荷機械２との動作の差すなわちトルク伝達部３のねじ
れを大きく励起してしまい、機械系５に無理を与えてし
まう問題を生じる。したがって、フィードフォワード回
路12ｂによって調整する位置指令信号ｘrに対する目標
値応答の速さは反共振周波数ωzを基準に設定するのが
良い。したがって本実施の形態では位置指令信号ｘrに
対する応答の速さを決めるための目標値応答速度調整パ
ラメータであるモデル制御ループの交差周波数ωcrを予
め設定した定数ｎrを用いて次の（式１９）にしたがっ
て反共振周波数の定数倍に調整し、フィードフォワード
回路１２ｂの他の調整パラメータであるモデル速度ゲイ
ンＫrvとモデル位置ゲインＫrpは第一の従来技術のフィ
ードフォワード回路１２ａと同様に次の（式２０）、
（式２１）で調整する。

【００６６】

【数１３】

【００６７】ただし（式１９）において本実施の形態で
はｎr＝１としている。

【００６８】上記のようなフィードフォワード回路12ｂ
の調整により、トルク伝達部３のねじれを大きく励起し
ない、すなわち機械系５に無理を与えない範囲で位置指
令信号ｘrに対する電動機回転位置ｘMおよび負荷機械２
の回転位置の応答を速く制御することが可能になる。

【００６９】次に本実施の形態の自動調整回路28ａの動
作について上記で説明した図１、図２、図６、図７を用
いて説明する。図６、図７は機械共振特性をもつ二慣性
系に近似できる機械を使い、この実施の形態１の自動調
整を実際に実験を行ったときの動作と効果を説明する図
である。

【００７０】まず、自動調整を行うときは、スイッチ26
をｂ）に切り替え、駆動試験用トルク指令信号発生回路
27が例えば疑似ランダム信号などのトルク指令信号τr
を制御対象７に出力して駆動試験を行い、そのときのト
ルク指令信号τrと電動機回転速度ｖMを自動調整回路28
aに入力する。

【００７１】次に、自動調整回路28aでは、高次モデル
同定部29にトルク指令信号τrと電動機回転速度ｖMを入
力し、内蔵している高次の伝達関数モデルのパラメータ
を例えば最小二乗法を用いて計算することにより制御対
象７のトルク指令信号τrから電動機速度ｖMまでの伝達
関数Ｇ（ｓ）の詳細な同定を行い、高次モデル同定部29
は同定結果の高次モデルを出力する。

【００７２】次に、機械パラメータ推定部30ａでは高次
モデル同定部29が出力した高次モデルを入力し、最も小
さい複素零点の絶対値を推定反共振周波数ωzeとして選
び、高次モデルの低周波領域のゲイン特性から総イナー
シャＪを推定して推定イナーシャＪeとし、上記の推定
反共振周波数ωzeと推定イナーシャＪeを出力する。

【００７３】次に、二慣性系最適ゲイン計算部31は上記
の推定反共振周波数ωzeと推定イナーシャＪeを入力
し、上記（式１５）において反共振周波数ωz、総イナ
ーシャＪの変わりに上記のそれぞれの推定値ωze、Ｊe
を用いて二慣性系最適ゲインＫoptを計算し出力する。

【００７４】次に、周波数応答推定部32では上記同定結
果の高次モデルを入力し、その周波数応答を計算し出力
する。次に、限界ゲイン推定部33では周波数応答推定部
32が出力した周波数応答を入力し、予め設定した０以上
の設定位相余裕θmと１以上の設定ゲイン余裕Ｇmを用い
て上記の方法に基づき上記の最大ゲインＧmaxを求め、
上記（式１８）を用いて限界ゲインＫmaxを計算して出
力する。図６は上記の実験において周波数応答推定部32
が出力した同定結果の高次モデルの周波数応答と、機械
パラメータ推定部30ａで推定された推定イナーシャＪe
の剛体の特性を表すゲイン特性、推定反共振周波数ωze
および上記の安定限界周波数ωstおよび最大ゲインＧma
xを示す。

【００７５】次に、制御パラメータ決定部34ａでは、上
記二慣性系最適ゲインＫoptと上記限界ゲインＫmaxと上
記の推定イナーシャＪeおよび上記の推定反共振周波数
ωｚｅを入力し、ＫｏｐｔとＫmaxのうち小さい方を速
度補償回路９ｂの速度ゲインＫvとして決定し、上記フ
ィードバックループの交差周波数ωcを上記（式１４）
で総イナーシャＪの代わりに推定イナーシャＪeを用い
て求め、フィードバック補償回路１１ｂの制御パラメー
タ、すなわち位置補償回路１０ｂの位置ゲインＫpおよ
び位置積分ゲインＫpIは（式１６）および（式１７）を
用いて決定する。また、フィードフォワード回路12ｂの
調整パラメータは、剛体イナーシャモデル回路17ｂのパ
ラメータに推定イナーシャＪeを用い、モデル速度制御
回路19ｂのモデル速度ゲインＫrvは反共振周波数ωzの
変わりにその推定反共振周波数ωzeを用い、（式１
９）、（式２０）を用いて決定し、モデル位置制御回路
20ｂのモデル位置ゲインＫrpは（式２１）を用いて決定
する。次に、適当な調整手段を用いフィードフォワード
回路12ｂの制御パラメータを上記の自動調整回路28ａで
決定した調整パラメータに調整する。

【００７６】上記のような自動調整回路28ａの動作によ
り、モデル誤差に対して安定を保つ範囲で振動抑制と外
乱に対する応答の高速性を得るような調整と、機械系５
に無理を与えないような範囲で位置指令信号ｘrに対す
る電動機回転位置ｘMおよび負荷機械２の回転位置の応
答を高速化する制御の調整を自動的に行うことが可能に
なる。

【００７７】図７は、上述の実験においてこの実施の形
態１により自動調整された結果を用いた場合の位置指令
信号ｘrに対する電動機回転位置ｘMの応答と、第一の従
来技術を用い、機械系５の総イナーシャＪを正確に推定
した後、フィードバックループの交差周波数ωc、モデ
ル制御ループの交差周波数ωcrを適当に調整した場合の
応答を示す。図７に示した例では自動的に上記の二慣性
系最適ゲインが選択されており、第一の従来技術と比較
して振動が抑制され、応答が遅くなり過ぎず、良好な応
答を示していることがわかる。

【００７８】上記のように、本実施の形態においては、
複雑な制御パラメータを設定することなく、機械系の振
動を抑制し、外乱に対する応答をなるべく速くするよう
な調整を行える効果を有する。また、モデル誤差に対す
る安定性を確保した範囲でなるべく速度ゲインを大きく
するような調整を行える効果を有する。また、モデル誤
差に対する安定性を確保した範囲でなるべく機械系の振
動を抑制し、外乱に対する応答を速くするような調整を
行える効果を有する。さらに、電動機で駆動する機械系
の動作の指令信号に対する応答を機械系に負担を与えな
い範囲でなるべく速くするような調整を行える効果を有
する。

【００７９】実施の形態２．以下、本発明の別の実施の
形態を図を用いて説明する。上記実施の形態１における
電動機制御装置は電動機の位置を制御するものであった
が、電動機の速度を制御する電動機制御装置において自
動調整回路を用いても良い。また実施の形態１ではフィ
ードフォワード回路12ｂを用いて目標値応答の速さを独
立に調整できる二自由度制御装置を用いていたが、目標
値応答の速さを完全に独立には調整できない例えば通常
のＰＩ制御装置や二自由度ＰＩ制御装置を用いても良
い。

【００８０】図８に本実施の形態２に用いられる、二自
由度ＰＩ制御装置と呼ばれる制御装置の構造をした、速
度を制御する電動機制御装置の構成のブロック図を示
す。図８において図１と同一符号は同一部分を表す。16
ｃは制御パラメータ調整信号、28ｂは自動調整回路、21
は速度指令信号発生回路、35は第一の分配係数器、36は
第二の分配係数器、37は速度比例回路、38は速度積分回
路、39は第一の分配係数器35と第二の分配係数器36と速
度比例回路37と速度積分回路38を含む速度制御回路であ
る。

【００８１】次に、図９は自動調整回路28ｂの詳細を表
すブロック図である。図９において図３および図８と同
一符号は同一部分を表し、その説明を省略する。34ｂは
制御パラメータ決定部である。

【００８２】次に、速度制御回路39の動作について説明
する。まず、電動機回転速度ｖMを制御するときはスイ
ッチ26をａ）に接続する。速度制御回路39は二自由度Ｐ
Ｉ制御器と呼ばれる構成をしており、速度指令信号発生
回路８が出力した速度指令信号Ｖrと電動機速度ｖMとの
差信号を第一の分配係数器35と速度積分回路38に入力す
る。次に、第一の分配係数器35はその入力に０乃至１の
定数である分配係数αを乗じた信号を出力する。次に速
度積分回路39はその入力を積分して速度積分ゲインＫvI
を乗じた信号を出力する。次に、電動機回転速度ｖMを
第二の分配係数器36に入力し、第二の分配係数器36はそ
の入力に上記の分配係数αを用いて（１−α）を乗じた
信号を出力する。次に、上記第一の分配係数器35の出力
と上記第二の分配係数器36の出力の−１倍の信号と上記
速度積分回路38の出力との和信号を速度比例回路37に入
力し、速度比例回路37はその入力に速度ゲインＫvを乗
じたした信号をトルク指令信号τrとしてトルク制御回
路６に出力する。次にトルク制御回路６は電動機トルク
τMがトルク指令信号τrに一致するように制御すること
により電動機回転速度ｖMが速度指令信号ｖrに一致する
ように制御する。

【００８３】ここで、電動機回転速度ｖMは第一の分配
係数器35と第二の分配係数器36の二つの回路を通ってト
ルク指令τrにフィードバックされているが、第一の分
配係数器35のゲインαと第二の分配係数器36のゲイン
（１−α）の和は１であるため、速度比例回路37の速度
ゲインＫｖがフィードバックループ全体の速度ゲインと
なる。

【００８４】次に速度制御回路39の調整方法を説明す
る。まず、制御対象７の特性がイナーシャＪの剛体機械
に近似可能な場合には、フィードバックループの交差周
波数ωc［ｒａｄ／ｓｅｃ］が決められたとすると、速
度制御回路39の制御パラメータは次の（式２２）、（式
２３）のように調整することにより良好な外乱応答の形
が得られる。

【００８５】

【数１４】

【００８６】また、速度指令信号ｖrに対する目標値応
答に関しては、第一の分配係数器35と第二の分配係数器
36に共通の調整パラメータαを次の（式２４）のような
定数に選ぶことにより、フィードバックループの速度ゲ
インＫvと速度指令信号に対する目標値応答の速さを独
立に調整する事はできないが、オーバーシュートの無い
速やかな応答をする。

【００８７】

【数１５】

【００８８】次に、機械系５が機械共振特性を有する場
合の調整方法は、トルク制御回路６の伝達特性が理想的
に１であるとして機械系５が二慣性系に近似できるとす
ると、速度比例回路37の速度ゲインＫvは上記実施の形
態１の速度補償回路９ｂの速度ゲインＫvと全く同様に
（式１５）の二慣性系最適ゲインＫoptに調整し、この
ときの（式１４）で表されるフィードバックループの交
差周波数ωcを用いて上記の速度積分ゲインＫvIと、第
一および第二の分配係数器の調整パラメータαを（式２
３）、（式２４）のように調整することにより振動抑制
と外乱に対する応答の高速性と目標値応答特性の良好な
応答が得られる。

【００８９】図１０は計算機シミュレーションで機械系
５を二慣性系とし、トルク制御回路６の伝達特性が理想
的に１であるとしたときに、本実施の形態２を用いて調
整した場合のステップ状の速度指令信号ｖrに対する電
動機回転速度ｖMと負荷機械２の回転速度の時間応答を
示す。図１０より機械系５は振動せず、回転速度が良好
に制御されることが分かる。

【００９０】また、実際にはトルク制御回路６に位相遅
れなどのモデル誤差があるため安定の限界の把握をする
必要があるが、その方法は実施の形態１における限界ゲ
インＫmaxを同様に求め、上記のＫoptとＫmaxの小さい
方を速度ゲインＫvとし、（式１４）、（式２３）、
（式２４）を用いて調整すれば、モデル誤差に対する安
定が保たれる範囲で振動抑制と外乱に対する応答の高速
性が得られるような制御の調整が可能になる。

【００９１】次に、図９の自動調整回路28ｂの動作は図
３に示す実施の形態１の自動調整回路28ａにおいて制御
パラメータ決定部34ｂ以外の部分は同様であり、その説
明を省略する。制御パラメータ決定部34ｂは、上記の推
定イナーシャＪeと推定反共振周波数ωzeと二慣性系最
適ゲインＫmaxと限界ゲインＫmaxを入力し、二慣性系最
適ゲインＫmaxと限界ゲインＫmaxの小さい方を速度ゲイ
ンＫvとし、機械系５の総イナーシャＪの代わりに推定
イナーシャＪeを用いて上記の速度積分ゲインを、（式
１４）、（式２３）に従い調整する。また、第一および
第二の分配係数器の調整パラメータαは（式２４）のよ
うに固定している。

【００９２】上記のように、本実施の形態においては、
モデル誤差に対して安定な範囲で振動抑制と外乱に対す
る応答の高速性を得るような調整を自動的に行うことが
可能となる。ここで、本実施の形態では二自由度ＰＩ制
御とよばれる簡単な制御系の構成をしており、速度指令
信号ｖrに対する応答の速さを完全には独立に調整でき
ないため、モデル誤差に対する安定性のために限界ゲイ
ンＫmaxが速度ゲインＫvに選ばれた場合は、上記実施の
形態１とは異なり、目標値応答すなわち速度指令信号ｖ
rに対する応答も遅くなる。

【００９３】実施の形態３．以下、本発明の別の実施の
形態を図を用いて説明する。上記実施の形態１における
電動機制御装置のフィードフォワード回路12ｂは、制御
対象７の伝達特性が剛体機械と同じ場合に位置指令信号
ｘrに対する電動機回転位置ｘMが理想的に応答するよう
にフィードフォワードトルク信号τfを演算していた
が、機械系５が機械共振特性を有する二慣性系である場
合に負荷機械２の回転位置が理想的な応答するようにフ
ィードフォワードトルク信号τfを演算するような構成
にしても良い。

【００９４】図１１に実施の形態３に用いられる電動機
制御装置の全体のブロック構成図を示す。図１と同一符
号は同一部分を表し、その説明は省略する。12ｃはフィ
ードフォワード回路、13ｃはフィードフォワード回路12
ｃとフィードバック補償回路11ｂを含む位置制御回路、
28ｃは自動調整回路、16ｄは制御パラメータ調整信号で
ある。図１１は図１と比べてフィードフォワード回路12
ｃの構成が異なり、制御パラメータ調整信号16ｄと自動
調整回路28ｃの動作が一部異なるものである。

【００９５】図１２はフィードフォワード回路12ｃの詳
細を表すブロック図である。図１１と同一符号は同一部
分を表す。40は応答目標負荷位置信号生成フィルタ、41
はフィードフォワードトルク信号生成フィルタ、42は応
答目標電動機位置信号生成フィルタ、43は微分回路であ
る。

【００９６】図１３は自動調整回路28ｃの詳細を示すブ
ロック図であり、図３および図１１と同一符号は同一部
分を表す。30ｂは機械系５の総イナーシャＪと反共振周
波数ωzと共振周波数ωpを推定する機械パラメータ推定
部である。34ｃは制御パラメータ決定部である。

【００９７】次に、位置制御回路13ｃと制御対象７から
構成される制御系の動作および調整方法について説明す
る。図１１の制御系の構成において上記の図１の制御系
の構成とフィードフォワード回路以外の部分は全く同じ
であり説明を省略し、フィードフォワード回路12ｃの動
作とその調整方法について説明する。

【００９８】次に、フィードフォワード回路12ｃの動作
を説明する。まず、位置指令信号ｘfをフィードフォワ
ード回路12ｃに入力する。フィードフォワード回路12ｃ
はトルク制御回路６の伝達特性が理想的に１で、機械系
５の伝達特性が上記の（式１２）、（式１３）のような
減衰が無視できる二慣性系であるときに、位置指令信号
ｘrに対して負荷機械２の回転位置を理想的に応答させ
るようなフィードフォワードトルク信号τf、およびそ
のときの予想される電動機回転位置ｘMの応答を応答目
標位置信号ｘf、予想される電動機回転速度ｖMの応答を
応答目標速度信号ｖfとして出力する回路である。フィ
ードフォワード回路12ｃでは、応答目標負荷位置信号生
成フィルタ40が位置指令信号ｘrを入力し、負荷機械２
の回転位置の理想的な応答として、位置指令信号ｘfに
対する応答の速さを調整する目標値応答速度調整パラメ
ータωrを用いて次の（式２５）の演算を行い、応答目
標負荷位置信号ｘLfを出力する。（式２５）では伝達関
数が上記のωrの４重根を持つように構成しており、位
置指令信号ｘrに対して応答目標負荷位置信号ｘLfがオ
ーバーシュート無く良好な形で応答するように構成して
いる。

【００９９】

【数１６】

【０１００】次に、機械系５において電動機トルクτM
から電動機回転速度ｖMまでの伝達関数および電動機ト
ルクτMから負荷機械２の回転速度までの伝達関数が、
機械系５の総イナーシャＪ、反共振周波数ωz、共振周
波数ωpを用いて、それぞれ上記の（式１２）、（式１
３）で表される二慣性系の場合は、フィードフォワード
トルク信号生成フィルタ41は応答目標負荷位置信号ｘLf
を入力し、総イナーシャＪの推定値であるイナーシャ推
定値Ｊeおよび共振周波数ωpの推定値である推定共振周
波数ωpeを用いて（式１３）の逆関数の微分に相当する
次の（式２６）の演算によりフィードフォワードトルク
信号τfを出力する。

【０１０１】

【数１７】

【０１０２】次に、応答目標電動機位置信号生成フィル
タ42は応答目標負荷位置信号ｘLfを入力し、機械系５の
反共振周波数ωzの推定値ωzeを用いて、（式１２）と
（式１３）の右辺の比に相当する次の（式２７）の演算
により電動機回転位置ｘMの応答目標信号である応答目
標位置信号ｘfを出力し、微分回路43は応答目標位置信
号ｘfを入力して微分動作を行うことにより応答目標速
度信号ｖfを出力する。

【０１０３】

【数１８】

【０１０４】上記のようにフィードフォワード回路12ｃ
が位置指令信号ｘrを入力してフィードフォワードトル
ク信号τfと応答目標位置信号ｘfと応答目標速度信号ｖ
fを出力することにより、トルク制御回路６の伝達特性
が理想的に１で機械系５の特性が（式１２）および（式
１３）に一致し、上記の機械パラメータの推定値Ｊe、
ωze、ωpeが正確に推定されている場合は、フィードフ
ォワードトルク信号τfをトルク指令信号τrとして制御
対象７を駆動することにより、電動機回転位置ｘMは応
答目標位置信号ｘfに、電動機回転速度ｖMは応答目標速
度信号ｖfに、負荷機械回転位置ｘLは応答目標負荷位置
信号ｘLfに一致する。したがって位置指令信号ｘfに対
して負荷機械回転位置ｘLはオーバーシュート無く良好
な形で応答し、またその応答の速さは目標値応答速度調
整パラメータωrの調整によって任意に変えることがで
きる。

【０１０５】次にフィードフォワード回路12ｃの調整方
法について説明する。フィードフォワードトルク信号生
成フィルタ41の調整パラメータである推定イナーシャＪ
e、推定反共振周波数ωze、推定共振周波数ωpeには、
それぞれ機械系５の総イナーシャＪ、反共振周波数ω
z、共振周波数ωpの推定値を用いる。機械系５が二慣性
系で上記の推定値が正確とすると、応答目標負荷位置信
号生成フィルタ40の調整パラメータである目標値応答速
度調整パラメータωrを調整することにより、位置指令
信号に対する負荷機械の回転位置の応答を理論的には任
意の速さに調整可能である。しかし、上記の実施の形態
１の説明で述べたように、負荷機械２の動作を反共振周
波数ωzより高い周波数帯域まで追従させようとする
と、電動機１と負荷機械２との動作の差すなわちトルク
伝達部３のねじれを大きく励起してしまい、機械系５に
無理を与えてしまう問題を生じる。従って、目標値応答
速度調整パラメータωrを予め設定した定数ｎr2を用い
て次の（式２８）に従い反共振周波数の定数倍に調整す
ることにより、機械系５に負担をかけない範囲で速い応
答を得る効果が得られる。

【０１０６】

【数１９】

【０１０７】図１４は計算機シミュレーションで機械系
５を二慣性系とし、トルク制御回路６の伝達特性が理想
的に１であるとした場合に、本実施の形態３を用いて調
整したときのステップ状の位置指令信号ｘrに対する電
動機回転位置ｘMと負荷機械２の回転位置の時間応答を
示す。ここで、図１４の例では、（式２８）における設
定定数ｎr2は２．７としている。図１４より位置指令信
号ｘMに対して電動機回転位置ｘMの応答を振ることによ
り、負荷機械２の回転位置は理想的な応答になっている
ことがわかる。なお、上記の定数ｎr2をこれ以上大きな
値とすると、負荷機械２の回転位置はオーバーシュート
の無い理想的な形のまま速くなるが、電動機回転位置ｘ
Mの応答が大きくオーバーシュートさせた後に戻るよう
になり、すなわちトルク伝達部３のねじれが大きくなっ
て機械系５に無理を与えるため、ｎr2は２．７より小さ
い値を選ぶ方がよいことがわかる。

【０１０８】次に、自動調整回路28ｃの動作について説
明する。自動調整回路28ｃの機械パラメータ推定部30ｂ
と制御パラメータ決定部34ｃ以外の部分は実施の形態１
の図３と同様でありその説明を省略する。

【０１０９】機械パラメータ推定部30ｂでは、高次モデ
ル同定部29で同定された高次モデルを入力し、例えば最
も小さい複素零点の絶対値を推定反共振周波数ωze、最
も小さい複素極の絶対値を推定共振周波数ωpeとし、ま
た低周波領域の高次モデルのゲイン特性から機械系５の
総イナーシャＪを推定イナーシャＪeとして推定し、推
定イナーシャＪeと推定反共振周波数ωzeと推定共振周
波数ωpeを出力する。

【０１１０】次に、制御パラメータ決定部34ｃでは、推
定イナーシャＪeと推定反共振周波数ωzeと推定共振周
波数ωpeと二慣性系最適ゲインＫoptと限界ゲインＫmax
を入力し、フィードバック補償回路１１ｂの制御パラメ
ータは上記実施の形態１と同様に決定し、フィードフォ
ワード補償回路12ｃの制御パラメータは推定イナーシャ
Ｊeと推定反共振周波数ωzeと推定共振周波数ωpeを用
い、また予め設定された定数ｎr2と反共振周波数ωzの
変わりに推定反共振周波数ωzeを用いて（式２８）の演
算により目標値応答速度調整パラメータωrを決定す
る。

【０１１１】上記のように、モデル誤差に対して安定を
保つ範囲で振動抑制と外乱に対する応答の高速性を得る
ような調整と、機械系５に無理を与えないような範囲で
位置指令信号ｘrに対して特に負荷機械２の回転位置の
応答を高速かつ正確に制御するような調整を自動的に行
うことが可能になる。

【０１１２】なお、上記説明では電動機速度を比例倍し
てフィードバックするループのゲインを速度ゲインＫv
として調整したが、そのループにローパスフィルタなど
が挿入されてるような制御装置においても、最も小さな
反共振周波数付近の特性が比例フィードバックに近けれ
ば同様に利用できることは言うまでもない。

【０１１３】

【発明の効果】この発明に係る電動機制御方法及び電動
機制御装置は、電動機トルクで駆動する機械系の総イナ
ーシャと最も小さい反共振周波数を推定する機械パラメ
ータ推定手段を備え、速度ゲインをフィードバックルー
プの一巡伝達関数のゲイン特性の反共振周波数における
ノッチ特性が０ [dB] より少し下側にあるような二慣性
系最適ゲインに調整するようにしたものであり、機械系
の振動を抑制し、外乱に対する応答をなるべく速くする
ような調整を行える効果を有する。

【０１１４】また、この発明に係る電動機制御方法及び
電動機制御装置は、電動機に対するトルク指令信号から
電動機回転速度までの制御対象の周波数応答を推定する
周波数応答推定手段を備え、推定された制御対象の周波
数応答の位相が−１８０［ｄｅｇ］以下になっている周
波数領域における制御対象の最大ゲインＧmaxを求め、
速度ゲインをＧmaxの逆数以下の値である限界ゲインに
調整するものであり、モデル誤差に対する安定性を確保
した範囲でなるべく速度ゲインを大きくするような調整
を行える効果を有する。

【０１１５】また、この発明に係る電動機制御方法及び
電動機制御装置は、電動機トルクで駆動する機械系の総
イナーシャと最も小さい反共振周波数を推定する機械パ
ラメータ推定手段と電動機に対するトルク指令信号から
電動機回転速度までの制御対象の周波数応答を推定する
周波数応答推定手段を備え、速度ゲインを上記の二慣性
系最適ゲインと上記の限界ゲインの小さい方に調整する
ものであり、モデル誤差に対する安定性を確保した範囲
でなるべく機械系の振動を抑制し、外乱に対する応答を
速くするような調整を行える効果を有する。

【０１１６】さらに、この発明に係る電動機制御方法及
び電動機制御装置は、電動機トルクで駆動する機械系の
最も小さい反共振周波数を推定する機械パラメータ推定
手段を備え、電動機の動作の指令信号に対する応答速度
を調整するフィードフォワード回路の目標値応答調整パ
ラメータを反共振周波数の定数倍に調整するものであ
り、電動機で駆動する機械系の動作の指令信号に対する
応答を機械系に負担を与えない範囲でなるべく速くする
ような調整を行える効果を有する。

【図面の簡単な説明】

【図１】 本発明の実施の形態１に用いられる電動機制
御装置の構成を表すブロック図である。

【図２】 本発明の実施の形態１の電動機制御装置のフ
ィードフォワード回路のブロック図である

【図３】 本発明の実施の形態１の電動機制御装置の自
動調整回路のブロック図である。

【図４】 本発明の実施の形態１の調整結果を表すフィ
ードバックループの一巡伝達関数の折れ線近似ゲイン線
図である。

【図５】 制御対象が二慣性系の場合の速度ゲインと振
動の減衰率の関係を表す図である。

【図６】 本発明の自動調整を実施した実験における制
御対象の同定結果を表す周波数応答である。

【図７】 本発明の実施の形態１の効果を表す実験にお
ける電動機回転位置の応答である。

【図８】 本発明の実施の形態２に用いられる電動機制
御装置の構成を表すブロック図である。

【図９】 本発明の実施の形態２の電動機制御装置の自
動調整回路のブロック図である。

【図１０】 本発明の実施の形態２の効果を表すシミュ
レーションにおける電動機回転速度と負荷機械の回転速
度の応答である。

【図１１】 本発明の実施の形態３に用いられる電動機
制御装置の構成を表すブロック図である。

【図１２】 本発明の実施の形態３の電動機制御装置に
おけるフィードフォワード回路のブロック図である。

【図１３】 本発明の実施の形態３の電動機制御装置の
自動調整回路のブロック図である。

【図１４】 本発明の実施の形態３の効果を表すシミュ
レーションにおける電動機回転速度と負荷機械の回転速
度の応答である。

【図１５】 第一の従来技術の電動機制御装置の構成を
表すブロック図である。

【図１６】 第一の従来技術の電動機制御装置のフィー
ドフォワード回路のブロック図である。

【図１７】 第二の従来技術の電動機制御装置の構成を
表すブロック図である。

【符号の説明】

１ 電動機、 ２ 負荷機械、 ３ トルク伝達
部、４ 回転検出器、 ５ 機械系、 ６ トルク
制御回路、７ 制御対象、 ８ 位置指令信号発生回
路、 ９ｂ 速度補償回路、10ｂ 位置補償回路、
11ｂ フィードバック補償回路、12ｂ、12ｃ フィー
ドフォワード回路、 13ｂ、13ｃ 位置制御回路、14
負荷外乱トルクτd、 15 イナーシャ推定回路、1
6ｂ、16ｃ、16ｄ 制御パラメータ調整信号、17ｂ 剛
体イナーシャモデル回路、 18 積分回路、19ｂ モ
デル速度制御回路、 20ｂ モデル位置制御回路、21
速度指令信号発生回路、 22 速度制御回路、
23 外乱推定回路、24 推定外乱増幅器、 25 位相
進み増幅器、 26 スイッチ、27 駆動試験用トルク
指令信号発生回路、28ａ、28ｂ、28ｃ 自動調整回路、
29 高次モデル同定部、30ａ、30ｂ 機械パラメー
タ推定部、 31 二慣性系最適ゲイン計算部、32 周
波数応答推定部、 33 限界ゲイン推定部、34ａ、34
ｂ、34ｃ 制御パラメータ決定部、 35 第一の分配
係数器、36 第二の分配係数器、 37 速度比例回
路、 38 速度積分回路、39 速度制御回路、 40
応答目標負荷位置信号生成フィルタ、41 フィードフ
ォワードトルク信号生成フィルタ、42 応答目標電動機
位置信号生成フィルタ、 43 微分回路

Claims (9)

【特許請求の範囲】
1. 【請求項１】 電動機の回転速度あるいは回転位置を検
   出して、上記電動機の回転速度あるいは上記電動機の回
   転位置の微分信号を比例倍した信号を元に生成されたト
   ルク指令信号により、上記電動機の回転トルクを制御し
   て、電動機の回転速度あるいは回転位置を制御する電動
   機制御方法において、上記電動機の回転速度あるいは上
   記電動機の回転位置の微分信号を比例倍した信号を元に
   トルク指令信号を生成する速度比例フィードバック回路
   の全体のゲインをＫvとし、上記電動機の回転トルクで
   駆動する機械系の総イナーシャＪの推定値である推定イ
   ナーシャをＪe、上記機械系の最も小さい反共振周波数
   ωzの推定値である推定反共振周波数をωze、二慣性系
   最適ゲインをＫoptとした時、 Ｋopt＝ｎ×Ｊe×ωze 但し、０．５≦ｎ≦１（ｎは定数）により記述される二
   慣性系最適ゲインＫoptを用いて上記速度比例フィード
   バック回路の全体のゲインＫvを調整することを特徴と
   する電動機制御方法。
2. 【請求項２】 請求項１において、二慣性系最適ゲイン
   Ｋoptを記述する定数ｎが、 ０．７≦ｎ＜１ であることを特徴とする電動機制御方法。
3. 【請求項３】 電動機の回転速度あるいは回転位置を検
   出し、上記電動機の回転速度あるいは上記電動機の回転
   位置の微分信号を比例倍した信号を元に生成されたトル
   ク指令信号により、上記電動機の回転トルクを制御し
   て、電動機の回転速度あるいは回転位置を制御する電動
   機制御方法において、上記電動機の回転速度あるいは上
   記電動機の回転位置の微分信号を比例倍した信号を元に
   トルク指令信号を生成する速度比例フィードバック回路
   の全体のゲインをＫvとする時、上記トルク指令信号か
   ら上記電動機の回転速度あるいは上記電動機の回転位置
   の微分信号までの制御対象の周波数応答を推定し、０以
   上の定数である設定位相余裕θmと１以上の定数である
   設定ゲイン余裕Ｇmを用いて、上記推定された制御対象
   の周波数応答の位相が（−１８０＋θm）［ｄｅｇ］と
   なる最も低い周波数より高周波数領域における上記制御
   対象の周波数応答の最大ゲインＧmaxを求め、次に上記
   最大ゲインＧmaxと上記設定ゲイン余裕Ｇmの積の逆数か
   ら限界ゲインＫmaxを求め、上記速度比例フィードバッ
   ク回路の全体のゲインＫvを上記限界ゲインＫmaxを用い
   て調整することを特徴とする電動機制御方法。
4. 【請求項４】 電動機の回転速度あるいは回転位置を検
   出し、上記電動機の回転速度あるいは上記電動機の回転
   位置の微分信号を比例倍した信号を元に生成されたトル
   ク指令信号により、上記電動機の回転トルクを制御し
   て、電動機の回転速度あるいは回転位置を制御する電動
   機制御方法において、上記電動機の回転速度あるいは上
   記電動機の回転位置の微分信号を比例倍した信号を元に
   トルク指令信号を生成する速度比例フィードバック回路
   の全体のゲインをＫvとし、上記電動機の回転トルクで
   駆動する機械系の総イナーシャＪの推定値である推定イ
   ナーシャをＪe、上記機械系の最も小さい反共振周波数
   ωzの推定値である推定反共振周波数をωze、二慣性系
   最適ゲインをＫoptとした時、 Ｋopt＝ｎ×Ｊe×ωze 但し、０．５≦ｎ≦１（ｎは定数）により二慣性系最適
   ゲインＫoptを求め、上記トルク指令信号から上記電動
   機の回転速度あるいは上記電動機の回転位置の微分信号
   までの制御対象の周波数応答を推定し、０以上の定数で
   ある設定位相余裕θmと１以上の定数である設定ゲイン
   余裕Ｇmを用いて、上記推定された制御対象の周波数応
   答の位相が（−１８０＋θm）［ｄｅｇ］となる最も低
   い周波数より高周波数領域における上記制御対象の周波
   数応答の最大ゲインＧmaxを求め、次に上記最大ゲイン
   Ｇmaxと上記設定ゲイン余裕Ｇmとの積の逆数から限界ゲ
   インＫmaxを求め、上記求められたＫoptとＫmaxとを比
   較して、小さい方を用いて上記速度比例フィードバック
   回路の全体のゲインＫvを調整することを特徴とする電
   動機制御方法
5. 【請求項５】 電動機の回転速度あるいは回転位置を制
   御するための指令信号を元に生成されたトルク指令信号
   により、上記電動機の回転トルクを制御して、電動機の
   回転速度あるいは回転位置を制御する電動機制御方法に
   おいて、上記電動機の回転速度あるいは回転位置が上記
   指令信号に追従して応答する速さを調整するための調整
   パラメータである目標値応答速度調整パラメータを、少
   なくとも電動機の回転トルクで駆動する機械系の最も小
   さい反共振周波数ωzの推定値である推定反共振周波数
   ωzeを用いて決定することを特徴とする電動機制御方
   法。
6. 【請求項６】 少なくとも電動機の回転トルクをトルク
   指令信号に追従させるトルク制御回路と、電動機の回転
   速度あるいは回転位置を検出する電動機回転検出器と、
   上記電動機の回転速度あるいは上記電動機の回転位置の
   微分信号を比例倍した信号を上記トルク指令信号にフィ
   ードバックして加える単数あるいは複数の速度比例フィ
   ードバック回路を有して電動機の回転速度あるいは回転
   位置を制御する電動機制御装置において、上記速度比例
   フィードバック回路のゲインを調整する手段と、電動機
   の回転トルクで駆動する機械系の総イナーシャＪの推定
   値である推定イナーシャＪeと上記機械系の最も小さい
   反共振周波数ωzの推定値である推定反共振周波数ωze
   を出力する機械パラメータ推定手段とを備え、上記機械
   パラメータ推定部から出力された上記推定イナーシャを
   Ｊe、上記推定反共振周波数をωzeとする時、 Ｋopt＝ｎ×Ｊe×ωze 但し、０．５≦ｎ≦１（ｎは定数）により、二慣性系最
   適ゲインＫoptは記述され、上記速度比例フィードバッ
   ク回路のゲインを調整する手段は、上記の単数あるいは
   複数の速度比例フィードバック回路の全体のゲインＫv
   を上記二慣性系最適ゲインＫoptに調整することを特徴
   とする電動機制御装置。
7. 【請求項７】 少なくとも電動機の回転トルクをトルク
   指令信号に追従させるトルク制御回路と、電動機の回転
   速度あるいは回転位置を検出する電動機回転検出器と、
   上記電動機の回転速度あるいは上記電動機の回転位置の
   微分信号を比例倍した信号を上記トルク指令信号にフィ
   ードバックして加える単数あるいは複数の速度比例フィ
   ードバック回路を有して電動機の回転速度あるいは回転
   位置を制御する電動機制御装置において、上記速度比例
   フィードバック回路のゲインを調整する手段と、上記ト
   ルク指令信号から上記電動機の回転速度あるいは上記電
   動機の回転位置の微分信号までの制御対象の周波数応答
   を推定する周波数応答推定手段とを備え、０以上の定数
   である設定位相余裕θmと１以上の定数である設定ゲイ
   ン余裕Ｇmを用いて、上記周波数応答推定手段が出力し
   た制御対象の周波数応答の位相が（−１８０＋θm）
   ［ｄｅｇ］となる最も低い周波数より高周波数領域にお
   ける上記制御対象の周波数応答の最大ゲインをＧmaxと
   し、上記最大ゲインＧmaxと上記設定ゲイン余裕Ｇmの積
   の逆数を限界ゲインＫmaxとすると、上記速度比例フィ
   ードバック回路のゲインを調整する手段は上記の単数あ
   るいは複数の速度比例フィードバック回路の全体のゲイ
   ンＫvを上記限界ゲインＫmaxに調整することを特徴とす
   る電動機制御装置。
8. 【請求項８】 少なくとも電動機の回転トルクをトルク
   指令信号に追従させるトルク制御回路と、電動機の回転
   速度あるいは回転位置を検出する電動機回転検出器と、
   上記電動機の回転速度あるいは上記電動機の回転位置の
   微分信号を比例倍した信号を上記トルク指令信号にフィ
   ードバックして加える単数あるいは複数の速度比例フィ
   ードバック回路を有して電動機の回転速度あるいは回転
   位置を制御する電動機制御装置において、上記速度比例
   フィードバック回路のゲインを調整する手段と、電動機
   の回転トルクで駆動する機械系の総イナーシャＪの推定
   値である推定イナーシャＪeと上記機械系の最も小さい
   反共振周波数ωzの推定値である推定反共振周波数ωze
   を出力する機械パラメータ推定手段と、上記トルク指令
   信号から上記電動機の回転速度あるいは上記電動機の回
   転位置の微分信号までの制御対象の周波数応答を推定す
   る周波数応答推定手段とを備え、上記機械パラメータ推
   定部から出力された上記推定イナーシャをＪe、上記推
   定反共振周波数をωzeとする時、 Ｋｏｐｔ＝ｎ×Ｊe×ωｚｅ 但し、０．５≦ｎ≦１（ｎは定数）により、二慣性系最
   適ゲインＫｏｐｔは記述され、０以上の定数である設定
   位相余裕θmと１以上の定数である設定ゲイン余裕Ｇmを
   用いて、上記周波数応答推定手段が出力した制御対象の
   周波数応答の位相が（−１８０＋θm）［ｄｅｇ］とな
   る最も低い周波数より高周波数領域における上記制御対
   象の周波数応答の最大ゲインをＧmaxとし、上記最大ゲ
   インＧmaxと上記設定ゲイン余裕Ｇmの積の逆数を限界ゲ
   インＫmaxとすると、上記速度比例フィードバック回路
   のゲインを調整する手段は、上記二慣性系最適ゲインＫ
   optと上記限界ゲインＫmaxとを比較する手段を備え、上
   記の単数あるいは複数の速度比例フィードバック回路の
   全体のゲインＫvを上記二慣性系最適ゲインＫoptと上記
   限界ゲインＫmaxとの小さい方に調整することを特徴と
   する電動機制御装置。
9. 【請求項９】 少なくとも電動機の回転トルクをトルク
   指令信号に追従させるトルク制御回路と、少なくとも電
   動機の回転速度あるいは回転位置に対する指令信号を入
   力して電動機の動作が上記指令信号に追従して応答する
   ようにフィードフォワードトルク信号を演算して出力し
   上記トルク指令信号に加算するフィードフォワード回路
   を備えた電動機制御装置において、電動機の回転速度あ
   るいは回転位置が上記指令信号に追従して応答する速さ
   を調整するための上記フィードフォワード回路の調整パ
   ラメータである目標値応答速度調整パラメータを調整す
   る手段と、電動機の回転トルクで駆動する機械系の最も
   小さい反共振周波数ωzの推定値である推定反共振周波
   数ωzeを出力する機械パラメータ推定手段を備え、上記
   目標値応答速度調整パラメータを調整する手段は、上記
   目標値応答速度調整パラメータを上記推定反共振周波数
   ωzeに予め設定した定数を乗じた値に調整することを特
   徴とする電動機制御装置。