保護機能を備えた電動機制御装置
【課題】簡易な構成でアラーム停止を回避できる保護機能を備えた電動機制御装置を得ること。
【解決手段】コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、実効負荷率もしくは当該電動機制御装置と前記モータと前記機械との少なくともいずれか一つの温度に関する物理量を観測或いは推測し、過負荷になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過負荷回避動作を行う構成を備えた。
【解決手段】コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、実効負荷率もしくは当該電動機制御装置と前記モータと前記機械との少なくともいずれか一つの温度に関する物理量を観測或いは推測し、過負荷になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過負荷回避動作を行う構成を備えた。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、各種機械を駆動するモータを制御する電動機制御装置に関し、特に保護機能を備えた電動機制御装置に関するものである。
【背景技術】
【０００２】
モータ制御装置としては、サーボアンプやインバータなど各種あるが、本明細書では、サーボアンプを例に挙げて説明する。サーボアンプは、上位コントローラから位置指令あるいは速度指令を受け取り、サーボモータからモータ位置あるいはモータ速度をフィードバック信号として取り込み、モータ位置あるいはモータ速度を指令に追従させるように位置制御あるいは速度制御を行ってサーボモータに電圧を印加することで、サーボモータのモータ位置あるいはモータ速度を制御するように構成される。
【０００３】
ところで、各種機械を駆動するサーボモータは、サーボアンプから供給される駆動電流による発熱などにより加熱される。負荷が大きい場合などにおいてサーボモータに過度な電流が流れた場合、サーボモータは、発熱による焼損や永久磁石の減磁などにより損傷してしまうという問題がある。一方、サーボアンプについても、過度の電流を流れた場合、サーボアンプ内のスイッチング素子が損傷してしまうという問題がある。
【０００４】
そこで、従来では、サーボモータやサーボアンプを損傷してしまわないように、過負荷になる可能性が高まった場合は、過負荷アラームとしてサーボアンプを非常停止することにより、過負荷を防止する保護機能が一般的に備えられている。また、過負荷以外にも、過回生や過電圧・不足電圧などの非常時には、アラームを発生してサーボアンプを非常停止する保護機能が一般的に備えられている。
【０００５】
しかし、このようなサーボアンプを非常停止する措置を講じた場合、ユーザ側では、停止・起動の繰り返しに対応する余分な手間が発生し、停止後再起動するための余分な段取り時間が発生し、アラーム停止による余分な歩留まりが発生し、アラーム停止による機械破損の可能性が発生する、などの問題が起こる。
【０００６】
そのため、極力アラーム非常停止とならないように動作するサーボアンプをユーザに提供できることが望まれており、このような要請に応える種々の提案がなされている（例えば、特許文献１，２等）。
【０００７】
特許文献１では、過負荷になる可能性が高まったと判断した場合、過負荷とならないような速度パターンに修正し、その速度指令にて運転を行う技術が提案されている。具体的には、モータ温度が高くなった場合に、速度指令の加減速時定数を下げて駆動電流を減らすことで、過負荷を防止するという技術である。
【０００８】
また、特許文献２では、過負荷になる可能性が高まったと判断した場合、リミッタを利用し、速度変化もしくは電流リミットを下げて加速度・電流を下げた運転を行う技術が提案されている。
【先行技術文献】
【特許文献】
【０００９】
【特許文献１】特開平１１−１９４８０７号公報
【特許文献２】特開平１１−１２２９６４号公報
【発明の概要】
【発明が解決しようとする課題】
【００１０】
ところが、本発明が対象とするサーボアンプは、一般産業機械用サーボアンプのように、指令パターンを生成する上位コントローラから指令をもらって動作するタイプのサーボアンプである。これに対して、特許文献１に記載の技術は、サーボアンプ内部に速度指令パターン生成部を有する場合の技術であるので、本発明が対象とするサーボアンプでは、利用が困難である。
【００１１】
すなわち、上位コントローラから指令をもらって動作するタイプのサーボアンプに、かりに、特許文献１に記載の技術を適用する場合は、上位コントローラに対し実効負荷率や電流などのデータをリアルタイムに送付し、上位コントローラにて過負荷に関する判断・対策を行う必要がある。
【００１２】
そうすると、上位コントローラでは過負荷判断・対策に遅れが発生し、上位コントローラとサーボアンプとの間のデータ通信量が増加し、上位コントローラのソフトウェア負荷の増大が発生するという問題が起こる。上位コントローラのソフトウェア負荷の増大は、機械ユーザのソフトウェア開発の増大にも繋がり好ましくない。また、特に上位コントローラからパルス列指令を受け取るパルス列タイプのサーボアンプの場合には、これらのデータ送信用に特別な配線を用意する必要があり、省配線の面で望ましくない。
【００１３】
この点、特許文献２に記載の技術では、電流リミットを下げると、駆動電流が減り、結果として過負荷が防止できる。本方式であれば、上位コントローラに依存せずサーボアンプ単体での過負荷回避動作も可能である。また、同様に速度リミットやトルクリミットを行えば過回生アラーム回避動作も可能である。
【００１４】
しかし、リミッタで制限する動作は非線形動作であるので、特許文献２に記載の技術のように、これらをリミッタで制限するという方式を用いた場合には、振動やショックを増大させる可能性がある。また、アウターループ（位置ループなど）を組んだ場合に非線形動作によりハンチングや不安定を引き起こす可能性がある。それらの不安定を防止するた方策としては、リミッタ時の飽和量を再帰計算などで計算しなおしたり、飽和量をフィードバックしたりするなどの手法も存在するが、プログラムが増大・複雑になり、開発に大きな負荷が掛かることや、演算負荷が大きく演算時間が長くなるなど、新たな問題が発生する。
【００１５】
本発明は、上記に鑑みてなされたものであり、簡易な構成でアラーム停止を回避できる保護機能を備えた電動機制御装置を得ることを目的とする。
【課題を解決するための手段】
【００１６】
上述した目的を達成するために、本発明は、コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、実効負荷率もしくは当該モータ制御装置と前記モータと前記機械との少なくともいずれか一つの温度に関する物理量を観測或いは推測し、過負荷になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過負荷回避動作を行う構成を備えたことを特徴とする。
【発明の効果】
【００１７】
本発明によれば、過負荷アラーム停止となるような過負荷の発生を予知した場合、待機時間を引き延ばすようにしたので、サイクルタイムが長くなり、実効負荷率を下げる方向に動作させることができ、簡易な構成で過負荷アラーム停止を回避することができるという効果を奏する。
【図面の簡単な説明】
【００１８】
【図１】図１は、この発明の実施の形態１による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【図２】図２は、図１に示す過負荷回避回路の構成例を示すブロック図である。
【図３】図３は、通常モード時と過負荷回避モード時とでの動作内容を比較して示す動作波形の一例を示す応答波形図である。
【図４】図４は、図１に示す過負荷回避回路の他の構成例（シーケンス構成例）を説明するフローチャートである。
【図５】図５は、この発明の実施の形態２による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【図６】図６は、この発明の実施の形態３による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【図７】図７は、この発明の実施の形態４による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【発明を実施するための形態】
【００１９】
以下に、本発明にかかる保護機能を備えた電動機制御装置の実施の形態を図面に基づいて詳細に説明する。なお、この実施の形態により本発明が限定されるものではない。
【００２０】
実施の形態１．
図１は、本発明の実施の形態１による保護機能を備えた電動機制御装置の構成を示すブロック図である。図１において、まず、上位コントローラ１と、本実施の形態１による保護機能を備えた電動機制御装置であるサーボアンプ２ａと、位置検出器３ａが取り付けられているサーボモータ３との関係を説明する。
【００２１】
上位コントローラ１は、位置指令ａをサーボアンプ２ａに出力する。サーボアンプ２ａは、位置指令ａに、サーボモータ３からフィードバックされる位置検出器３ａにて検出されたモータ位置ｂが追従するようにサーボモータ３を駆動する。
【００２２】
サーボアンプ２ａは、位置決め動作が完了すると、位置決め完了信号ｃを上位コントローラ１に送信する。上位コントローラ１は、位置決め完了信号ｃを受け取ると、サーボアンプ２ａの動作完了を認識し、次の動作シーケンスへと移り、サーボアンプ２ａないしは他のサーボアンプへ位置指令を出力する。これの繰り返しにより、図示しない各種の機械が所望の状態に制御される。
【００２３】
さて、サーボアンプ２ａは、一般には、位置偏差演算器４、位置制御部５、速度演算器６、速度偏差演算器７、速度制御部８、トルク制御部９、および位置決め完了判定部１０を備えているが、本実施の形態１では、過負荷アラーム停止を回避する手段として、過負荷回避回路１１と、遅延回路１２とを追加して設けてある。
【００２４】
位置偏差演算器４は、上位コントローラ１から得られる位置指令ａとサーボモータ３の位置検出器３ａからフィードバックされたモータ位置ｂとから位置偏差ｄを演算して出力する。位置制御部５は、位置偏差ｄに基づいて位置制御を行って速度指令ｅを出力する。速度演算器６は、フィードバックされたモータ位置ｂに擬似微分演算などを実施してモータ速度ｆを演算して出力する。
【００２５】
速度偏差演算器７は、位置制御出力である速度指令ｅとモータ速度ｆとから速度偏差ｇを演算して出力する。速度制御部８は、速度偏差ｇを受けて速度制御を行い、トルク指令ｈを出力する。トルク制御部９は、トルク指令ｈを受けて電流制御を行い、トルク指令ｈ通りにモータ３が動くように駆動電圧を供給する。
【００２６】
位置決め完了判定部１０は、位置指令ａとモータ位置ｂとの偏差を取ってドループ信号を作成し、そのドループ信号がドループ基準範囲内に入っているか否かを判定した位置決め完了信号ｉを出力する。
【００２７】
ここで、過負荷回避回路１１は、実効負荷率ｊを入力とし、例えば、図２や図４に示す構成によって、過負荷回避動作時に、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間の生成を行い、生成した遅延時間ｋを遅延回路１２に出力する。
【００２８】
遅延回路１２は、過負荷回避回路１１からの遅延時間ｋがゼロである場合は、遅延処理を行わず、位置決め完了判定部１０からの位置決め完了信号ｉをそのまま位置決め完了信号ｃとしてコントローラ１へ出力する。一方、過負荷回避回路１１からの遅延時間ｋがゼロではなく、或る値（Ｔｄｉ）である場合は、遅延回路１２は、位置決め完了判定部１０からの位置決め完了信号ｉを遅延時間Ｔｄｉだけ遅延させた位置決め完了信号ｃをコントローラ１へ出力する遅延処理を行う。
【００２９】
次に、図２は、図１に示す過負荷回避回路１１の構成例を示すブロック図である。過負荷回避回路１１は、例えば図２に示すように、実効負荷率偏差演算部１３と、スイッチ部１４と、実効負荷率制御部１５と、制限器１６とを備えている。
【００３０】
実効負荷率偏差演算部１３は、実効負荷率基準値ｍと実効負荷率ｊとの実効負荷率偏差ｎを演算して出力する。なお、実効負荷率基準値ｍとしては、事前に過負荷非常停止となるレベルよりも低い値が設定されている。スイッチ部１４は、過負荷回避動作のオン（実行：過負荷回避モード）／オフ（非実行：通常モード）を決定する。実効負荷率制御部１５は、例えばＰＩ制御などを行って、実効負荷率偏差ｎに応じて、位置決め完了決定部１０が決定した位置決め完了信号ｉの送出を遅延させる遅延時間量ｐを決定する。制限器１６は、入力される遅延時間量ｐに遅延時間の制限範囲を適用した遅延時間ｋを遅延回路１２に出力する。
【００３１】
次に、図３をも参照して、動作について説明する。なお、図３は、通常モード時と過負荷回避モード時とでの動作内容を比較して示す動作波形の一例を示す応答波形図である。図３では、（ａ）過負荷アラーム停止が起こらない運転状態である通常モード時の応答波形と、（ｂ）過負荷アラーム停止が起こる可能性が高い運転状態の場合に行われる過負荷回避モード時の応答波形とが示されている。
【００３２】
実効負荷率ｊに目立った上昇気配が無く実効負荷率基準値ｍ以下であり、過負荷アラーム停止が起こるような過負荷になる可能性の低い通常モード時では、過負荷回避回路１１では、スイッチ部１４がオフしていて後段の実効負荷率制御部１５以降は動作しない。遅延回路１２は、過負荷回避回路１１からの遅延時間ｋがゼロであり遅延処理を行わない。そのため、位置決め完了判定部１０が判定した位置決め完了信号ｉが、そのまま位置決め完了信号ｃとしてサーボアンプ２ａの位置決めが完了すると同時に出力される。
【００３３】
図３（ａ）において、通常モード時では、速度指令２０に少し遅れて実速度２１が追従し、速度指令払出完了２２から若干時間の経過後に実速度２１がほぼ零２３に収束する。位置指令ａとモータ位置ｂとの位置偏差ｄであるドループ信号も同様の動作をするため、速度指令払出完了２２から若干時間の経過後にドループ信号がドループ基準範囲内に収束し、実速度２１がほぼ零２３に収束するタイミングで、位置決め完了信号ｃが低レベルから高レベルに立ち上がる。これによって、上位コントローラ１は、位置決め完了信号ｃの入力を認識し、次の動作シーケンスへ移行し、新たな位置指令ａをサーボアンプ２ａに出力する。
【００３４】
一方、上位コントローラ１から適切でない位置指令ａが入ってきた場合や、負荷が増大した場合、あるいは主回路電圧が低下した場合などにより、実効負荷率ｊが実効負荷率基準値ｍを超えて上昇し、過負荷アラーム停止が起こるような過負荷になる可能性が高まった場合は、過負荷回避回路１１では、スイッチ部１４がオンとなって、後段の実効負荷率制御部１５が動作し、過負荷回避モードとなる。
【００３５】
過負荷回避モードでは、実効負荷率制御部１５にて位置決め完了信号ｉに与える遅延時間量ｐが決定され、制限器１６にて上下限の制限処理されたゼロでない遅延時間ｋが遅延回路１２に出力され、遅延回路１２にて位置決め完了信号ｉを遅延時間ｋだけ遅延させて位置決め完了信号ｃとする動作（過負荷回避動作）が行われる。
【００３６】
具体的に説明する。図２において、過負荷アラーム停止が起こるような過負荷になる可能性が高まると、実効負荷率基準値ｍに対し実効負荷率ｊが大きな値となるため、実効負荷率偏差ｎは負の値となる。そこで、実効負荷率制御部１５は、実効負荷率ｊが下がるように位置決め完了信号ｉに与える遅延時間量ｐを増大する方向に制御する。
【００３７】
そうすると、図３（ｂ）において、通常モード時では速度指令払出完了２２から若干時間の経過後に実速度２１がほぼ零２３に収束するタイミングで低レベルから高レベルに立ち上がっていた位置決め完了信号ｃが、過負荷回避モード時では、過負荷回避回路１１から得られた遅延時間ｋ＝Ｔｄｉだけ遅延させたタイミングで低レベルから高レベルに立ち上がる位置決め完了信号ｃとして出力される。これによって、上位コントローラ１は、位置決め完了信号ｃの入力を遅延時間ｋ＝Ｔｄｉだけ遅れて認識することになり、次の位置指令ａの入力時期が通常モード時よりも遅延時間ｋ＝Ｔｄｉだけ遅れることになる。
【００３８】
このように、位置決め完了信号ｉの送出を遅延させると、上位コントローラ１から次の位置指令ａが入力されるまでの待機時間が通常モード時よりも長くなる。その結果、実効負荷率ｊが下がり、実効負荷率基準値ｍを下回ることとなり、実効負荷率偏差ｊは正の値となる。これにより、実効負荷率制御部１５は、今度は実効負荷率ｊが上がるように、位置決め完了信号ｉに与える遅延時間量ｐを減らす方向に制御する。位置決め完了信号ｉの送出を遅延させる時間が前回よりも少し短くなる。以上の動作が繰り返されて、実効負荷率ｊは、実効負荷率基準値ｍに近づくように、位置決め完了信号ｉに与える遅延時間量ｐが増減制御される。
【００３９】
要するに、サーボアンプ２ａでは、過負荷回避モードになると、各動作シーケンスにおける位置指令ａの入力を待機する時間が延びることになる。その結果、図３（ａ）（ｂ）に示すように、サーボアンプ２ａの過負荷回避モード時でのサイクルタイム２５は、通常モード時でのサイクルタイム２４から、遅延時間Ｔｄｉだけ増加することになる。サーボアンプ２ａでは、サイクルタイムが引き延ばされると、その分だけ実効負荷率が下がることになるので、過負荷アラーム停止となるような過負荷が起こる状況でも、過負荷アラーム停止が回避されることになる。
【００４０】
次に、過負荷回避回路１１の他の構成例を説明する。図２は、過負荷回避回路１１が過負荷回避動作を線形制御的に行う場合の構成例であるが、例えば図４に示すように、過負荷回避回路１１は、過負荷回避動作をシーケンス制御的に行う構成も可能である。なお、図４は、図１に示す過負荷回避回路１１の他の構成例（シーケンス構成例）を説明するフローチャートである。図４では、各処理ステップは、符号Ｓを付して表してある。
【００４１】
図４において、最初のＳ１では、事前に何らかの方法で設定されている過負荷回避モード突入レベル・回避レベルを入力する。そして、電流値等から演算された実効負荷率を観測し（Ｓ２）、現在の動作状態が過負荷回避モード中か否かを判断する（Ｓ３）。Ｓ３での判断結果、過負荷回避モード中で無い場合（Ｓ３：Ｎｏ）は、実効負荷率が回避モード突入レベルよりも大きいか否かを判断する（Ｓ４）。
【００４２】
Ｓ４での判断結果、実効負荷率が回避モード突入レベルよりも小さい場合（Ｓ４：Ｎｏ）は、遅延時間の生成を行わずに本手順を終了し、通常モードを継続する。一方、Ｓ４での判断結果、実効負荷率が回避モード突入レベルよりも大きい場合（Ｓ４：Ｙｅｓ）は、過負荷回避モードに突入し（Ｓ５）、送出する位置決め完了信号を遅延させる処理を行い（Ｓ６）、本手順を終了する。
【００４３】
ここで、Ｓ６での遅延時間は、現行運転パターンでの、ある時定数期間における実効負荷率の低減率と位置決め回数などに基づいて必要な遅延時間を推測して設定すればよい。例えば、ある時定数期間Ｔ０での位置決め回数をＮ回とし、そのときの実効負荷率をＪとし、実効負荷率Ｊをα％低減させた実効負荷率Ｊ’＝α／１００×Ｊとするための遅延時間Ｔｄｉは、次の式（１）で求めることが可能である。
Ｔｄｉ＝｛（１００／α）２−１｝Ｔ０／Ｎ …（１）
【００４４】
但し、式（１）は、停止中の実効負荷がおよそ無視できる場合に適用されるので、上下軸などのアンバランストルクがある場合や静止摩擦が大きい場合など、停止時に何らかのトルクを発生させているケースではその分の補正が必要となる。
【００４５】
また、先のＳ３の判断において、過負荷回避モード中である場合（Ｓ３：Ｙｅｓ）、実効負荷率が回避モード離脱レベルよりも大きいか否かを判断する（Ｓ７）。その結果、実効負荷率が回避モード離脱レベルを超過している場合（Ｓ７：Ｙｅｓ）は、過負荷回避モードでの動作を継続し、本手順を終了する。
【００４６】
その結果、Ｓ１〜Ｓ３を経由したＳ７において、実効負荷率が回避モード離脱レベルよりも小さくなった場合（Ｓ７：Ｎｏ）は、過負荷回避モードを離脱し（Ｓ８）、遅延時間を元の値に戻し（Ｓ９）、本手順を終了する。このようなシーケンスを行えば、過負荷回避モードへの突入・離脱を繰り返すチャタリングを発生させること無しに、サイクルタイムを引き延ばす過負荷回避動作を行うことが可能となる。
【００４７】
このように、本実施の形態１によれば、過負荷アラーム停止となるような過負荷の発生を予知した場合、位置決め完了の通知を遅延させ待機時間を引き延ばすようにしたので、サイクルタイムが長くなり、実効負荷率を下げる方向に動作させることができ、過負荷アラーム停止を回避することができる。
【００４８】
このとき、サーボアンプ単体で過負荷対策ができるので、コントローラは過負荷を意識する必要が無い。したがって、コントローラの負荷削減、コントローラのユーザソフトウェア作成の簡易化、構成の単純化、コントローラとサーボアンプとの間のデータ通信量削減などを実現できる。
【００４９】
また、待機時間を引き延ばす方式であれば、サーボアンプ単体でトルク制限や速度制限する方法と違って線形動作するので、ショックや振動は発生しない。不安定・ハンチングを発生させない。サーボアンプの構成が単純、演算量が少ないなどの効果がある。
【００５０】
さらに、サーボモータの動き方自体が変わらないため、特性変動の心配が無い。次のサイクルタイムでの過負荷アラーム停止を回避することができる。サーボモータは、とりあえず指令どおりに動作するので、例えば他軸と同期・補間動作を行っている場合に同期性が損なわれにくいなどの効果もある。
【００５１】
なお、本実施の形態１では、遅延回路１２を用いて位置決め完了信号ｉを遅延させて位置決め完了信号ｃとする場合を説明したが、遅延の形態は、これに限定されるものではない。例えば、遅延回路１２を用いずに、過負荷回避回路１１が生成した遅延時間ｋを位置決め完了判定部１０に与え、位置決め完了判定部１０において、遅延時間ｋに応じて、ドループ基準範囲を狭くしたり、ドループ演算値自体を遅延させたりする方法など、故意に遅延時間を生成する方法であればいかなる方法でも構わない。
【００５２】
また、実効負荷率演算は、通常ばらつきを抑えるために長い時定数のフィルタを用いて演算されるが、フィルタ時定数分だけアラーム回避動作が遅れてしまう場合は、別途短い時定数フィルタを準備し、フィルタを準備した短い時定数フィルタに切り替えて、その短い時定数フィルタを用いて計算した実効負荷率を用いてアラーム回避動作を行えばよい。
【００５３】
実施の形態２．
図５は、本発明の実施の形態２による保護機能を備えた電動機制御装置の構成を示すブロック図である。なお、図５では、図１（実施の形態１）に示した構成要素と同一ないしは同等である構成要素には同一の符号が付されている。ここでは、本実施の形態２に関わる部分を中心に説明する。
【００５４】
本実施の形態２では、遅延する対象を位置指令に変更した場合について説明する。すなわち、図５に示すように、本実施の形態２による保護機能を備えた電動機制御装置であるサーボアンプ２ｂでは、図１（実施の形態１）に示した構成において、過負荷回避回路１１と遅延回路１２とを削除し、位置決め完了判定部１０が判定した位置決め完了信号をそのまま位置決め完了信号ｃとして上位コントローラに出力する。その代わり、上位コントローラからの位置指令ａを遅延させて取り込む遅延回路２７と、過負荷回避回路２８とが設けられている。
【００５５】
過負荷回避回路２８は、実施の形態１にて説明した内容の実効負荷率ｊを入力とし、上位コントローラからの位置指令ａに与える遅延時間の変更を行い、変更した遅延時間ｋを遅延回路２７に出力する。なお、位置指令ａに与える遅延時間の変更は、例えば、マルチタップの遅延ブロックから必要な箇所のデータを取り出すなどの方法で実現可能である。
【００５６】
遅延回路２７は、過負荷回避回路２８からの遅延時間ｋがゼロである場合は、上位コントローラからの位置指令ａをそのまま位置偏差演算器４と位置決め完了判定部１０とに出力するが、過負荷回避回路２８からの遅延時間ｋがゼロでなく或る値Ｔ１を有する場合には、位置指令ａを遅延時間Ｔ１だけ遅延させて位置偏差演算器４と位置決め完了判定部１０とに出力する。
【００５７】
この構成では、過負荷回避動作時に位置偏差演算器４と位置決め完了判定部１０とは、それぞれ、遅延回路２７にて遅延された位置指令を用いて偏差の演算を行う。但し、位置決め完了判定部１０は、遅延前の位置指令ａを用いてもよい。
【００５８】
以上のように位置指令ａの取り込みを遅延させる場合でも、その遅延分だけ位置指令を受け取ってから位置決め完了信号を吐き出すまでの時間が延びることになり、待機時間を引き延ばすことができる。その結果、実施の形態１と同様に、サイクルタイムが延びることにより、実効負荷率が下がるため、過負荷アラーム停止となる過負荷が起こる状況であっても、過負荷アラーム停止を回避することが可能になる。
【００５９】
このように、本実施の形態２では、過負荷アラーム停止となるような過負荷の発生を予知した場合、位置指令の取り込みを遅延させて待機時間を引き延ばすようにしたので、実施の形態１と同様に、サイクルタイムが長くなり、実効負荷率を下げる方向に動作させることができ、過負荷アラーム停止を回避することができる。
【００６０】
加えて、本実施の形態２では、実施の形態１に比べて次のような効果が得られる。
（１）実施の形態１では、位置決め完了信号を遅延させるので、動作してからの待ち時間が長くなるのに対し、本実施の形態２では、位置指令を遅延させるので、待ってから動作を行うことになり、実効負荷率が早めに下がり、過負荷回避動作時間が短くなる効果が得られる。
【００６１】
（２）また、ある運転サイクル中に過負荷回避モードに入った場合に、自軸の次サイクルの動作が遅延されることになるので、（今回サイクルの後の）他軸の動作は遅らせることなく継続して動作完了できる効果も得られる。この点、実施の形態１では、位置決め完了信号を遅延させるので、（自軸の今回サイクルの後の）他軸の動作が遅延させられてしまうことが起こるという難点がある。
【００６２】
（３）さらに、もし自軸のサーボアンプの動作開始を待って他の軸と同期を行うようなシーケンスが組まれていたケースの場合、本実施の形態２による方が、同期性を損なわないという効果も発生する。
【００６３】
実施の形態３．
図６は、本発明の実施の形態３による保護機能を備えた電動機制御装置の構成を示すブロック図である。なお、図６では、図１（実施の形態１）に示した構成要素と同一ないしは同等である構成要素には同一の符号が付されている。ここでは、本実施の形態３に関わる部分を中心に説明する。
【００６４】
図６において、本実施の形態３による保護機能を備えた電動機制御装置であるサーボアンプ２ｃでは、図１（実施の形態１）に示した構成において、実効負荷率ｊを入力とする過負荷回避回路１１に代えて、回生負荷率ｒを入力とする過回生回避回路３１が設けられている。
【００６５】
過回生回避回路３１に入力される回生負荷率ｒは、例えば、回生コンバータの回生電流や回生トランジスタのオン／オフの回数・デューティーなどを基に逐次計算されるものである。過回生回避回路３１は、過負荷回避回路１１と同様の考えで、過回生回避動作を行うものであり、図２や図４に示した構成と類似の構成を有している。
【００６６】
次に、動作について説明する。過回生回避回路３１は、入力される回生負荷率ｒに目立った上昇気配がなく基準値を下まわり、過回生アラーム停止となるような過回生になる可能性が低い場合には、過回生回避動作を行わず、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成しないので、遅延回路１２への遅延時間ｋはゼロである。つまり、遅延回路１２は、位置決め完了判定部１０が判定した位置決め完了信号ｉをそのまま位置決め完了信号ｃとして出力する。
【００６７】
このように、過回生アラーム停止となるような過回生とならない通常の動作の場合は、位置決め完了判定部１０が判定した位置決め完了信号ｉは、サーボアンプ２ｃの位置決めが完了すると同時に出力される。
【００６８】
一方、過回生回避回路３１は、入力される回生負荷率ｒが基準値を超えて上昇し、過回生アラーム停止となるような過回生になる可能性が高くなった場合には、過回生回避動作を行い、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成し、生成したゼロでない遅延時間ｋを遅延回路１２に出力する。
【００６９】
これによって、上位コントローラ１に出力される位置決め完了信号ｃは、位置決め完了判定部１０が判定した位置決め完了信号ｉに、過回生回避回路３１にて生成された遅延時間ｋだけの遅延処理が施された信号となる。
【００７０】
上位コントローラ１は、サーボアンプ２ｃの位置決め完了信号ｃを待って次の動作シーケンスへと移行するので、サーボアンプ２ｃでは、次の動作シーケンスにおける位置指令ａの入力を待機する時間が延びることになる。その結果、サーボアンプ２ｃの過回生回避動作時でのサイクルタイムは、通常の過回生とならないような動作時よりも増加することになる。サーボアンプ２ｃでは、サイクルタイムが引き延ばされると、回生負荷率が下がることになり、過回生アラーム停止となるような過回生が起こる状況でも、過回生アラーム停止が回避されることになる。
【００７１】
このように、本実施の形態３によれば、過回生アラーム停止となるような過回生の発生を予知した場合、位置決め完了の通知を遅らせて待機時間を引き延ばすようにしたので、サイクルタイムが長くなり、回生負荷率を下げる方向に動作させることができ、過回生アラーム停止を回避することができる。
【００７２】
このとき、サーボアンプ単体で過回生対策ができるので、コントローラは過回生を意識する必要が無い。したがって、コントローラの負荷削減、コントローラのユーザソフトウェア作成の簡易化、構成の単純化、コントローラとサーボアンプとの間のデータ通信量削減などを実現できる。
【００７３】
また、待機時間を引き延ばす方式であれば、サーボアンプ単体でトルク制限や速度制限する方法と違い、線形動作するのでショックや振動が発生しない。不安定・ハンチングを発生させない。サーボアンプの構成が単純、演算量が少ないなどの効果がある。
【００７４】
さらに、サーボモータの動き方自体が変わらないため、特性変動の心配が無い。次のサイクルタイムでの過回生アラーム停止を回避することができる。サーボモータは、とりあえず指令どおりに動作するので、例えば他軸と同期・補間動作を行っている場合に同期性が損なわれにくいなどの効果もある。
【００７５】
なお、本実施の形態３では、遅延回路１２を用いて位置決め完了信号ｉを遅延させて位置決め完了信号ｃとする場合を説明したが、遅延の形態は、これに限定されるものではない。例えば、遅延回路１２を用いずに、過回生回避回路３１が生成した遅延時間ｋを位置決め完了判定部１０に与え、位置決め完了判定部１０において、遅延時間ｋに応じて、ドループ基準範囲を狭くしたり、ドループ演算値自体を遅延させたりする方法など、故意に遅延時間を生成する方法であればいかなる方法でも構わない。
【００７６】
実施の形態４．
図７は、本発明の実施の形態４による保護機能を備えた電動機制御装置の構成を示すブロック図である。なお、図７では、図１（実施の形態１）に示した構成要素と同一ないしは同等である構成要素には同一の符号が付されている。ここでは、本実施の形態４に関わる部分を中心に説明する。
【００７７】
図７において、本実施の形態４による保護機能を備えた電動機制御装置であるサーボアンプ２ｄでは、図１（実施の形態１）に示した構成において、実効負荷率ｊを入力とする過負荷回避回路１１に代えて、母線電圧などの主回路電圧ｓを入力とする電圧アラーム回避回路４１が設けられている。
【００７８】
電圧アラーム回避回路４１は、過負荷回避回路１１と同様の考えで、過電圧・不足電圧の回避動作を行うものであり、図２や図４に示した構成と類似の構成を有している。
【００７９】
次に、動作について説明する。電圧アラーム回避回路４１は、入力される主回路電圧ｓに目立った上昇変化・下降変化の気配がなく、過電圧・不足電圧になる可能性が低い場合には、遅延処理を行う電圧アラーム回避動作を行わず、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成しないので、遅延回路１２への遅延時間ｋはゼロである。つまり、遅延回路１２は、位置決め完了判定部１０が判定した位置決め完了信号ｉをそのまま位置決め完了信号ｃとして出力する。
【００８０】
このように、過電圧・不足電圧とならないような通常の動作の場合は、位置決め完了判定部１０が判定した位置決め完了信号ｉは、サーボアンプ２ｄの位置決めが完了すると同時に出力される。
【００８１】
一方、電圧アラーム回避回路４１は、入力される主回路電圧ｓが基準値を超えて上昇し、過電圧になる可能性が高くなった場合には、遅延処理を行う過電圧回避動作を行い、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成し、生成したゼロでない遅延時間ｋを遅延回路１２に出力する。
【００８２】
これによって、上位コントローラ１に出力される位置決め完了信号ｃは、位置決め完了判定部１０が判定した位置決め完了信号ｉに、電圧アラーム回避回路４１にて生成された遅延時間ｋだけの遅延処理が施された信号となる。
【００８３】
上位コントローラ１は、サーボアンプ２ｄからの位置決め完了信号ｃを待って次の動作シーケンスへと移行するので、サーボアンプ２ｄでは、次の動作シーケンスにおける位置指令ａの入力を待機する時間が延びることになる。サーボアンプ２ｄでは、待機時間内はサーボ動作を行わないため、高くなりかけた主回路電圧ｓが抑制されることになり、次の運転サイクルにおいて過電圧となる可能性を下げることが可能になる。
【００８４】
なお、図７では示していないが、過電圧になる可能性が高くなった場合、過電圧アラーム回避信号を上位コントローラ１に送信し、上位コントローラ１が過電圧の発生を回避するように、動作シーケンスや指令パターンの変更を行うという手法も可能である。
【００８５】
また、電圧アラーム回避回路４１は、入力される主回路電圧ｓが瞬停などで基準値以下に下降し、不足電圧になる可能性が高くなった場合は、遅延処理を行う不足電圧回避動作が行われ、上記と同様に位置決め完了信号ｉの遅延処理が行われる。その結果、遅延処理による待機時間の間はサーボ運転を行わないため、電力消費が減り、主回路電圧ｓの低下を減少させることができ、次の運転サイクルにおいて、不足電圧となる可能性を下げることが可能となる。
【００８６】
なお、図７では示していないが、不足電圧になる可能性が高くなった場合、不足電圧アラーム回避信号を上位コントローラに送信し、上位コントローラが不足電圧の発生を回避するように、動作シーケンスや指令パターンの変更を行うという手法も可能である。
【００８７】
ここで、図７では、電圧アラーム回避回路４１は、主回路電圧を監視する場合を示したが、電圧値自体を検出する手段を有しない場合などにおいては、主回路電圧が過電圧の閾値レベルを超過したことを判断するフラグや、不足電圧の閾値レベルを下回ったことを判断するフラグを監視するようにしてもよい。
【００８８】
なお、本実施の形態４では、遅延回路１２を用いて位置決め完了信号ｉを遅延させて位置決め完了信号ｃとする場合を説明したが、遅延の形態は、これに限定されるものではない。例えば、遅延回路１２を用いずに、電圧アラーム回避回路４１が生成した遅延時間ｋを位置決め完了判定部１０に与え、位置決め完了判定部１０において、遅延時間ｋに応じて、ドループ基準範囲を狭くしたり、ドループ演算値自体を遅延させたりする方法など、故意に遅延時間を生成する方法であればいかなる方法でも構わない。
【００８９】
このように、本実施の形態４によれば、過電圧アラーム停止となるような過電圧の発生を予知した場合や、不足電圧アラーム停止となるような不足電圧の発生を予知した場合には、位置決め完了の通知を遅らせて待機時間を引き延ばすようにしたので、主回路電圧の上昇を抑える、或いは、主回路電圧の減少を少なくすることができ、次運転サイクルでの過電圧アラーム停止や不足電圧アラーム停止を回避することができる。
【００９０】
このとき、サーボアンプ単体で過電圧・不足電圧対策ができるので、コントローラは過電圧・不足電圧を意識する必要が無い。したがって、コントローラの負荷削減、コントローラのユーザソフトウェア作成の簡易化、構成の単純化、コントローラとサーボアンプとの間のデータ通信量削減などを実現できる。
【００９１】
また、待機時間を引き延ばす方式であれば、サーボアンプ単体でトルク制限や速度制限する方法と違い、線形動作するのでショックや振動は発生しない。不安定・ハンチングを発生させない。サーボアンプの構成が単純、演算量が少ないなどの効果がある。
【００９２】
さらに、サーボモータの動き方自体が変わらないため、特性変動の心配が無い。次のサイクルタイムでの過電圧・不足電圧のアラーム停止を回避することができる。サーボモータは、とりあえず指令どおりに動作するので、例えば他軸と同期・補間動作を行っている場合に同期性が損なわれにくいなどの効果もある。
【００９３】
ここで、本発明は、以上説明した実施の形態１〜４に限定されるものではなく、以下に示す各種の態様が可能である。
【００９４】
（１）実施の形態１に対して実施の形態２があるように、本実施の形態３，４に対しても実施の形態２と同様の考えで、位置指令を取り込んでから実際に起動する時間を遅延させて待機時間を引き延ばすようにしてもよい。
【００９５】
（２）実施の形態１〜４では、位置制御モードの場合における説明をしているが、速度制御モードや圧力制御モードなどの場合においても同様の動作が可能である。例えば、速度制御モードの場合には、位置指令の代わりに速度指令を用い、位置決め完了信号の代わりに、零速度近傍になったことを検出する零速度検出信号もしくはモータ速度が指令速度に到達したことを検出する速度到達信号（速度一致検出信号）を用いればよい。速度指令ないしは零速度検出信号、速度到達信号を遅延させることで同様の動作を実現できる。
【００９６】
（３）実施の形態１，２では、過負荷回避回路への入力は実効負荷率を用いているが、実効負荷率の２乗や推定した負荷率を用いても、過負荷回避動作を行うことが可能である。また、サーボモータやエンコーダ、サーボアンプ、機械などの温度に関連する様々な観測値ないしは推定値を用いても、過負荷回避動作を行うことが可能である。
【００９７】
（４）実施の形態１〜４では、サーボアンプのタイプとして、上位コントローラから位置指令・速度指令を受け取って動作するタイプを対象に説明したが、本発明は、上位コントローラから目標位置や起動信号などを受け取りサーボアンプ内部にて指令パターンを生成する位置決め内蔵タイプなどにも同様に適用することができる。
【００９８】
この位置決め内蔵タイプなどのサーボアンプを用いる場合は、サーボアンプ内部にて指令を生成するため、起動タイミングを遅らせる動作を実現しようとした場合、起動信号を遅らせるだけでよく、実施の形態２のように指令を遅らせるよりも簡易な回路で遅延処理を行うことができる。
【００９９】
（５）また、位置決め内蔵タイプなどのサーボアンプを用いる場合では、サーボアンプ内部で指令パターンを変更することで過負荷・過回生などのアラーム回避を行うことも可能である。この場合、本発明は、動作開始・終了の待ち時間を変更するのみであり、モータの動き方は変わらないため、指令パターンを変更する方式と比較して、特性変動の心配が無いという点で望ましい。また、両者を併用することももちろん可能である。
【０１００】
（６）実施の形態１〜４では、サーボアンプを例に挙げて説明したが、インバータなどその他のモータ制御装置でも同様に適用可能であることはいうまでもない。
【０１０１】
（７）実施の形態１〜４では、遅延時間の大きさをサーボアンプ内で決定しているが、上位コントローラにアラーム回避モードの要否を送信し、上位コントローラから遅延時間を指定してもらう手法も可能である。同期や補間などを行う機械では、他軸との連動が必要であることから上位コントローラで遅延時間を決定できることが望ましい。もちろん、遅延時間をサーボアンプ内にて決定し上位コントローラに送信するという方法や、事前にサーボアンプに設定した遅延時間を上位コントローラにおいて認識しておき、サーボアンプがアラーム回避モードに入ったことを上位コントローラに知らせるという方法などでもよい。
【０１０２】
（８）また、実施の形態１〜４は、組み合わせての利用も可能であることはいうまでもない。
【産業上の利用可能性】
【０１０３】
以上のように、本発明にかかるモータ制御装置は、簡易な構成でアラーム停止を回避できる保護機能を備えたモータ制御装置として有用である。
【符号の説明】
【０１０４】
１ コントローラ
２ａ，２ｂ，２ｃ，２ｄ サーボアンプ
３ サーボモータ（電動機）
３ａ 位置検出器
４ 位置偏差演算器
５ 位置制御部
６ 速度演算器
７ 速度偏差演算器
８ 速度制御部
９ トルク制御部
１０ 位置決め完了判定部
１１，２８ 過負荷回避回路
１２，２７ 遅延回路
１３ 実効負荷率偏差演算部
１４ スイッチ部
１５ 実効負荷率制御部
１６ 制限器
３１ 過回生回避回路
４１ 電圧アラーム回避回路
【技術分野】
【０００１】
本発明は、各種機械を駆動するモータを制御する電動機制御装置に関し、特に保護機能を備えた電動機制御装置に関するものである。
【背景技術】
【０００２】
モータ制御装置としては、サーボアンプやインバータなど各種あるが、本明細書では、サーボアンプを例に挙げて説明する。サーボアンプは、上位コントローラから位置指令あるいは速度指令を受け取り、サーボモータからモータ位置あるいはモータ速度をフィードバック信号として取り込み、モータ位置あるいはモータ速度を指令に追従させるように位置制御あるいは速度制御を行ってサーボモータに電圧を印加することで、サーボモータのモータ位置あるいはモータ速度を制御するように構成される。
【０００３】
ところで、各種機械を駆動するサーボモータは、サーボアンプから供給される駆動電流による発熱などにより加熱される。負荷が大きい場合などにおいてサーボモータに過度な電流が流れた場合、サーボモータは、発熱による焼損や永久磁石の減磁などにより損傷してしまうという問題がある。一方、サーボアンプについても、過度の電流を流れた場合、サーボアンプ内のスイッチング素子が損傷してしまうという問題がある。
【０００４】
そこで、従来では、サーボモータやサーボアンプを損傷してしまわないように、過負荷になる可能性が高まった場合は、過負荷アラームとしてサーボアンプを非常停止することにより、過負荷を防止する保護機能が一般的に備えられている。また、過負荷以外にも、過回生や過電圧・不足電圧などの非常時には、アラームを発生してサーボアンプを非常停止する保護機能が一般的に備えられている。
【０００５】
しかし、このようなサーボアンプを非常停止する措置を講じた場合、ユーザ側では、停止・起動の繰り返しに対応する余分な手間が発生し、停止後再起動するための余分な段取り時間が発生し、アラーム停止による余分な歩留まりが発生し、アラーム停止による機械破損の可能性が発生する、などの問題が起こる。
【０００６】
そのため、極力アラーム非常停止とならないように動作するサーボアンプをユーザに提供できることが望まれており、このような要請に応える種々の提案がなされている（例えば、特許文献１，２等）。
【０００７】
特許文献１では、過負荷になる可能性が高まったと判断した場合、過負荷とならないような速度パターンに修正し、その速度指令にて運転を行う技術が提案されている。具体的には、モータ温度が高くなった場合に、速度指令の加減速時定数を下げて駆動電流を減らすことで、過負荷を防止するという技術である。
【０００８】
また、特許文献２では、過負荷になる可能性が高まったと判断した場合、リミッタを利用し、速度変化もしくは電流リミットを下げて加速度・電流を下げた運転を行う技術が提案されている。
【先行技術文献】
【特許文献】
【０００９】
【特許文献１】特開平１１−１９４８０７号公報
【特許文献２】特開平１１−１２２９６４号公報
【発明の概要】
【発明が解決しようとする課題】
【００１０】
ところが、本発明が対象とするサーボアンプは、一般産業機械用サーボアンプのように、指令パターンを生成する上位コントローラから指令をもらって動作するタイプのサーボアンプである。これに対して、特許文献１に記載の技術は、サーボアンプ内部に速度指令パターン生成部を有する場合の技術であるので、本発明が対象とするサーボアンプでは、利用が困難である。
【００１１】
すなわち、上位コントローラから指令をもらって動作するタイプのサーボアンプに、かりに、特許文献１に記載の技術を適用する場合は、上位コントローラに対し実効負荷率や電流などのデータをリアルタイムに送付し、上位コントローラにて過負荷に関する判断・対策を行う必要がある。
【００１２】
そうすると、上位コントローラでは過負荷判断・対策に遅れが発生し、上位コントローラとサーボアンプとの間のデータ通信量が増加し、上位コントローラのソフトウェア負荷の増大が発生するという問題が起こる。上位コントローラのソフトウェア負荷の増大は、機械ユーザのソフトウェア開発の増大にも繋がり好ましくない。また、特に上位コントローラからパルス列指令を受け取るパルス列タイプのサーボアンプの場合には、これらのデータ送信用に特別な配線を用意する必要があり、省配線の面で望ましくない。
【００１３】
この点、特許文献２に記載の技術では、電流リミットを下げると、駆動電流が減り、結果として過負荷が防止できる。本方式であれば、上位コントローラに依存せずサーボアンプ単体での過負荷回避動作も可能である。また、同様に速度リミットやトルクリミットを行えば過回生アラーム回避動作も可能である。
【００１４】
しかし、リミッタで制限する動作は非線形動作であるので、特許文献２に記載の技術のように、これらをリミッタで制限するという方式を用いた場合には、振動やショックを増大させる可能性がある。また、アウターループ（位置ループなど）を組んだ場合に非線形動作によりハンチングや不安定を引き起こす可能性がある。それらの不安定を防止するた方策としては、リミッタ時の飽和量を再帰計算などで計算しなおしたり、飽和量をフィードバックしたりするなどの手法も存在するが、プログラムが増大・複雑になり、開発に大きな負荷が掛かることや、演算負荷が大きく演算時間が長くなるなど、新たな問題が発生する。
【００１５】
本発明は、上記に鑑みてなされたものであり、簡易な構成でアラーム停止を回避できる保護機能を備えた電動機制御装置を得ることを目的とする。
【課題を解決するための手段】
【００１６】
上述した目的を達成するために、本発明は、コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、実効負荷率もしくは当該モータ制御装置と前記モータと前記機械との少なくともいずれか一つの温度に関する物理量を観測或いは推測し、過負荷になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過負荷回避動作を行う構成を備えたことを特徴とする。
【発明の効果】
【００１７】
本発明によれば、過負荷アラーム停止となるような過負荷の発生を予知した場合、待機時間を引き延ばすようにしたので、サイクルタイムが長くなり、実効負荷率を下げる方向に動作させることができ、簡易な構成で過負荷アラーム停止を回避することができるという効果を奏する。
【図面の簡単な説明】
【００１８】
【図１】図１は、この発明の実施の形態１による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【図２】図２は、図１に示す過負荷回避回路の構成例を示すブロック図である。
【図３】図３は、通常モード時と過負荷回避モード時とでの動作内容を比較して示す動作波形の一例を示す応答波形図である。
【図４】図４は、図１に示す過負荷回避回路の他の構成例（シーケンス構成例）を説明するフローチャートである。
【図５】図５は、この発明の実施の形態２による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【図６】図６は、この発明の実施の形態３による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【図７】図７は、この発明の実施の形態４による保護機能を備えた電動機制御装置の構成を示すブロック図である。
【発明を実施するための形態】
【００１９】
以下に、本発明にかかる保護機能を備えた電動機制御装置の実施の形態を図面に基づいて詳細に説明する。なお、この実施の形態により本発明が限定されるものではない。
【００２０】
実施の形態１．
図１は、本発明の実施の形態１による保護機能を備えた電動機制御装置の構成を示すブロック図である。図１において、まず、上位コントローラ１と、本実施の形態１による保護機能を備えた電動機制御装置であるサーボアンプ２ａと、位置検出器３ａが取り付けられているサーボモータ３との関係を説明する。
【００２１】
上位コントローラ１は、位置指令ａをサーボアンプ２ａに出力する。サーボアンプ２ａは、位置指令ａに、サーボモータ３からフィードバックされる位置検出器３ａにて検出されたモータ位置ｂが追従するようにサーボモータ３を駆動する。
【００２２】
サーボアンプ２ａは、位置決め動作が完了すると、位置決め完了信号ｃを上位コントローラ１に送信する。上位コントローラ１は、位置決め完了信号ｃを受け取ると、サーボアンプ２ａの動作完了を認識し、次の動作シーケンスへと移り、サーボアンプ２ａないしは他のサーボアンプへ位置指令を出力する。これの繰り返しにより、図示しない各種の機械が所望の状態に制御される。
【００２３】
さて、サーボアンプ２ａは、一般には、位置偏差演算器４、位置制御部５、速度演算器６、速度偏差演算器７、速度制御部８、トルク制御部９、および位置決め完了判定部１０を備えているが、本実施の形態１では、過負荷アラーム停止を回避する手段として、過負荷回避回路１１と、遅延回路１２とを追加して設けてある。
【００２４】
位置偏差演算器４は、上位コントローラ１から得られる位置指令ａとサーボモータ３の位置検出器３ａからフィードバックされたモータ位置ｂとから位置偏差ｄを演算して出力する。位置制御部５は、位置偏差ｄに基づいて位置制御を行って速度指令ｅを出力する。速度演算器６は、フィードバックされたモータ位置ｂに擬似微分演算などを実施してモータ速度ｆを演算して出力する。
【００２５】
速度偏差演算器７は、位置制御出力である速度指令ｅとモータ速度ｆとから速度偏差ｇを演算して出力する。速度制御部８は、速度偏差ｇを受けて速度制御を行い、トルク指令ｈを出力する。トルク制御部９は、トルク指令ｈを受けて電流制御を行い、トルク指令ｈ通りにモータ３が動くように駆動電圧を供給する。
【００２６】
位置決め完了判定部１０は、位置指令ａとモータ位置ｂとの偏差を取ってドループ信号を作成し、そのドループ信号がドループ基準範囲内に入っているか否かを判定した位置決め完了信号ｉを出力する。
【００２７】
ここで、過負荷回避回路１１は、実効負荷率ｊを入力とし、例えば、図２や図４に示す構成によって、過負荷回避動作時に、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間の生成を行い、生成した遅延時間ｋを遅延回路１２に出力する。
【００２８】
遅延回路１２は、過負荷回避回路１１からの遅延時間ｋがゼロである場合は、遅延処理を行わず、位置決め完了判定部１０からの位置決め完了信号ｉをそのまま位置決め完了信号ｃとしてコントローラ１へ出力する。一方、過負荷回避回路１１からの遅延時間ｋがゼロではなく、或る値（Ｔｄｉ）である場合は、遅延回路１２は、位置決め完了判定部１０からの位置決め完了信号ｉを遅延時間Ｔｄｉだけ遅延させた位置決め完了信号ｃをコントローラ１へ出力する遅延処理を行う。
【００２９】
次に、図２は、図１に示す過負荷回避回路１１の構成例を示すブロック図である。過負荷回避回路１１は、例えば図２に示すように、実効負荷率偏差演算部１３と、スイッチ部１４と、実効負荷率制御部１５と、制限器１６とを備えている。
【００３０】
実効負荷率偏差演算部１３は、実効負荷率基準値ｍと実効負荷率ｊとの実効負荷率偏差ｎを演算して出力する。なお、実効負荷率基準値ｍとしては、事前に過負荷非常停止となるレベルよりも低い値が設定されている。スイッチ部１４は、過負荷回避動作のオン（実行：過負荷回避モード）／オフ（非実行：通常モード）を決定する。実効負荷率制御部１５は、例えばＰＩ制御などを行って、実効負荷率偏差ｎに応じて、位置決め完了決定部１０が決定した位置決め完了信号ｉの送出を遅延させる遅延時間量ｐを決定する。制限器１６は、入力される遅延時間量ｐに遅延時間の制限範囲を適用した遅延時間ｋを遅延回路１２に出力する。
【００３１】
次に、図３をも参照して、動作について説明する。なお、図３は、通常モード時と過負荷回避モード時とでの動作内容を比較して示す動作波形の一例を示す応答波形図である。図３では、（ａ）過負荷アラーム停止が起こらない運転状態である通常モード時の応答波形と、（ｂ）過負荷アラーム停止が起こる可能性が高い運転状態の場合に行われる過負荷回避モード時の応答波形とが示されている。
【００３２】
実効負荷率ｊに目立った上昇気配が無く実効負荷率基準値ｍ以下であり、過負荷アラーム停止が起こるような過負荷になる可能性の低い通常モード時では、過負荷回避回路１１では、スイッチ部１４がオフしていて後段の実効負荷率制御部１５以降は動作しない。遅延回路１２は、過負荷回避回路１１からの遅延時間ｋがゼロであり遅延処理を行わない。そのため、位置決め完了判定部１０が判定した位置決め完了信号ｉが、そのまま位置決め完了信号ｃとしてサーボアンプ２ａの位置決めが完了すると同時に出力される。
【００３３】
図３（ａ）において、通常モード時では、速度指令２０に少し遅れて実速度２１が追従し、速度指令払出完了２２から若干時間の経過後に実速度２１がほぼ零２３に収束する。位置指令ａとモータ位置ｂとの位置偏差ｄであるドループ信号も同様の動作をするため、速度指令払出完了２２から若干時間の経過後にドループ信号がドループ基準範囲内に収束し、実速度２１がほぼ零２３に収束するタイミングで、位置決め完了信号ｃが低レベルから高レベルに立ち上がる。これによって、上位コントローラ１は、位置決め完了信号ｃの入力を認識し、次の動作シーケンスへ移行し、新たな位置指令ａをサーボアンプ２ａに出力する。
【００３４】
一方、上位コントローラ１から適切でない位置指令ａが入ってきた場合や、負荷が増大した場合、あるいは主回路電圧が低下した場合などにより、実効負荷率ｊが実効負荷率基準値ｍを超えて上昇し、過負荷アラーム停止が起こるような過負荷になる可能性が高まった場合は、過負荷回避回路１１では、スイッチ部１４がオンとなって、後段の実効負荷率制御部１５が動作し、過負荷回避モードとなる。
【００３５】
過負荷回避モードでは、実効負荷率制御部１５にて位置決め完了信号ｉに与える遅延時間量ｐが決定され、制限器１６にて上下限の制限処理されたゼロでない遅延時間ｋが遅延回路１２に出力され、遅延回路１２にて位置決め完了信号ｉを遅延時間ｋだけ遅延させて位置決め完了信号ｃとする動作（過負荷回避動作）が行われる。
【００３６】
具体的に説明する。図２において、過負荷アラーム停止が起こるような過負荷になる可能性が高まると、実効負荷率基準値ｍに対し実効負荷率ｊが大きな値となるため、実効負荷率偏差ｎは負の値となる。そこで、実効負荷率制御部１５は、実効負荷率ｊが下がるように位置決め完了信号ｉに与える遅延時間量ｐを増大する方向に制御する。
【００３７】
そうすると、図３（ｂ）において、通常モード時では速度指令払出完了２２から若干時間の経過後に実速度２１がほぼ零２３に収束するタイミングで低レベルから高レベルに立ち上がっていた位置決め完了信号ｃが、過負荷回避モード時では、過負荷回避回路１１から得られた遅延時間ｋ＝Ｔｄｉだけ遅延させたタイミングで低レベルから高レベルに立ち上がる位置決め完了信号ｃとして出力される。これによって、上位コントローラ１は、位置決め完了信号ｃの入力を遅延時間ｋ＝Ｔｄｉだけ遅れて認識することになり、次の位置指令ａの入力時期が通常モード時よりも遅延時間ｋ＝Ｔｄｉだけ遅れることになる。
【００３８】
このように、位置決め完了信号ｉの送出を遅延させると、上位コントローラ１から次の位置指令ａが入力されるまでの待機時間が通常モード時よりも長くなる。その結果、実効負荷率ｊが下がり、実効負荷率基準値ｍを下回ることとなり、実効負荷率偏差ｊは正の値となる。これにより、実効負荷率制御部１５は、今度は実効負荷率ｊが上がるように、位置決め完了信号ｉに与える遅延時間量ｐを減らす方向に制御する。位置決め完了信号ｉの送出を遅延させる時間が前回よりも少し短くなる。以上の動作が繰り返されて、実効負荷率ｊは、実効負荷率基準値ｍに近づくように、位置決め完了信号ｉに与える遅延時間量ｐが増減制御される。
【００３９】
要するに、サーボアンプ２ａでは、過負荷回避モードになると、各動作シーケンスにおける位置指令ａの入力を待機する時間が延びることになる。その結果、図３（ａ）（ｂ）に示すように、サーボアンプ２ａの過負荷回避モード時でのサイクルタイム２５は、通常モード時でのサイクルタイム２４から、遅延時間Ｔｄｉだけ増加することになる。サーボアンプ２ａでは、サイクルタイムが引き延ばされると、その分だけ実効負荷率が下がることになるので、過負荷アラーム停止となるような過負荷が起こる状況でも、過負荷アラーム停止が回避されることになる。
【００４０】
次に、過負荷回避回路１１の他の構成例を説明する。図２は、過負荷回避回路１１が過負荷回避動作を線形制御的に行う場合の構成例であるが、例えば図４に示すように、過負荷回避回路１１は、過負荷回避動作をシーケンス制御的に行う構成も可能である。なお、図４は、図１に示す過負荷回避回路１１の他の構成例（シーケンス構成例）を説明するフローチャートである。図４では、各処理ステップは、符号Ｓを付して表してある。
【００４１】
図４において、最初のＳ１では、事前に何らかの方法で設定されている過負荷回避モード突入レベル・回避レベルを入力する。そして、電流値等から演算された実効負荷率を観測し（Ｓ２）、現在の動作状態が過負荷回避モード中か否かを判断する（Ｓ３）。Ｓ３での判断結果、過負荷回避モード中で無い場合（Ｓ３：Ｎｏ）は、実効負荷率が回避モード突入レベルよりも大きいか否かを判断する（Ｓ４）。
【００４２】
Ｓ４での判断結果、実効負荷率が回避モード突入レベルよりも小さい場合（Ｓ４：Ｎｏ）は、遅延時間の生成を行わずに本手順を終了し、通常モードを継続する。一方、Ｓ４での判断結果、実効負荷率が回避モード突入レベルよりも大きい場合（Ｓ４：Ｙｅｓ）は、過負荷回避モードに突入し（Ｓ５）、送出する位置決め完了信号を遅延させる処理を行い（Ｓ６）、本手順を終了する。
【００４３】
ここで、Ｓ６での遅延時間は、現行運転パターンでの、ある時定数期間における実効負荷率の低減率と位置決め回数などに基づいて必要な遅延時間を推測して設定すればよい。例えば、ある時定数期間Ｔ０での位置決め回数をＮ回とし、そのときの実効負荷率をＪとし、実効負荷率Ｊをα％低減させた実効負荷率Ｊ’＝α／１００×Ｊとするための遅延時間Ｔｄｉは、次の式（１）で求めることが可能である。
Ｔｄｉ＝｛（１００／α）２−１｝Ｔ０／Ｎ …（１）
【００４４】
但し、式（１）は、停止中の実効負荷がおよそ無視できる場合に適用されるので、上下軸などのアンバランストルクがある場合や静止摩擦が大きい場合など、停止時に何らかのトルクを発生させているケースではその分の補正が必要となる。
【００４５】
また、先のＳ３の判断において、過負荷回避モード中である場合（Ｓ３：Ｙｅｓ）、実効負荷率が回避モード離脱レベルよりも大きいか否かを判断する（Ｓ７）。その結果、実効負荷率が回避モード離脱レベルを超過している場合（Ｓ７：Ｙｅｓ）は、過負荷回避モードでの動作を継続し、本手順を終了する。
【００４６】
その結果、Ｓ１〜Ｓ３を経由したＳ７において、実効負荷率が回避モード離脱レベルよりも小さくなった場合（Ｓ７：Ｎｏ）は、過負荷回避モードを離脱し（Ｓ８）、遅延時間を元の値に戻し（Ｓ９）、本手順を終了する。このようなシーケンスを行えば、過負荷回避モードへの突入・離脱を繰り返すチャタリングを発生させること無しに、サイクルタイムを引き延ばす過負荷回避動作を行うことが可能となる。
【００４７】
このように、本実施の形態１によれば、過負荷アラーム停止となるような過負荷の発生を予知した場合、位置決め完了の通知を遅延させ待機時間を引き延ばすようにしたので、サイクルタイムが長くなり、実効負荷率を下げる方向に動作させることができ、過負荷アラーム停止を回避することができる。
【００４８】
このとき、サーボアンプ単体で過負荷対策ができるので、コントローラは過負荷を意識する必要が無い。したがって、コントローラの負荷削減、コントローラのユーザソフトウェア作成の簡易化、構成の単純化、コントローラとサーボアンプとの間のデータ通信量削減などを実現できる。
【００４９】
また、待機時間を引き延ばす方式であれば、サーボアンプ単体でトルク制限や速度制限する方法と違って線形動作するので、ショックや振動は発生しない。不安定・ハンチングを発生させない。サーボアンプの構成が単純、演算量が少ないなどの効果がある。
【００５０】
さらに、サーボモータの動き方自体が変わらないため、特性変動の心配が無い。次のサイクルタイムでの過負荷アラーム停止を回避することができる。サーボモータは、とりあえず指令どおりに動作するので、例えば他軸と同期・補間動作を行っている場合に同期性が損なわれにくいなどの効果もある。
【００５１】
なお、本実施の形態１では、遅延回路１２を用いて位置決め完了信号ｉを遅延させて位置決め完了信号ｃとする場合を説明したが、遅延の形態は、これに限定されるものではない。例えば、遅延回路１２を用いずに、過負荷回避回路１１が生成した遅延時間ｋを位置決め完了判定部１０に与え、位置決め完了判定部１０において、遅延時間ｋに応じて、ドループ基準範囲を狭くしたり、ドループ演算値自体を遅延させたりする方法など、故意に遅延時間を生成する方法であればいかなる方法でも構わない。
【００５２】
また、実効負荷率演算は、通常ばらつきを抑えるために長い時定数のフィルタを用いて演算されるが、フィルタ時定数分だけアラーム回避動作が遅れてしまう場合は、別途短い時定数フィルタを準備し、フィルタを準備した短い時定数フィルタに切り替えて、その短い時定数フィルタを用いて計算した実効負荷率を用いてアラーム回避動作を行えばよい。
【００５３】
実施の形態２．
図５は、本発明の実施の形態２による保護機能を備えた電動機制御装置の構成を示すブロック図である。なお、図５では、図１（実施の形態１）に示した構成要素と同一ないしは同等である構成要素には同一の符号が付されている。ここでは、本実施の形態２に関わる部分を中心に説明する。
【００５４】
本実施の形態２では、遅延する対象を位置指令に変更した場合について説明する。すなわち、図５に示すように、本実施の形態２による保護機能を備えた電動機制御装置であるサーボアンプ２ｂでは、図１（実施の形態１）に示した構成において、過負荷回避回路１１と遅延回路１２とを削除し、位置決め完了判定部１０が判定した位置決め完了信号をそのまま位置決め完了信号ｃとして上位コントローラに出力する。その代わり、上位コントローラからの位置指令ａを遅延させて取り込む遅延回路２７と、過負荷回避回路２８とが設けられている。
【００５５】
過負荷回避回路２８は、実施の形態１にて説明した内容の実効負荷率ｊを入力とし、上位コントローラからの位置指令ａに与える遅延時間の変更を行い、変更した遅延時間ｋを遅延回路２７に出力する。なお、位置指令ａに与える遅延時間の変更は、例えば、マルチタップの遅延ブロックから必要な箇所のデータを取り出すなどの方法で実現可能である。
【００５６】
遅延回路２７は、過負荷回避回路２８からの遅延時間ｋがゼロである場合は、上位コントローラからの位置指令ａをそのまま位置偏差演算器４と位置決め完了判定部１０とに出力するが、過負荷回避回路２８からの遅延時間ｋがゼロでなく或る値Ｔ１を有する場合には、位置指令ａを遅延時間Ｔ１だけ遅延させて位置偏差演算器４と位置決め完了判定部１０とに出力する。
【００５７】
この構成では、過負荷回避動作時に位置偏差演算器４と位置決め完了判定部１０とは、それぞれ、遅延回路２７にて遅延された位置指令を用いて偏差の演算を行う。但し、位置決め完了判定部１０は、遅延前の位置指令ａを用いてもよい。
【００５８】
以上のように位置指令ａの取り込みを遅延させる場合でも、その遅延分だけ位置指令を受け取ってから位置決め完了信号を吐き出すまでの時間が延びることになり、待機時間を引き延ばすことができる。その結果、実施の形態１と同様に、サイクルタイムが延びることにより、実効負荷率が下がるため、過負荷アラーム停止となる過負荷が起こる状況であっても、過負荷アラーム停止を回避することが可能になる。
【００５９】
このように、本実施の形態２では、過負荷アラーム停止となるような過負荷の発生を予知した場合、位置指令の取り込みを遅延させて待機時間を引き延ばすようにしたので、実施の形態１と同様に、サイクルタイムが長くなり、実効負荷率を下げる方向に動作させることができ、過負荷アラーム停止を回避することができる。
【００６０】
加えて、本実施の形態２では、実施の形態１に比べて次のような効果が得られる。
（１）実施の形態１では、位置決め完了信号を遅延させるので、動作してからの待ち時間が長くなるのに対し、本実施の形態２では、位置指令を遅延させるので、待ってから動作を行うことになり、実効負荷率が早めに下がり、過負荷回避動作時間が短くなる効果が得られる。
【００６１】
（２）また、ある運転サイクル中に過負荷回避モードに入った場合に、自軸の次サイクルの動作が遅延されることになるので、（今回サイクルの後の）他軸の動作は遅らせることなく継続して動作完了できる効果も得られる。この点、実施の形態１では、位置決め完了信号を遅延させるので、（自軸の今回サイクルの後の）他軸の動作が遅延させられてしまうことが起こるという難点がある。
【００６２】
（３）さらに、もし自軸のサーボアンプの動作開始を待って他の軸と同期を行うようなシーケンスが組まれていたケースの場合、本実施の形態２による方が、同期性を損なわないという効果も発生する。
【００６３】
実施の形態３．
図６は、本発明の実施の形態３による保護機能を備えた電動機制御装置の構成を示すブロック図である。なお、図６では、図１（実施の形態１）に示した構成要素と同一ないしは同等である構成要素には同一の符号が付されている。ここでは、本実施の形態３に関わる部分を中心に説明する。
【００６４】
図６において、本実施の形態３による保護機能を備えた電動機制御装置であるサーボアンプ２ｃでは、図１（実施の形態１）に示した構成において、実効負荷率ｊを入力とする過負荷回避回路１１に代えて、回生負荷率ｒを入力とする過回生回避回路３１が設けられている。
【００６５】
過回生回避回路３１に入力される回生負荷率ｒは、例えば、回生コンバータの回生電流や回生トランジスタのオン／オフの回数・デューティーなどを基に逐次計算されるものである。過回生回避回路３１は、過負荷回避回路１１と同様の考えで、過回生回避動作を行うものであり、図２や図４に示した構成と類似の構成を有している。
【００６６】
次に、動作について説明する。過回生回避回路３１は、入力される回生負荷率ｒに目立った上昇気配がなく基準値を下まわり、過回生アラーム停止となるような過回生になる可能性が低い場合には、過回生回避動作を行わず、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成しないので、遅延回路１２への遅延時間ｋはゼロである。つまり、遅延回路１２は、位置決め完了判定部１０が判定した位置決め完了信号ｉをそのまま位置決め完了信号ｃとして出力する。
【００６７】
このように、過回生アラーム停止となるような過回生とならない通常の動作の場合は、位置決め完了判定部１０が判定した位置決め完了信号ｉは、サーボアンプ２ｃの位置決めが完了すると同時に出力される。
【００６８】
一方、過回生回避回路３１は、入力される回生負荷率ｒが基準値を超えて上昇し、過回生アラーム停止となるような過回生になる可能性が高くなった場合には、過回生回避動作を行い、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成し、生成したゼロでない遅延時間ｋを遅延回路１２に出力する。
【００６９】
これによって、上位コントローラ１に出力される位置決め完了信号ｃは、位置決め完了判定部１０が判定した位置決め完了信号ｉに、過回生回避回路３１にて生成された遅延時間ｋだけの遅延処理が施された信号となる。
【００７０】
上位コントローラ１は、サーボアンプ２ｃの位置決め完了信号ｃを待って次の動作シーケンスへと移行するので、サーボアンプ２ｃでは、次の動作シーケンスにおける位置指令ａの入力を待機する時間が延びることになる。その結果、サーボアンプ２ｃの過回生回避動作時でのサイクルタイムは、通常の過回生とならないような動作時よりも増加することになる。サーボアンプ２ｃでは、サイクルタイムが引き延ばされると、回生負荷率が下がることになり、過回生アラーム停止となるような過回生が起こる状況でも、過回生アラーム停止が回避されることになる。
【００７１】
このように、本実施の形態３によれば、過回生アラーム停止となるような過回生の発生を予知した場合、位置決め完了の通知を遅らせて待機時間を引き延ばすようにしたので、サイクルタイムが長くなり、回生負荷率を下げる方向に動作させることができ、過回生アラーム停止を回避することができる。
【００７２】
このとき、サーボアンプ単体で過回生対策ができるので、コントローラは過回生を意識する必要が無い。したがって、コントローラの負荷削減、コントローラのユーザソフトウェア作成の簡易化、構成の単純化、コントローラとサーボアンプとの間のデータ通信量削減などを実現できる。
【００７３】
また、待機時間を引き延ばす方式であれば、サーボアンプ単体でトルク制限や速度制限する方法と違い、線形動作するのでショックや振動が発生しない。不安定・ハンチングを発生させない。サーボアンプの構成が単純、演算量が少ないなどの効果がある。
【００７４】
さらに、サーボモータの動き方自体が変わらないため、特性変動の心配が無い。次のサイクルタイムでの過回生アラーム停止を回避することができる。サーボモータは、とりあえず指令どおりに動作するので、例えば他軸と同期・補間動作を行っている場合に同期性が損なわれにくいなどの効果もある。
【００７５】
なお、本実施の形態３では、遅延回路１２を用いて位置決め完了信号ｉを遅延させて位置決め完了信号ｃとする場合を説明したが、遅延の形態は、これに限定されるものではない。例えば、遅延回路１２を用いずに、過回生回避回路３１が生成した遅延時間ｋを位置決め完了判定部１０に与え、位置決め完了判定部１０において、遅延時間ｋに応じて、ドループ基準範囲を狭くしたり、ドループ演算値自体を遅延させたりする方法など、故意に遅延時間を生成する方法であればいかなる方法でも構わない。
【００７６】
実施の形態４．
図７は、本発明の実施の形態４による保護機能を備えた電動機制御装置の構成を示すブロック図である。なお、図７では、図１（実施の形態１）に示した構成要素と同一ないしは同等である構成要素には同一の符号が付されている。ここでは、本実施の形態４に関わる部分を中心に説明する。
【００７７】
図７において、本実施の形態４による保護機能を備えた電動機制御装置であるサーボアンプ２ｄでは、図１（実施の形態１）に示した構成において、実効負荷率ｊを入力とする過負荷回避回路１１に代えて、母線電圧などの主回路電圧ｓを入力とする電圧アラーム回避回路４１が設けられている。
【００７８】
電圧アラーム回避回路４１は、過負荷回避回路１１と同様の考えで、過電圧・不足電圧の回避動作を行うものであり、図２や図４に示した構成と類似の構成を有している。
【００７９】
次に、動作について説明する。電圧アラーム回避回路４１は、入力される主回路電圧ｓに目立った上昇変化・下降変化の気配がなく、過電圧・不足電圧になる可能性が低い場合には、遅延処理を行う電圧アラーム回避動作を行わず、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成しないので、遅延回路１２への遅延時間ｋはゼロである。つまり、遅延回路１２は、位置決め完了判定部１０が判定した位置決め完了信号ｉをそのまま位置決め完了信号ｃとして出力する。
【００８０】
このように、過電圧・不足電圧とならないような通常の動作の場合は、位置決め完了判定部１０が判定した位置決め完了信号ｉは、サーボアンプ２ｄの位置決めが完了すると同時に出力される。
【００８１】
一方、電圧アラーム回避回路４１は、入力される主回路電圧ｓが基準値を超えて上昇し、過電圧になる可能性が高くなった場合には、遅延処理を行う過電圧回避動作を行い、位置決め完了判定部１０が判定した位置決め完了信号ｉに与える遅延時間を生成し、生成したゼロでない遅延時間ｋを遅延回路１２に出力する。
【００８２】
これによって、上位コントローラ１に出力される位置決め完了信号ｃは、位置決め完了判定部１０が判定した位置決め完了信号ｉに、電圧アラーム回避回路４１にて生成された遅延時間ｋだけの遅延処理が施された信号となる。
【００８３】
上位コントローラ１は、サーボアンプ２ｄからの位置決め完了信号ｃを待って次の動作シーケンスへと移行するので、サーボアンプ２ｄでは、次の動作シーケンスにおける位置指令ａの入力を待機する時間が延びることになる。サーボアンプ２ｄでは、待機時間内はサーボ動作を行わないため、高くなりかけた主回路電圧ｓが抑制されることになり、次の運転サイクルにおいて過電圧となる可能性を下げることが可能になる。
【００８４】
なお、図７では示していないが、過電圧になる可能性が高くなった場合、過電圧アラーム回避信号を上位コントローラ１に送信し、上位コントローラ１が過電圧の発生を回避するように、動作シーケンスや指令パターンの変更を行うという手法も可能である。
【００８５】
また、電圧アラーム回避回路４１は、入力される主回路電圧ｓが瞬停などで基準値以下に下降し、不足電圧になる可能性が高くなった場合は、遅延処理を行う不足電圧回避動作が行われ、上記と同様に位置決め完了信号ｉの遅延処理が行われる。その結果、遅延処理による待機時間の間はサーボ運転を行わないため、電力消費が減り、主回路電圧ｓの低下を減少させることができ、次の運転サイクルにおいて、不足電圧となる可能性を下げることが可能となる。
【００８６】
なお、図７では示していないが、不足電圧になる可能性が高くなった場合、不足電圧アラーム回避信号を上位コントローラに送信し、上位コントローラが不足電圧の発生を回避するように、動作シーケンスや指令パターンの変更を行うという手法も可能である。
【００８７】
ここで、図７では、電圧アラーム回避回路４１は、主回路電圧を監視する場合を示したが、電圧値自体を検出する手段を有しない場合などにおいては、主回路電圧が過電圧の閾値レベルを超過したことを判断するフラグや、不足電圧の閾値レベルを下回ったことを判断するフラグを監視するようにしてもよい。
【００８８】
なお、本実施の形態４では、遅延回路１２を用いて位置決め完了信号ｉを遅延させて位置決め完了信号ｃとする場合を説明したが、遅延の形態は、これに限定されるものではない。例えば、遅延回路１２を用いずに、電圧アラーム回避回路４１が生成した遅延時間ｋを位置決め完了判定部１０に与え、位置決め完了判定部１０において、遅延時間ｋに応じて、ドループ基準範囲を狭くしたり、ドループ演算値自体を遅延させたりする方法など、故意に遅延時間を生成する方法であればいかなる方法でも構わない。
【００８９】
このように、本実施の形態４によれば、過電圧アラーム停止となるような過電圧の発生を予知した場合や、不足電圧アラーム停止となるような不足電圧の発生を予知した場合には、位置決め完了の通知を遅らせて待機時間を引き延ばすようにしたので、主回路電圧の上昇を抑える、或いは、主回路電圧の減少を少なくすることができ、次運転サイクルでの過電圧アラーム停止や不足電圧アラーム停止を回避することができる。
【００９０】
このとき、サーボアンプ単体で過電圧・不足電圧対策ができるので、コントローラは過電圧・不足電圧を意識する必要が無い。したがって、コントローラの負荷削減、コントローラのユーザソフトウェア作成の簡易化、構成の単純化、コントローラとサーボアンプとの間のデータ通信量削減などを実現できる。
【００９１】
また、待機時間を引き延ばす方式であれば、サーボアンプ単体でトルク制限や速度制限する方法と違い、線形動作するのでショックや振動は発生しない。不安定・ハンチングを発生させない。サーボアンプの構成が単純、演算量が少ないなどの効果がある。
【００９２】
さらに、サーボモータの動き方自体が変わらないため、特性変動の心配が無い。次のサイクルタイムでの過電圧・不足電圧のアラーム停止を回避することができる。サーボモータは、とりあえず指令どおりに動作するので、例えば他軸と同期・補間動作を行っている場合に同期性が損なわれにくいなどの効果もある。
【００９３】
ここで、本発明は、以上説明した実施の形態１〜４に限定されるものではなく、以下に示す各種の態様が可能である。
【００９４】
（１）実施の形態１に対して実施の形態２があるように、本実施の形態３，４に対しても実施の形態２と同様の考えで、位置指令を取り込んでから実際に起動する時間を遅延させて待機時間を引き延ばすようにしてもよい。
【００９５】
（２）実施の形態１〜４では、位置制御モードの場合における説明をしているが、速度制御モードや圧力制御モードなどの場合においても同様の動作が可能である。例えば、速度制御モードの場合には、位置指令の代わりに速度指令を用い、位置決め完了信号の代わりに、零速度近傍になったことを検出する零速度検出信号もしくはモータ速度が指令速度に到達したことを検出する速度到達信号（速度一致検出信号）を用いればよい。速度指令ないしは零速度検出信号、速度到達信号を遅延させることで同様の動作を実現できる。
【００９６】
（３）実施の形態１，２では、過負荷回避回路への入力は実効負荷率を用いているが、実効負荷率の２乗や推定した負荷率を用いても、過負荷回避動作を行うことが可能である。また、サーボモータやエンコーダ、サーボアンプ、機械などの温度に関連する様々な観測値ないしは推定値を用いても、過負荷回避動作を行うことが可能である。
【００９７】
（４）実施の形態１〜４では、サーボアンプのタイプとして、上位コントローラから位置指令・速度指令を受け取って動作するタイプを対象に説明したが、本発明は、上位コントローラから目標位置や起動信号などを受け取りサーボアンプ内部にて指令パターンを生成する位置決め内蔵タイプなどにも同様に適用することができる。
【００９８】
この位置決め内蔵タイプなどのサーボアンプを用いる場合は、サーボアンプ内部にて指令を生成するため、起動タイミングを遅らせる動作を実現しようとした場合、起動信号を遅らせるだけでよく、実施の形態２のように指令を遅らせるよりも簡易な回路で遅延処理を行うことができる。
【００９９】
（５）また、位置決め内蔵タイプなどのサーボアンプを用いる場合では、サーボアンプ内部で指令パターンを変更することで過負荷・過回生などのアラーム回避を行うことも可能である。この場合、本発明は、動作開始・終了の待ち時間を変更するのみであり、モータの動き方は変わらないため、指令パターンを変更する方式と比較して、特性変動の心配が無いという点で望ましい。また、両者を併用することももちろん可能である。
【０１００】
（６）実施の形態１〜４では、サーボアンプを例に挙げて説明したが、インバータなどその他のモータ制御装置でも同様に適用可能であることはいうまでもない。
【０１０１】
（７）実施の形態１〜４では、遅延時間の大きさをサーボアンプ内で決定しているが、上位コントローラにアラーム回避モードの要否を送信し、上位コントローラから遅延時間を指定してもらう手法も可能である。同期や補間などを行う機械では、他軸との連動が必要であることから上位コントローラで遅延時間を決定できることが望ましい。もちろん、遅延時間をサーボアンプ内にて決定し上位コントローラに送信するという方法や、事前にサーボアンプに設定した遅延時間を上位コントローラにおいて認識しておき、サーボアンプがアラーム回避モードに入ったことを上位コントローラに知らせるという方法などでもよい。
【０１０２】
（８）また、実施の形態１〜４は、組み合わせての利用も可能であることはいうまでもない。
【産業上の利用可能性】
【０１０３】
以上のように、本発明にかかるモータ制御装置は、簡易な構成でアラーム停止を回避できる保護機能を備えたモータ制御装置として有用である。
【符号の説明】
【０１０４】
１ コントローラ
２ａ，２ｂ，２ｃ，２ｄ サーボアンプ
３ サーボモータ（電動機）
３ａ 位置検出器
４ 位置偏差演算器
５ 位置制御部
６ 速度演算器
７ 速度偏差演算器
８ 速度制御部
９ トルク制御部
１０ 位置決め完了判定部
１１，２８ 過負荷回避回路
１２，２７ 遅延回路
１３ 実効負荷率偏差演算部
１４ スイッチ部
１５ 実効負荷率制御部
１６ 制限器
３１ 過回生回避回路
４１ 電圧アラーム回避回路
【特許請求の範囲】
【請求項１】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
実効負荷率もしくは当該電動機制御装置と前記モータと前記機械との少なくともいずれか一つの温度に関する物理量を観測或いは推測し、過負荷になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過負荷回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項２】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
回生負荷率もしくは回生コンバータと回生抵抗体との少なくともいずれか一方の温度に関する物理量を観測或いは推測し、過回生になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過回生回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項３】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
当該電動機制御装置の主回路電圧値もしくは前記主回路電圧が閾値を超えるのを知らせるフラグを観測し、過電圧になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過電圧回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項４】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
当該電動機制御装置の主回路電圧値もしくは前記主回路電圧が閾値を下回るのを知らせるフラグを観測し、不足電圧になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす不足電圧回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項５】
前記待機時間の引き延ばしは、前記コントローラへ出力する前記動作完了信号を遅延させることにより行われることを特徴とする請求項１〜４のいずれか一つに記載の保護機能を備えた電動機制御装置。
【請求項６】
前記動作完了信号は、位置決め完了信号であることを特徴とする請求項５に記載の保護機能を備えた電動機制御装置。
【請求項７】
前記動作完了信号は、零速度検出信号と速度到達信号の一方または両方であることを特徴とする請求項５に記載の保護機能を備えた電動機制御装置。
【請求項８】
前記待機時間の引き延ばしは、起動タイミングを遅延させることにより行われることを特徴とする請求項１〜４のいずれか一つに記載の保護機能を備えた電動機制御装置。
【請求項９】
前記起動タイミングの遅延は、前記コントローラから入力される前記位置指令もしくは前記速度指令を遅延させることにより行われることを特徴とする請求項８に記載の保護機能を備えた電動機制御装置。
【請求項１０】
前記起動タイミングの遅延は、前記コントローラから入力される起動信号を遅延させることによって行われることを特徴とする請求項８に記載の保護機能を備えた電動機制御装置。
【請求項１】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
実効負荷率もしくは当該電動機制御装置と前記モータと前記機械との少なくともいずれか一つの温度に関する物理量を観測或いは推測し、過負荷になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過負荷回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項２】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
回生負荷率もしくは回生コンバータと回生抵抗体との少なくともいずれか一方の温度に関する物理量を観測或いは推測し、過回生になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過回生回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項３】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
当該電動機制御装置の主回路電圧値もしくは前記主回路電圧が閾値を超えるのを知らせるフラグを観測し、過電圧になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす過電圧回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項４】
コントローラから指令ないしは起動信号を受け取り、各種の機械を駆動するモータを制御し、前記コントローラへ動作完了信号を出力する電動機制御装置において、
当該電動機制御装置の主回路電圧値もしくは前記主回路電圧が閾値を下回るのを知らせるフラグを観測し、不足電圧になる可能性が高いと判断した場合に、前記コントローラから次の指令ないしは起動信号を受け取ってから、動作完了信号を前記コントローラに出力するまでの間における待機時間を引き延ばす不足電圧回避動作を行う構成、
を備えたことを特徴とする保護機能を備えた電動機制御装置。
【請求項５】
前記待機時間の引き延ばしは、前記コントローラへ出力する前記動作完了信号を遅延させることにより行われることを特徴とする請求項１〜４のいずれか一つに記載の保護機能を備えた電動機制御装置。
【請求項６】
前記動作完了信号は、位置決め完了信号であることを特徴とする請求項５に記載の保護機能を備えた電動機制御装置。
【請求項７】
前記動作完了信号は、零速度検出信号と速度到達信号の一方または両方であることを特徴とする請求項５に記載の保護機能を備えた電動機制御装置。
【請求項８】
前記待機時間の引き延ばしは、起動タイミングを遅延させることにより行われることを特徴とする請求項１〜４のいずれか一つに記載の保護機能を備えた電動機制御装置。
【請求項９】
前記起動タイミングの遅延は、前記コントローラから入力される前記位置指令もしくは前記速度指令を遅延させることにより行われることを特徴とする請求項８に記載の保護機能を備えた電動機制御装置。
【請求項１０】
前記起動タイミングの遅延は、前記コントローラから入力される起動信号を遅延させることによって行われることを特徴とする請求項８に記載の保護機能を備えた電動機制御装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【公開番号】特開２０１０−２５２４９３（Ｐ２０１０−２５２４９３Ａ）
【公開日】平成２２年１１月４日（２０１０．１１．４）
【国際特許分類】
【出願番号】特願２００９−９８３８１（Ｐ２００９−９８３８１）
【出願日】平成２１年４月１４日（２００９．４．１４）
【出願人】（０００００６０１３）三菱電機株式会社 (33,312)
【Ｆターム（参考）】
【公開日】平成２２年１１月４日（２０１０．１１．４）
【国際特許分類】
【出願日】平成２１年４月１４日（２００９．４．１４）
【出願人】（０００００６０１３）三菱電機株式会社 (33,312)
【Ｆターム（参考）】
[ Back to top ]