JP4240208B2 - モータ制御装置 - Google Patents
モータ制御装置 Download PDFInfo
- Publication number
- JP4240208B2 JP4240208B2 JP2003111753A JP2003111753A JP4240208B2 JP 4240208 B2 JP4240208 B2 JP 4240208B2 JP 2003111753 A JP2003111753 A JP 2003111753A JP 2003111753 A JP2003111753 A JP 2003111753A JP 4240208 B2 JP4240208 B2 JP 4240208B2
- Authority
- JP
- Japan
- Prior art keywords
- motor
- speed
- motor speed
- simulated
- control unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Control Of Electric Motors In General (AREA)
- Testing And Monitoring For Control Systems (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、主にロボットや工作機械などを駆動するモータ制御装置、特に、故障発生後に故障原因の診断を行うモータ制御装置に関する。
【０００２】
【従来の技術】
従来、故障発生後に故障原因の診断を行うモータ制御装置は、故障時の波形とシミュレーション波形が同一となるように探索を行い、データテーブルを利用して故障原因の診断を行っている。（例えば、特許文献１参照）。
【０００３】
【特許文献１】
特開平６−３４４２９３号公報（第１０頁、第５図）
【０００４】
図５において、５１はアンプ(サーボアンプ)であり、ロボット５２を駆動する位置指令、速度指令、位置フィードバック、電流値などを記憶する。５３はコントローラであり、前記アンプ５１に位置指令を送るとともに、前記アンプ５１から診断に必要な情報を受け取る。
図５において、故障診断部５４が故障の発生を検出すると、波形原因解析部５５が故障時の波形とシミュレーション波形が同一となるようなシミュレーションパラメータを探索し、予め記憶されたシミュレーションパラメータと故障原因の関連データテーブルから故障原因を推定することで、故障原因の診断を行う。
このように、従来の故障原因の診断を行うモータ制御装置は、故障時の波形とシミュレーション波形が同一となるように探索を行い、データテーブルを利用して故障原因を推定するのである。
【０００５】
【発明が解決しようとする課題】
しかしながら、前記従来例では、故障時の波形とシミュレーション波形が同一となるように探索を行う際、シミュレータが故障時の波形を再現できない場合、制御装置のどの部分に異常があるかを特定できない。また、データテーブルに用いる多くの記憶領域が必要である、という問題点があった。
そこで、本発明はこのような問題点に鑑みてなされたものであり、異常発生時に、簡単な判断で異常原因が制御装置のどの部分にあるかを特定でき、かつ多くの記憶領域を必要としないモータ制御装置を提供することを目的とする。
【０００６】
【課題を解決するための手段】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、モータ速度に基づいて作成された速度フィードバック信号を入力し、予め定められた、または時々刻々変化する速度指令に前記速度フィードバック信号が一致するよう速度制御を行い、トルク指令を出力する速度制御部と、前記トルク指令を入力し、駆動電流をモータへ出力する電流制御部と、前記モータの位置または速度を検出し、前記モータ速度を出力する検出器と、を備えたモータ制御装置において、前記モータの回転子慣性モーメントと前記モータが駆動している負荷の慣性モーメントを前記モータの回転軸に換算した慣性モーメントとの和と、前記モータのトルク定数と、前記駆動電流と、に基づいて模擬モータ速度を計算するモータ動作模擬部と、前記モータ速度を入力し、前記モータ速度または前記モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記モータ速度が正常な状態か否かを判断するモータ速度診断部と、前記模擬モータ速度を入力し、前記模擬モータ速度または前記模擬モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記模擬モータ速度が正常な状態か否かを判断する模擬モータ速度診断部と、を備え、前記モータ速度診断部が前記モータ速度を異常と判定すると共に、前記模擬モータ速度診断部が前記模擬モータ速度を異常と判定した場合、前記模擬モータ速度診断部が前記速度制御部または前記電流制御部に異常原因があると判断し、一方、前記模擬モータ速度診断部が前記模擬モータ速度を正常と判定した場合、前記模擬モータ速度診断部が前記速度制御部および前記電流制御部以外に異常原因があると判断することを特徴とするものである。
また、請求項２に記載の発明は、モータ速度に基づいて作成された速度フィードバック信号を入力し、予め定められた、または時々刻々変化する速度指令に前記速度フィードバック信号が一致するよう速度制御を行い、トルク指令を出力する速度制御部と、前記トルク指令を入力し、駆動電流をモータへ出力する電流制御部と、前記モータの位置または速度を検出し、前記モータ速度を出力する検出器と、を備えたモータ制御装置において、前記トルク指令を入力して、模擬駆動電流を計算する電流制御模擬部と、前記モータの回転子慣性モーメントと前記モータが駆動している負荷の慣性モーメントを前記モータの回転軸に換算した慣性モーメントとの和と、前記モータのトルク定数と、前記模擬駆動電流と、に基づいて模擬モータ速度を計算するモータ動作模擬部と、前記モータ速度を入力し、前記モータ速度または前記モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記モータ速度が正常な状態か否かを判断するモータ速度診断部と、前記模擬モータ速度を入力し、前記模擬モータ速度または前記模擬モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記模擬モータ速度が正常な状態か否かを判断する模擬モータ速度診断部と、を備え、前記モータ速度診断部が前記モータ速度を異常と判定すると共に、前記模擬モータ速度診断部が前記模擬モータ速度を異常と判定した場合、前記模擬モータ速度診断部が前記速度制御部に異常原因があると判断し、一方、前記模擬モータ速度診断部が前記模擬モータ速度を正常と判定した場合、前記模擬モータ速度診断部が前記速度制御部以外に異常原因があると判断することを特徴とするものである。
【０００７】
【発明の実施の形態】
以下、本発明の具体的実施例を図に基づいて説明する。
図１は、本発明を適用するモータ制御装置のブロック図である。図において、１１は速度制御部であり、速度フィードバック信号Vfbを入力し、予め定められた、または時々刻々変化する速度指令と速度フィードバック信号Vfbが一致するよう速度制御を行いトルク指令Trefを出力する。１２は電流制御部であり、トルク指令Trefを入力してこれに応じた駆動電流iqを出力してモータ１３を駆動する。１４は検出器であり、モータ速度Vfbrを検出して出力する。１５はモータ動作模擬部であり、前記駆動電流iqを入力し、モータ動作を模擬する数式または等価回路またはブロック図などにより、模擬モータ速度Vfbmを計算して出力する。
モータ動作を模擬する数式の最も簡単な例として、式（１）がある。
いま、モータの回転子慣性モーメントとそのモータが駆動している負荷の慣性モーメントをそのモータの回転軸に換算した慣性モーメントとの和をJ、モータのトルク定数をΦとするとき、
Vfbm＝∫（Φ・iq／J） 式（１）
とする。式（１）において∫は時間積分を表す。
また、もっと高い精度のモータ動作の模擬が要求される場合は、モータの種類やモータの駆動する負荷などの条件を加味して数式または等価回路またはブロック図などを改良してもよい。
１６はモータ速度診断部であり、前記モータ速度Vfbrを入力し、そのモータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、モータの動作が正常か否かを判定してフィードバック切り替え信号SwVfbを出力する。
最も簡略化した判定方法として、前記モータ速度Vfbrの絶対値と通常の動作では到達しないと考えられる高い値に予め設定した閾値Vfbmaxと比較する方法がある。
いま、動作説明の都合上、｜Vfbr｜≧Vfbmaxとなる場合は異常状態と判断してフィードバック信号切り替え指令SwVfbをLoとし、それ以外の場合は正常と判断して前記フィードバック信号切り替え指令SwVfbをHiとすると定義する。
また、別の判定方法として、前記モータ速度Vfbrが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、前記モータ速度Vfbrに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法もある。
なお、モータ速度診断部１６が異常と判断した時点でモータ１３を非常停止するなどの措置をとってもよいが、異常原因を見つけるためには、その際も速度制御部１１および電流制御部１２は動作を継続する。
１７はフィードバック信号切り替え部であり、前記フィードバック信号切り替え指令SwVfbに基づいて速度フィードバック信号Vfbを出力する。フィードバック信号切り替え部１７は、前記フィードバック信号切り替え指令SwVfbがHiであれば前記モータ速度Vfbrを出力し、前記フィードバック信号切り替え指令SwVfbがLoであれば前記模擬モータ速度Vfbmを出力する。
１８は模擬モータ速度診断部であり、前記模擬モータ速度Vfbmを入力し、その模擬モータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、模擬したモータの動作が正常か否かを判定する。
判定方法は、前記モータ速度Vfbrの代わりに前記模擬モータ速度Vfbmを入力して、モータ速度診断部１６と同様の方法がある。
前記模擬モータ速度診断部は自身の判断に基づいて何らかの方法で警報を出す。
【０００８】
次に、模擬モータ速度診断部１８において異常を診断する一つの例について、図２を用いて手順を説明する。図２は、模擬モータ速度診断部１８の内部の処理を示すフローチャートである。図２において、Ｓに続く数値はステップ番号を示す。Ｓ１８１では模擬モータ速度Vfbmを入力する。Ｓ１８２では前記Vfbmの絶対値と閾値Vfbmaxと比較し、|Vfbm|≧Vfbmaxとなる場合はＳ１８３へ進み、それ以外はＳ１８４へ進む。Ｓ１８３では速度制御部または電流制御部に異常原因がある旨の警報を発し、Ｓ１８４では速度制御部および電流制御部以外に異常原因がある旨の警報を発する。なお、前記モータ速度診断部１６と前記模擬モータ速度診断部１８内の異常診断に用いる閾値は互いに違ってもよい。また、モータ速度診断部同様、模擬モータ速度Vfbmが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、前記模擬モータ速度Vfbmに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法を使ってもよい。
【０００９】
次に、本発明の第２実施例について、図３を用いて説明する。図３は、本発明を適用するモータ制御装置のブロック図である。図において、３１は速度制御部であり、モータ速度Vfbを入力し、予め定められた、または時々刻々変化する速度指令と前記モータ速度Vfbが一致するよう速度制御を行いトルク指令Trefを出力する。３２は電流制御部であり、トルク指令Trefを入力してこれに応じた駆動電流iqを出力してモータ３３を駆動する。３４は検出器であり、モータ速度Vfbrを検出して出力する。３５は電流制御模擬部であり、前記トルク指令Trefを入力して、モータの電気特性に合わせて模擬した数式または等価回路またはブロック図などを、電流制御部３２と同等の処理を行って模擬駆動電流iqmを計算して出力する。しかし、一般的には、電流ループの応答は速度ループの応答に比べて非常に速いため、電流ループの閉ループ伝達関数を１と近似することができる。
したがって、
iqm＝Tref 式（２）
としても差し支えない。
３６はモータ動作模擬部であり、前記模擬駆動電流iqｍを入力し、モータ動作を模擬する数式または等価回路またはブロック図などにより、模擬モータ速度Vfbmを計算して出力する。
いま、モータの回転子慣性モーメントとそのモータが駆動している負荷の慣性モーメントをそのモータの回転軸に換算した慣性モーメントとの和をJ,モータのトルク定数をΦとするとき、模擬モータ速度Vfbmは、
Vfbm＝∫（Φ・iqm／J） 式（３）
となり、式（２）より、
Vfbm＝∫（Φ・Tref／J） 式（４）
で求めることができる。式（３）および式（４）において∫は時間積分を表す。模擬モータ速度を、もっと高い精度で得たい場合は、電流ループの閉ループ伝達関数を１と近似せず、モータの種類やモータの駆動する負荷などの条件を考慮した数式または等価回路またはブロック図などを使用して、模擬駆動電流iqmを計算し、さらに、模擬モータ速度を求めてもよい。
３７はモータ速度診断部であり、前記モータ速度Vfbrを入力し、そのモータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、モータの動作が正常か否かを判定してフィードバック切り替え信号SwVfbを出力する。最も簡略化した判定方法として、前記モータ速度Vfbrの絶対値と通常の動作では到達しないと考えられる高い値に予め設定した閾値Vfbmaxと比較する方法がある。
いま、動作説明の都合上、｜Vfbr｜≧Vfbmaxとなる場合は異常状態と判断してフィードバック信号切り替え指令SwVfbをLoとし、それ以外の場合は正常と判断して前記フィードバック信号切り替え指令SwVfbをHiとすると定義する。
また、別の判定方法として、前記モータ速度Vfbrが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、前記モータ速度Vfbrに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法もある。
なお、モータ速度診断部３７が異常と判断した時点でモータ３３を非常停止するなどの措置をとってもよいが、異常原因を見つけるためには、その際も速度制御部３１は動作を継続する。
３８はフィードバック信号切り替え部であり、前記フィードバック信号切り替え指令SwVfbに基づいて速度フィードバック信号Vfbを出力する。フィードバック信号切り替え部３８は、前記フィードバック信号切り替え指令SwVfbがHiであれば前記モータ速度Vfbrを出力し、前記フィードバック信号切り替え指令SwVfbがLoであれば前記模擬モータ速度Vfbmを出力する。
３９は模擬モータ速度診断部であり、前記模擬モータ速度Vfbmを入力し、その模擬モータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、模擬したモータの動作が正常か否かを判定する。
判定方法は、前記モータ速度Vfbrの代わりに前記模擬モータ速度Vfbmを入力して、モータ速度診断部３７と同様の方法がある。
前記模擬モータ速度診断部は自身の判断に基づいて何らかの方法で警報を出す。
【００１０】
次に、模擬モータ速度診断部３９において異常を診断する一つの例について、図４を用いて手順を説明する。図４は、模擬モータ速度診断部３９の内部の処理を示すフローチャートである。図４において、Ｓに続く数値はステップ番号を示す。Ｓ３９１では模擬モータ速度Vfbmを入力する。Ｓ３９２では前記Vfbmの絶対値と閾値Vfbmaxと比較し、|Vfbm|≧Vfbmaxとなる場合はＳ３９３へ進み、それ以外はＳ３９４へ進む。なお、前記閾値Vfbmaxは通常の動作では到達しないほど高い値に予め設定しておく。Ｓ３９３では速度制御部に異常原因がある旨の警報を発し、Ｓ３９４では速度制御部以外に異常原因がある旨の警報を発する。なお、前記モータ速度診断部３７と前記模擬モータ速度診断部３９内の異常診断に用いる閾値は互いに違ってもよい。また、モータ速度診断部同様、模擬モータ速度Vfbmが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、模擬モータ速度Vfbmに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法を使ってもよい。
本実施例が前記第１の実施例と最も異なる点はモータ動作模擬部が電流制御部の出力信号の代わりに電流制御模擬部の出力信号を使う点にある。この結果、前記電流制御部の影響を受けずにモータの動作を模擬し異常診断を行うので、異常発生時に異常の原因が速度制御部にあるか否かを判断することができる。
【００１１】
【発明の効果】
以上述べたように、本発明のモータ制御装置によれば、メカ部や電流制御部を部分的にモデル化したシミュレータのシミュレーション結果を診断するので、異常発生時に、簡単な判断で異常原因が制御装置のどの部分にあるかを特定でき、かつ多くの記憶領域を必要としないモータ制御装置を提供することができる。
【図面の簡単な説明】
【図１】本発明の実施例を示すブロック図
【図２】図１における模擬モータ速度診断部１８の詳細を示すフローチャート
【図３】本発明の第２実施例を示すブロック図
【図４】図３における模擬モータ速度診断部３９の詳細を示すフローチャート
【図５】従来例を示す図
【符号の説明】
１１、３１ 速度制御部
１２、３２ 電流制御部
１３、３３ モータ
１４、３４ 検出器
１５、３６ モータ動作模擬部
１６、３７ モータ速度診断部
１７、３８ フィードバック信号切り替え部
１８、３９ 模擬モータ速度診断部
３５ 電流制御模擬部
５１ アンプ
５２ ロボット本体
５３ コントローラ
５４ 故障診断部
５５ 波形原因解析部
【発明の属する技術分野】
本発明は、主にロボットや工作機械などを駆動するモータ制御装置、特に、故障発生後に故障原因の診断を行うモータ制御装置に関する。
【０００２】
【従来の技術】
従来、故障発生後に故障原因の診断を行うモータ制御装置は、故障時の波形とシミュレーション波形が同一となるように探索を行い、データテーブルを利用して故障原因の診断を行っている。（例えば、特許文献１参照）。
【０００３】
【特許文献１】
特開平６−３４４２９３号公報（第１０頁、第５図）
【０００４】
図５において、５１はアンプ(サーボアンプ)であり、ロボット５２を駆動する位置指令、速度指令、位置フィードバック、電流値などを記憶する。５３はコントローラであり、前記アンプ５１に位置指令を送るとともに、前記アンプ５１から診断に必要な情報を受け取る。
図５において、故障診断部５４が故障の発生を検出すると、波形原因解析部５５が故障時の波形とシミュレーション波形が同一となるようなシミュレーションパラメータを探索し、予め記憶されたシミュレーションパラメータと故障原因の関連データテーブルから故障原因を推定することで、故障原因の診断を行う。
このように、従来の故障原因の診断を行うモータ制御装置は、故障時の波形とシミュレーション波形が同一となるように探索を行い、データテーブルを利用して故障原因を推定するのである。
【０００５】
【発明が解決しようとする課題】
しかしながら、前記従来例では、故障時の波形とシミュレーション波形が同一となるように探索を行う際、シミュレータが故障時の波形を再現できない場合、制御装置のどの部分に異常があるかを特定できない。また、データテーブルに用いる多くの記憶領域が必要である、という問題点があった。
そこで、本発明はこのような問題点に鑑みてなされたものであり、異常発生時に、簡単な判断で異常原因が制御装置のどの部分にあるかを特定でき、かつ多くの記憶領域を必要としないモータ制御装置を提供することを目的とする。
【０００６】
【課題を解決するための手段】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、モータ速度に基づいて作成された速度フィードバック信号を入力し、予め定められた、または時々刻々変化する速度指令に前記速度フィードバック信号が一致するよう速度制御を行い、トルク指令を出力する速度制御部と、前記トルク指令を入力し、駆動電流をモータへ出力する電流制御部と、前記モータの位置または速度を検出し、前記モータ速度を出力する検出器と、を備えたモータ制御装置において、前記モータの回転子慣性モーメントと前記モータが駆動している負荷の慣性モーメントを前記モータの回転軸に換算した慣性モーメントとの和と、前記モータのトルク定数と、前記駆動電流と、に基づいて模擬モータ速度を計算するモータ動作模擬部と、前記モータ速度を入力し、前記モータ速度または前記モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記モータ速度が正常な状態か否かを判断するモータ速度診断部と、前記模擬モータ速度を入力し、前記模擬モータ速度または前記模擬モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記模擬モータ速度が正常な状態か否かを判断する模擬モータ速度診断部と、を備え、前記モータ速度診断部が前記モータ速度を異常と判定すると共に、前記模擬モータ速度診断部が前記模擬モータ速度を異常と判定した場合、前記模擬モータ速度診断部が前記速度制御部または前記電流制御部に異常原因があると判断し、一方、前記模擬モータ速度診断部が前記模擬モータ速度を正常と判定した場合、前記模擬モータ速度診断部が前記速度制御部および前記電流制御部以外に異常原因があると判断することを特徴とするものである。
また、請求項２に記載の発明は、モータ速度に基づいて作成された速度フィードバック信号を入力し、予め定められた、または時々刻々変化する速度指令に前記速度フィードバック信号が一致するよう速度制御を行い、トルク指令を出力する速度制御部と、前記トルク指令を入力し、駆動電流をモータへ出力する電流制御部と、前記モータの位置または速度を検出し、前記モータ速度を出力する検出器と、を備えたモータ制御装置において、前記トルク指令を入力して、模擬駆動電流を計算する電流制御模擬部と、前記モータの回転子慣性モーメントと前記モータが駆動している負荷の慣性モーメントを前記モータの回転軸に換算した慣性モーメントとの和と、前記モータのトルク定数と、前記模擬駆動電流と、に基づいて模擬モータ速度を計算するモータ動作模擬部と、前記モータ速度を入力し、前記モータ速度または前記モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記モータ速度が正常な状態か否かを判断するモータ速度診断部と、前記模擬モータ速度を入力し、前記模擬モータ速度または前記模擬モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記模擬モータ速度が正常な状態か否かを判断する模擬モータ速度診断部と、を備え、前記モータ速度診断部が前記モータ速度を異常と判定すると共に、前記模擬モータ速度診断部が前記模擬モータ速度を異常と判定した場合、前記模擬モータ速度診断部が前記速度制御部に異常原因があると判断し、一方、前記模擬モータ速度診断部が前記模擬モータ速度を正常と判定した場合、前記模擬モータ速度診断部が前記速度制御部以外に異常原因があると判断することを特徴とするものである。
【０００７】
【発明の実施の形態】
以下、本発明の具体的実施例を図に基づいて説明する。
図１は、本発明を適用するモータ制御装置のブロック図である。図において、１１は速度制御部であり、速度フィードバック信号Vfbを入力し、予め定められた、または時々刻々変化する速度指令と速度フィードバック信号Vfbが一致するよう速度制御を行いトルク指令Trefを出力する。１２は電流制御部であり、トルク指令Trefを入力してこれに応じた駆動電流iqを出力してモータ１３を駆動する。１４は検出器であり、モータ速度Vfbrを検出して出力する。１５はモータ動作模擬部であり、前記駆動電流iqを入力し、モータ動作を模擬する数式または等価回路またはブロック図などにより、模擬モータ速度Vfbmを計算して出力する。
モータ動作を模擬する数式の最も簡単な例として、式（１）がある。
いま、モータの回転子慣性モーメントとそのモータが駆動している負荷の慣性モーメントをそのモータの回転軸に換算した慣性モーメントとの和をJ、モータのトルク定数をΦとするとき、
Vfbm＝∫（Φ・iq／J） 式（１）
とする。式（１）において∫は時間積分を表す。
また、もっと高い精度のモータ動作の模擬が要求される場合は、モータの種類やモータの駆動する負荷などの条件を加味して数式または等価回路またはブロック図などを改良してもよい。
１６はモータ速度診断部であり、前記モータ速度Vfbrを入力し、そのモータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、モータの動作が正常か否かを判定してフィードバック切り替え信号SwVfbを出力する。
最も簡略化した判定方法として、前記モータ速度Vfbrの絶対値と通常の動作では到達しないと考えられる高い値に予め設定した閾値Vfbmaxと比較する方法がある。
いま、動作説明の都合上、｜Vfbr｜≧Vfbmaxとなる場合は異常状態と判断してフィードバック信号切り替え指令SwVfbをLoとし、それ以外の場合は正常と判断して前記フィードバック信号切り替え指令SwVfbをHiとすると定義する。
また、別の判定方法として、前記モータ速度Vfbrが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、前記モータ速度Vfbrに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法もある。
なお、モータ速度診断部１６が異常と判断した時点でモータ１３を非常停止するなどの措置をとってもよいが、異常原因を見つけるためには、その際も速度制御部１１および電流制御部１２は動作を継続する。
１７はフィードバック信号切り替え部であり、前記フィードバック信号切り替え指令SwVfbに基づいて速度フィードバック信号Vfbを出力する。フィードバック信号切り替え部１７は、前記フィードバック信号切り替え指令SwVfbがHiであれば前記モータ速度Vfbrを出力し、前記フィードバック信号切り替え指令SwVfbがLoであれば前記模擬モータ速度Vfbmを出力する。
１８は模擬モータ速度診断部であり、前記模擬モータ速度Vfbmを入力し、その模擬モータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、模擬したモータの動作が正常か否かを判定する。
判定方法は、前記モータ速度Vfbrの代わりに前記模擬モータ速度Vfbmを入力して、モータ速度診断部１６と同様の方法がある。
前記模擬モータ速度診断部は自身の判断に基づいて何らかの方法で警報を出す。
【０００８】
次に、模擬モータ速度診断部１８において異常を診断する一つの例について、図２を用いて手順を説明する。図２は、模擬モータ速度診断部１８の内部の処理を示すフローチャートである。図２において、Ｓに続く数値はステップ番号を示す。Ｓ１８１では模擬モータ速度Vfbmを入力する。Ｓ１８２では前記Vfbmの絶対値と閾値Vfbmaxと比較し、|Vfbm|≧Vfbmaxとなる場合はＳ１８３へ進み、それ以外はＳ１８４へ進む。Ｓ１８３では速度制御部または電流制御部に異常原因がある旨の警報を発し、Ｓ１８４では速度制御部および電流制御部以外に異常原因がある旨の警報を発する。なお、前記モータ速度診断部１６と前記模擬モータ速度診断部１８内の異常診断に用いる閾値は互いに違ってもよい。また、モータ速度診断部同様、模擬モータ速度Vfbmが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、前記模擬モータ速度Vfbmに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法を使ってもよい。
【０００９】
次に、本発明の第２実施例について、図３を用いて説明する。図３は、本発明を適用するモータ制御装置のブロック図である。図において、３１は速度制御部であり、モータ速度Vfbを入力し、予め定められた、または時々刻々変化する速度指令と前記モータ速度Vfbが一致するよう速度制御を行いトルク指令Trefを出力する。３２は電流制御部であり、トルク指令Trefを入力してこれに応じた駆動電流iqを出力してモータ３３を駆動する。３４は検出器であり、モータ速度Vfbrを検出して出力する。３５は電流制御模擬部であり、前記トルク指令Trefを入力して、モータの電気特性に合わせて模擬した数式または等価回路またはブロック図などを、電流制御部３２と同等の処理を行って模擬駆動電流iqmを計算して出力する。しかし、一般的には、電流ループの応答は速度ループの応答に比べて非常に速いため、電流ループの閉ループ伝達関数を１と近似することができる。
したがって、
iqm＝Tref 式（２）
としても差し支えない。
３６はモータ動作模擬部であり、前記模擬駆動電流iqｍを入力し、モータ動作を模擬する数式または等価回路またはブロック図などにより、模擬モータ速度Vfbmを計算して出力する。
いま、モータの回転子慣性モーメントとそのモータが駆動している負荷の慣性モーメントをそのモータの回転軸に換算した慣性モーメントとの和をJ,モータのトルク定数をΦとするとき、模擬モータ速度Vfbmは、
Vfbm＝∫（Φ・iqm／J） 式（３）
となり、式（２）より、
Vfbm＝∫（Φ・Tref／J） 式（４）
で求めることができる。式（３）および式（４）において∫は時間積分を表す。模擬モータ速度を、もっと高い精度で得たい場合は、電流ループの閉ループ伝達関数を１と近似せず、モータの種類やモータの駆動する負荷などの条件を考慮した数式または等価回路またはブロック図などを使用して、模擬駆動電流iqmを計算し、さらに、模擬モータ速度を求めてもよい。
３７はモータ速度診断部であり、前記モータ速度Vfbrを入力し、そのモータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、モータの動作が正常か否かを判定してフィードバック切り替え信号SwVfbを出力する。最も簡略化した判定方法として、前記モータ速度Vfbrの絶対値と通常の動作では到達しないと考えられる高い値に予め設定した閾値Vfbmaxと比較する方法がある。
いま、動作説明の都合上、｜Vfbr｜≧Vfbmaxとなる場合は異常状態と判断してフィードバック信号切り替え指令SwVfbをLoとし、それ以外の場合は正常と判断して前記フィードバック信号切り替え指令SwVfbをHiとすると定義する。
また、別の判定方法として、前記モータ速度Vfbrが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、前記モータ速度Vfbrに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法もある。
なお、モータ速度診断部３７が異常と判断した時点でモータ３３を非常停止するなどの措置をとってもよいが、異常原因を見つけるためには、その際も速度制御部３１は動作を継続する。
３８はフィードバック信号切り替え部であり、前記フィードバック信号切り替え指令SwVfbに基づいて速度フィードバック信号Vfbを出力する。フィードバック信号切り替え部３８は、前記フィードバック信号切り替え指令SwVfbがHiであれば前記モータ速度Vfbrを出力し、前記フィードバック信号切り替え指令SwVfbがLoであれば前記模擬モータ速度Vfbmを出力する。
３９は模擬モータ速度診断部であり、前記模擬モータ速度Vfbmを入力し、その模擬モータ速度が通常の動作の範囲内か否かを、常時またはサンプリングして監視し、模擬したモータの動作が正常か否かを判定する。
判定方法は、前記モータ速度Vfbrの代わりに前記模擬モータ速度Vfbmを入力して、モータ速度診断部３７と同様の方法がある。
前記模擬モータ速度診断部は自身の判断に基づいて何らかの方法で警報を出す。
【００１０】
次に、模擬モータ速度診断部３９において異常を診断する一つの例について、図４を用いて手順を説明する。図４は、模擬モータ速度診断部３９の内部の処理を示すフローチャートである。図４において、Ｓに続く数値はステップ番号を示す。Ｓ３９１では模擬モータ速度Vfbmを入力する。Ｓ３９２では前記Vfbmの絶対値と閾値Vfbmaxと比較し、|Vfbm|≧Vfbmaxとなる場合はＳ３９３へ進み、それ以外はＳ３９４へ進む。なお、前記閾値Vfbmaxは通常の動作では到達しないほど高い値に予め設定しておく。Ｓ３９３では速度制御部に異常原因がある旨の警報を発し、Ｓ３９４では速度制御部以外に異常原因がある旨の警報を発する。なお、前記モータ速度診断部３７と前記模擬モータ速度診断部３９内の異常診断に用いる閾値は互いに違ってもよい。また、モータ速度診断部同様、模擬モータ速度Vfbmが異常か否かの判断を、例えば速度指令値の±２０％以内とするなど、速度指令の関数を閾値に設定する方法や、模擬モータ速度Vfbmに対して高速フーリエ変換を行って特定周波数におけるパワースペクトルに閾値を設けるなどの方法を使ってもよい。
本実施例が前記第１の実施例と最も異なる点はモータ動作模擬部が電流制御部の出力信号の代わりに電流制御模擬部の出力信号を使う点にある。この結果、前記電流制御部の影響を受けずにモータの動作を模擬し異常診断を行うので、異常発生時に異常の原因が速度制御部にあるか否かを判断することができる。
【００１１】
【発明の効果】
以上述べたように、本発明のモータ制御装置によれば、メカ部や電流制御部を部分的にモデル化したシミュレータのシミュレーション結果を診断するので、異常発生時に、簡単な判断で異常原因が制御装置のどの部分にあるかを特定でき、かつ多くの記憶領域を必要としないモータ制御装置を提供することができる。
【図面の簡単な説明】
【図１】本発明の実施例を示すブロック図
【図２】図１における模擬モータ速度診断部１８の詳細を示すフローチャート
【図３】本発明の第２実施例を示すブロック図
【図４】図３における模擬モータ速度診断部３９の詳細を示すフローチャート
【図５】従来例を示す図
【符号の説明】
１１、３１ 速度制御部
１２、３２ 電流制御部
１３、３３ モータ
１４、３４ 検出器
１５、３６ モータ動作模擬部
１６、３７ モータ速度診断部
１７、３８ フィードバック信号切り替え部
１８、３９ 模擬モータ速度診断部
３５ 電流制御模擬部
５１ アンプ
５２ ロボット本体
５３ コントローラ
５４ 故障診断部
５５ 波形原因解析部
Claims (2)
- モータ速度に基づいて作成された速度フィードバック信号を入力し、予め定められた、または時々刻々変化する速度指令に前記速度フィードバック信号が一致するよう速度制御を行い、トルク指令を出力する速度制御部と、前記トルク指令を入力し、駆動電流をモータへ出力する電流制御部と、前記モータの位置または速度を検出し、前記モータ速度を出力する検出器と、を備えたモータ制御装置において、
前記モータの回転子慣性モーメントと前記モータが駆動している負荷の慣性モーメントを前記モータの回転軸に換算した慣性モーメントとの和と、前記モータのトルク定数と、前記駆動電流と、に基づいて模擬モータ速度を計算するモータ動作模擬部と、
前記モータ速度を入力し、前記モータ速度または前記モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記モータ速度が正常な状態か否かを判断するモータ速度診断部と、
前記模擬モータ速度を入力し、前記模擬モータ速度または前記模擬モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記模擬モータ速度が正常な状態か否かを判断する模擬モータ速度診断部と、を備え、
前記モータ速度診断部が前記モータ速度を異常と判定すると共に、前記模擬モータ速度診断部が前記模擬モータ速度を異常と判定した場合、前記模擬モータ速度診断部が前記速度制御部または前記電流制御部に異常原因があると判断し、一方、前記模擬モータ速度診断部が前記模擬モータ速度を正常と判定した場合、前記模擬モータ速度診断部が前記速度制御部および前記電流制御部以外に異常原因があると判断することを特徴とするモータ制御装置。 - モータ速度に基づいて作成された速度フィードバック信号を入力し、予め定められた、または時々刻々変化する速度指令に前記速度フィードバック信号が一致するよう速度制御を行い、トルク指令を出力する速度制御部と、前記トルク指令を入力し、駆動電流をモータへ出力する電流制御部と、前記モータの位置または速度を検出し、前記モータ速度を出力する検出器と、を備えたモータ制御装置において、
前記トルク指令を入力して、模擬駆動電流を計算する電流制御模擬部と、
前記モータの回転子慣性モーメントと前記モータが駆動している負荷の慣性モーメントを前記モータの回転軸に換算した慣性モーメントとの和と、前記モータのトルク定数と、前記模擬駆動電流と、に基づいて模擬モータ速度を計算するモータ動作模擬部と、
前記モータ速度を入力し、前記モータ速度または前記モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記モータ速度が正常な状態か否かを判断するモータ速度診断部と、
前記模擬モータ速度を入力し、前記模擬モータ速度または前記模擬モータ速度に基づいて作成された値と予め設定した閾値とを比較することにより前記模擬モータ速度が正常な状態か否かを判断する模擬モータ速度診断部と、を備え、
前記モータ速度診断部が前記モータ速度を異常と判定すると共に、前記模擬モータ速度診断部が前記模擬モータ速度を異常と判定した場合、前記模擬モータ速度診断部が前記速度制御部に異常原因があると判断し、一方、前記模擬モータ速度診断部が前記模擬モータ速度を正常と判定した場合、前記模擬モータ速度診断部が前記速度制御部以外に異常原因があると判断することを特徴とするモータ制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003111753A JP4240208B2 (ja) | 2003-04-16 | 2003-04-16 | モータ制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003111753A JP4240208B2 (ja) | 2003-04-16 | 2003-04-16 | モータ制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004318509A JP2004318509A (ja) | 2004-11-11 |
| JP4240208B2 true JP4240208B2 (ja) | 2009-03-18 |
Family
ID=33472212
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003111753A Expired - Fee Related JP4240208B2 (ja) | 2003-04-16 | 2003-04-16 | モータ制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4240208B2 (ja) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4609052B2 (ja) * | 2004-11-30 | 2011-01-12 | ブラザー工業株式会社 | モータ制御方法及び装置 |
| US20070244683A1 (en) * | 2005-08-19 | 2007-10-18 | Honeywell International Inc. | Device simulating operation of a machine that functions as either a motor or a generator |
-
2003
- 2003-04-16 JP JP2003111753A patent/JP4240208B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004318509A (ja) | 2004-11-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Gaeid et al. | Wavelet fault diagnosis and tolerant of induction motor: A review | |
| Awadallah et al. | Automatic diagnosis and location of open-switch fault in brushless DC motor drives using wavelets and neuro-fuzzy systems | |
| TW202040918A (zh) | 監視裝置、監視方法、伺服放大器、產業用控制器及工具機 | |
| JP2018146436A (ja) | 振動診断システム、振動診断方法及びパラメータ設定方法 | |
| KR20200081591A (ko) | 웨이블릿변환을 이용한 동기전동기의 고장진단방법 | |
| KR20230096030A (ko) | 영구 자석 동기 기계에서의 고정자 턴간 단락 고장의 온라인 모니터링 및 보상 | |
| JP4240208B2 (ja) | モータ制御装置 | |
| Bhatti et al. | Intelligent fault diagnosis mechanism for industrial robot actuators using digital twin technology | |
| CN114487614A (zh) | 一种基于电流能量考虑逆变器功率器件老化状态的在线监测方法 | |
| JP6381850B1 (ja) | 故障診断装置および故障診断方法 | |
| JP2008203962A (ja) | アラーム診断装置および診断方法 | |
| JP2007122575A (ja) | モータ制御装置 | |
| Awadallah et al. | Switch fault diagnosis of PM brushless DC motor drive using adaptive fuzzy techniques | |
| Allen | Simulation and test systems for validation of electric drive and battery management systems | |
| JP2005346455A (ja) | モータ制御装置 | |
| Abed et al. | Fault diagnosis of brushless DC motor for an aircraft actuator using a neural wavelet network | |
| JP2020137327A (ja) | 故障判定装置、モータ駆動システム、及び故障判定方法 | |
| Uyar et al. | Fuzzy logic-based induction motor protection system | |
| CN115077032A (zh) | 压缩机母线电压控制方法、装置及空调器 | |
| JP6541420B2 (ja) | 診断装置、診断方法、及びプログラム | |
| JP4285057B2 (ja) | サーボ制御装置 | |
| JP3420022B2 (ja) | サーボドライバ診断装置 | |
| Awadallah et al. | Adaptive-fuzzy-based stator-winding fault diagnosis of PM brushless DC motor drive by monitoring supply current | |
| Dufour et al. | Using real-time simulation in hybrid electric drive and power electronics development: process, problems and solutions | |
| JP4437697B2 (ja) | 発電設備と電力変換装置との組み合わせ安定性の判別方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060331 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080904 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080910 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20081020 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20081203 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20081216 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120109 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120109 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130109 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150109 Year of fee payment: 6 |
|
| LAPS | Cancellation because of no payment of annual fees |