(58)【調査した分野】(Int.Cl.,DB名)
外部から入力された電圧指令である外部電圧指令および目標となる電圧値が0であるゼロ電圧指令をそれぞれ入力し、切換指令に応じていずれか一方の電圧指令を電圧制御部に入力する電圧指令切換部と、
前記電流値情報取得部の取得した電流値情報から得られる電流値が予め定めた最大電流閾値以上である場合に、前記ゼロ電圧指令が前記電圧制御部に入力されるように前記電圧指令切換部に切換指令を行う一方、前記電流値情報から得られる電流値が予め定めた解除電流閾値を下回った場合に、前記外部電圧指令が前記電圧制御部に入力されるように前記電圧指令切換部に切換指令を行う切換指令部とを設けた請求項1に記載のモータ制御装置。
前記電流値情報取得部は、電圧指令に応じてモータに流れるべき電流値を演算により算出するためのモータモデルを有し、前記電圧制御部に入力する電圧指令と前記モータモデルとに基づき前記モータに流れるべき電流値を前記電流値情報として算出する電流値演算部である請求項1又は2に記載のモータ制御装置。
【発明の概要】
【発明が解決しようとする課題】
【0004】
上記のようなモータに流れる電流を制御する電流アンプとも呼ばれるモータ制御装置はコスト高であるので、コストダウンのために、電圧指令に応じた電圧値となるようにモータに印加する電圧を制御することによりモータを駆動する電圧アンプとも呼ばれるモータ制御装置を採用することが一つの有効な手段となる。
【0005】
しかしながら、このような電圧アンプとも呼ばれるモータ制御装置は、モータに印加する出力電圧を制御するものであるため、モータ負荷の変動や外乱の変動によりモータに流れる電流が変化してしまう。この場合、モータに流れる電流と電圧との関係が一定であるとし、モータの許容する上限電流を超える電流がモータに流れないように電圧の最大値を規定して、電圧指令に応じた電圧値が最大値を超えないように制限したとしても、モータ負荷の変動等により上限電流を超える過大な電流がモータに流れてしまうことがあり、モータにダメージを与えてしまうおそれがある。
【0006】
本発明は、このような課題に着目してなされたものであって、その目的は、モータ負荷の変動や外乱の変動等によりモータに流れる電流が増大したとしても、モータに過大な電流が流れることを回避して過電流からモータを保護するモータ制御装置を提供することである。
【課題を解決するための手段】
【0007】
本発明は、かかる目的を達成するために、次のような手段を講じたものである。
【0008】
すなわち、本発明のモータ制御装置は、入力される電圧指令に応じた電圧値となるようにモータに印加する電圧を制御することにより前記モータを駆動する電圧制御部と、前記電圧制御部に入力する電圧指令を制限する制限手段と、前記モータに流れる電流値に関する電流値情報を取得する電流値情報取得部とを備え、前記制限手段は、前記電流値情報取得部の取得した電流値情報から得られる電流値に基づき高電流状態であるか否か及び前記高電流状態から通常状態に回復したか否かを判定し、前記高電流状態であると判定した場合に前記電圧制御部に入力する電圧指令を制限する一方、前記高電流状態から前記通常状態に回復したと判定した場合に前記電圧制御部に入力する電圧指令の制限を解除するように構成されて
おり、前記電流値情報取得部の取得した電流値情報から得られる電流値が予め定めた調整抜き電流閾値以上である間、前記電圧制御部に入力する電圧指令を制限する方向に修正する一方、前記電流値情報から得られる電流値が前記調整抜き電流閾値を下回る間、前記制限を解除する方向に前記電圧指令を修正する電圧指令修正部を備え、前記電圧指令修正部は、単位時間あたりの前記電圧指令の修正を予め定めた範囲内に留めて前記電圧指令の修正を複数回繰り返すように構成されていることを特徴とする。
【0009】
高電流状態は、モータに流れる電流値が或る値又は或る範囲よりも大きい状態を意味し、通常状態は、モータに流れる電流値が或る値又は或る範囲よりも小さい状態を意味する。これら或る値又は或る範囲は、モータの特性等によって予め設定される。
【0010】
このように、モータに流れる電流値が増大して高電流状態と判定される場合には電圧制御部に入力する電圧指令を制限し、電圧指令すなわちモータに印加する電圧を制限することでモータに流れる電流を低下させる一方、モータに流す電流値が低下して高電流状態から通常状態に回復したと判定される場合には電圧指令の制限を解除するので、モータ負荷の変動や外乱の変動によりモータに流れる電流が増大したとしても、モータに過大な電流が流れることを回避して過電流からモータを保護することが可能となる。
【0011】
さらには、前記電流値情報取得部の取得した電流値情報から得られる電流値が予め定めた調整抜き電流閾値以上である間、前記電圧制御部に入力する電圧指令を制限する方向に修正する一方、前記電流値情報から得られる電流値が前記調整抜き電流閾値を下回る間、前記制限を解除する方向に前記電圧指令を修正する電圧指令修正部を備え、前記電圧指令修正部は、単位時間あたりの前記電圧指令の修正を予め定めた範囲内に留めて前記電圧指令の修正を複数回繰り返すように構成されていることから、モータ動作を安定させるとともに、過電流によるモータの減磁等の損傷を抑制することもできる。
【0012】
ここでいう予め定めた範囲とは、電圧指令の大幅な変動を抑える趣旨である。
【0013】
過電流によるモータの減磁等の損傷を的確に防止するためには、外部から入力された電圧指令である外部電圧指令および目標となる電圧値が0であるゼロ電圧指令をそれぞれ入力し、切換指令に応じていずれか一方の電圧指令を電圧制御部に入力する電圧指令切換部と、前記電流値情報取得部の取得した電流値情報から得られる電流値が予め定めた最大電流閾値以上である場合に、前記ゼロ電圧指令が前記電圧制御部に入力されるように前記電圧指令切換部に切換指令を行う一方、前記電流値情報から得られる電流値が予め定めた解除電流閾値を下回った場合に、前記外部電圧指令が前記電圧制御部に入力されるように前記電圧指令切換部に切換指令を行う切換指令部とを設けることが好ましい。
【0014】
この場合、解除電流閾値は、最大電流閾値と同じ値又は最大電流閾値よりも小さな値に設定される。解除電流閾値を最大電流閾値よりも低い値に設定した場合には、双方の閾値の間に不感帯が設けられてヒステリシス性を持たせることになり、電圧指令の制限状態とその制限が解除された解除状態との切り換えが頻発するチャタリングを防止してモータ制御を安定させることが可能となる。
【0015】
精度のよい制御を可能とするためには、前記電流値情報取得部を、前記電流値情報として前記モータに流れる電流値を検出する電流検出部とするのが効果的である。
【0016】
コスト低減を追求するためには、前記電流値情報取得部を、電圧指令に応じてモータに流れるべき電流値を演算により算出するためのモータモデルを有し、前記電圧制御部に入力する電圧指令と前記モータモデルとに基づき前記モータに流れるべき電流値を前記電流値情報として算出する電流値演算部とするのが効果的である。
【発明の効果】
【0017】
本発明は、以上説明したように、モータに流れる電流値が増大して高電流状態と判定される場合には電圧制御部に入力する電圧指令を制限して、モータに流れる電流を低下させるので、モータ負荷の変動や外乱の変動によりモータに流れる電流が増大したとしても、モータに過大な電流が流れることを回避して過電流からモータを保護することが可能となる。
【発明を実施するための形態】
【0019】
以下、本発明の一実施形態に係るモータ制御装置を、図面を参照して説明する。
【0020】
モータ制御装置である電圧アンプは、
図1に示すように、入力した電圧指令Vに応じた電圧値となるようにモータMに印加する電圧を制御することによりモータMを駆動する電圧制御部1と、電圧制御部1に入力する電圧指令Vを制限する制限手段2と、モータMに流れる電流値Irefに関する電流値情報を取得する電流値情報取得部3とを有する。
【0021】
電圧制御部1は、電圧指令Vに応じた電圧をモータMに印加するためのゲート信号Gsを生成するゲート信号生成部とも呼ばれるPWM処理部10と、PWM処理部10で生成されたゲート信号Gsに応じた電圧をバッテリ等の電源(図示せず)からモータMに印加するゲート回路部11とを備えている。
【0022】
電流値情報取得部3は、モータMに流れる電流値Irefに関する情報を取得するもので、具体的には、モータMに流れる電流値Irefを検出する電流センサとも呼ばれる電流検出部30を主体に構成されている。本実施形態では、モータMに交流電流が通電されるため、電流検出部30の検出した検出電流値Irefを絶対値処理部31を介して絶対値処理を施し、検出電流絶対値|Iref|に変換している。
【0023】
制限手段2は、電流値情報取得部3の取得した電流値情報から得られる電流値Iref(検電流絶対値|Iref|)に基づき高電流状態であるか否か及び高電流状態から通常状態に回復したか否かを判定し、高電流状態であると判定した場合に電圧制御部1に入力する電圧指令Vを制限する一方、高電流状態から通常状態に回復したと判定した場合に電圧制御部1に入力する電圧指令Vの制限を解除するように構成されている。
【0024】
本実施形態では、第一の制限手段2a及び第二の制限手段2bというように、制限手段2を二種類設けて二重構成としている。具体的には、第一の制限手段2aは、電圧指令切換部20と、切換指令部21とを有する。
【0025】
電圧指令切換部20は、外部から入力された電圧指令である外部電圧指令Vrefおよび目標となる電圧値が0であるゼロ電圧指令V
0をそれぞれ入力し、切換指令に応じていずれか一方の電圧指令を電圧制御部1に入力するスイッチの役割を持つ。
【0026】
切換指令部21は、電圧指令切換部20の切換制御を行うもので、電流値情報取得部3の取得した電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)が予め定めた最大電流閾値Th
max以上である場合に、高電流状態であるとしてゼロ電圧指令V
0が電圧制御部1に入力されるように電圧指令切換部20に切換指令を行う一方、電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)が予め定めた解除電流閾値Th
offを下回った場合に、高電流状態から通常状態に回復したとして外部電圧指令Vrefが電圧制御部1に入力されるように電圧指令切換部20に切替指令を行うように構成されている。解除電流閾値Th
offは、
図2に示すように、最大電流閾値Th
maxよりも低い値に設定され、双方の閾値(Th
off、Th
max)の間に不感帯を設けてヒステリシス性を持たせてあり、電圧指令Vの制限状態とその制限が解除された解除状態との切り換えが頻発するチャタリングの発生を防止するようにしている。すなわち、第一の制限手段2aでは、
図2に示すように、高電流状態は、モータに流れる電流値Iref(検出電流絶対値|Iref|)が或る範囲(Th
off〜Th
max)よりも大きい状態であるとし、通常状態は、モータに流れる電流値Iref(検出電流絶対値|Iref|)が或る範囲(Th
off〜Th
max)よりも小さい状態であるとしている。この或る範囲(Th
off〜Th
max)は、モータの特性等によって予め設定される。なお、解除電流閾値Th
offを最大電流閾値Th
maxと同じ値に設定してもよい。
【0027】
図1に示すように、第一の制限手段2aに対して第二の制限手段2bは、電圧指令切換部20から電圧制御部1に入力される電圧指令Vを修正する電圧指令修正部22を主体とするもので、電流値情報取得部3の取得した電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)が予め定めた調整抜き電流閾値Th
max以上である間、電圧制御部1に入力する電圧指令Vを制限する方向に修正する一方、電流値情報から得られる電流値Iref(検出電流絶対値|Iref)が調整抜き電流閾値Th
maxを下回る間、制限を解除する方向に電圧指令Vを修正する。電圧指令修正部22は、電圧指令Vの修正を行う際、単位時間あたりの電圧指令Vの修正を予め定めた範囲内に留めて電圧指令Vの修正を複数回繰り返すように構成されている。具体的に、電圧指令Vの修正は、電圧指令切換部20から電圧制御部1に入力される電圧指令に調整ゲインGを乗算器22bで乗算することで行われる。この調整ゲインGは、電圧指令修正部22を構成する調整ゲイン演算部22aが算出する。調整ゲイン演算部22aは、
図3に示すように、検出電流絶対値|Iref|が調整抜き電流閾値Th
max以上である間、その間継続して調整ゲインGの値を一定勾配で減算していく。例えば、調整ゲインGが1.0000とした場合、1演算周期(単位時間)毎に調整ゲインを0.0001ずつ減算する。一方、検出電流絶対値|Iref|が調整抜き電流閾値Th
maxを下回った場合、調整ゲインGに対し0.0001ずつ加算する。調整ゲインGの上限値は1.0000に、下限値は0.0000に設定されている。すなわち、
図1に示す第二の制限手段2bでは、
図3に示すように、高電流状態は、モータMに流れる電流値が或る値(調整抜き閾値Th
z)よりも大きい状態であるとし、通常状態は、モータMに流れる電流値が或る値(調整抜き閾値Th
z)よりも小さい状態であるとしている。この或る値(調整抜き閾値Th
z)は、モータMの特性等によって予め設定される。
【0028】
上記構成のモータ制御装置の動作を以下説明する。本実施形態では、第一の制限手段2a及び第二の制限手段2bが協働して電圧指令Vを二段階で制限するが、説明を簡略化するために、それぞれの動作に分けて以下説明する。
【0029】
すなわち、第一の制限手段2aの動作については、
図2に示すように、検出電流絶対値|Iref|が増大して最大電流閾値Th
max以上になると、
図1に示す切換指令部21の切換指令により電圧指令切換部20が電圧制御部1に入力される電圧指令Vをゼロ電圧指令V
0に切り換え、電圧指令の制限状態(電圧印加の停止状態、制御停止状態)となり、これに伴いモータ電流が
図2に示すようにL/R時定数で降下する。検出電流絶対値|Iref|が減少して解除電流閾値Th
offを下回ると、
図1に示す切換指令部21の切換指令により電圧指令切換部20が電圧制御部1に入力される電圧指令Vを外部電圧指令Vrefに切り換え、電圧指令の制限が解除された解除状態(電圧印加の再開、制御再開)となり、通常の制御に復帰する。
【0030】
第二の制限手段2bの動作については、
図3に示すように、検出電流絶対値|Iref|が増大して調整抜き閾値Th
z以上になると、調整ゲイン演算部22a(
図1参照)により調整ゲインGが1.0000から一定勾配で減少し、これに伴い電圧指令が制限され、モータ電流が抑制される。検出電流絶対値|Iref|が減少して調整抜き閾値Th
zを下回ると、調整ゲイン演算部22a(
図1参照)により調整ゲインGが一定勾配で加算されて復帰し、これに伴い電圧指令の制限が解除され、モータ電流の抑制が解除される。このように電圧指令Vの制限が徐々に行われるので、急峻な電圧指令変化を実施することによりモータ動作が不安定状態に陥ることを防止している。
【0031】
上記では、第一及び第二の制限手段2a・2bの動作を別々に説明したが、本実施形態では、
図1に示すように、第二の制限手段2bで用いる調整抜き閾値Th
zを、第一の制限手段2aで用いる最大電流閾値Th
maxよりも低い値に設定して、モータ電流の上昇に伴い先に第二の制限手段2bによる電圧指令Vの制限が働き、それでもモータ電流が上昇する場合に第一の制限手段2aによる電圧指令Vの制限が働くようにし、急激な電圧指令Vの変化を回避することによるモータ動作の安定化と、モータMに対する最大電流閾値Th
max以上の通電をカットすることによるモータの損傷の確実な防止とを適切に両立させている。
【0032】
以上のように、本実施形態のモータ制御装置は、入力される電圧指令Vに応じた電圧値となるようにモータMに印加する電圧を制御することによりモータMを駆動する電圧制御部1と、電圧制御部1に入力する電圧指令Vを制限する制限手段2と、モータMに流れる電流値Irefに関する電流値情報を取得する電流値情報取得部3とを備え、制限手段2は、電流値情報取得部3の取得した電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)に基づき高電流状態であるか否か及び高電流状態から通常状態に回復したか否かを判定し、高電流状態であると判定した場合に電圧制御部1に入力する電圧指令Vを制限する一方、高電流状態から通常状態に回復したと判定した場合に電圧制御部1に入力する電圧指令Vの制限を解除するように構成されている。
【0033】
高電流状態は、モータMに流れる電流値が或る値又は或る範囲よりも大きい状態をいい、通常状態は、モータMに流れる電流値が或る値又は或る範囲よりも小さい状態をいい、これら或る値又は或る範囲は、モータMの特性等によって予め設定されるものである。
【0034】
このように、モータMに流れる電流値Iref(検出電流絶対値|Iref|)が増大して高電流状態と判定される場合には電圧制御部1に入力する電圧指令Vを制限し、電圧指令VすなわちモータMに印加する電圧を制限することでモータMに流れる電流を低下させる一方、モータMに流す電流値Iref(検出電流絶対値|Iref|)が低下して高電流状態から通常状態に回復したと判定される場合には電圧指令Vの制限を解除するので、モータ負荷の変動や外乱の変動によりモータMに流れる電流が増大したとしても、モータMに過大な電流が流れることを回避して過電流からモータMを保護することが可能となる。
【0035】
本実施形態では、外部から入力された電圧指令である外部電圧指令Vrefおよび目標となる電圧値が0であるゼロ電圧指令V
0をそれぞれ入力し、切換指令に応じていずれか一方の電圧指令を電圧制御部1に入力する電圧指令切換部20と、電流値情報取得部3の取得した電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)が予め定めた最大電流閾値Th
max以上である場合に、ゼロ電圧指令V
0が電圧制御部1に入力されるように電圧指令切換部20に切換指令を行う一方、電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)が予め定めた解除電流閾値Th
offを下回った場合に、外部電圧指令Vrefが電圧制御部1に入力されるように電圧指令切換部20に切換指令を行う切換指令部21とを設けているので、電流値情報から得られるモータMに流れる電流値Iref(検出電流絶対値|Iref|)が予め定めた最大電流閾値Th
max以上である場合には、目標となる電圧値が0であるゼロ電圧指令V
0が電圧制御部1に入力され、即座に電流を低減させる一方、電流値情報から得られるモータMに流れる電流値Iref(検出電流絶対値|Iref|)が予め定めた解除電流閾値Th
offを下回った場合に外部電圧指令Vrefが電圧制御部1に入力され、外部電圧指令Vrefに基づく電圧制御に復帰するので、最大電流閾値Th
max以上の電流がモータに流れなくなり、過電流によるモータMの減磁等の損傷を的確に防止することが可能となる。
【0036】
特に、本実施形態では、解除電流閾値Th
offを最大電流閾値Th
maxよりも低い値に設定して双方の閾値の間に不感帯を設けてヒステリシス性を持たせているので、電圧指令の制限状態とその制限が解除された解除状態との切り換えが頻発するチャタリングを防止してモータ制御を安定させることが可能となる。勿論、解除電流閾値Th
offを最大電流閾値Th
maxと同じ値に設定してもよい。
【0037】
さらに、本実施形態では、電流値情報取得部3の取得した電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)が予め定めた調整抜き電流閾値Th
max以上である間、電圧制御部1に入力する電圧指令Vを制限する方向に修正する一方、電流値情報から得られる電流値Iref(検出電流絶対値|Iref|)が調整抜き電流閾値Th
maxを下回る間、制限を解除する方向に電圧指令Vを修正する電圧指令修正部22を備え、電圧指令修正部22は、単位時間あたりの電圧指令Vの修正を予め定めた範囲内に留めて電圧指令Vの修正を複数回繰り返すように構成されているので、電流値情報から得られるモータMに流れる電流値Iref(検出電流絶対値|Iref|)が予め定めた調整抜き電流閾値Th
max以上である場合に、即座に電圧指令Vをカットするのではなく、予め定めた範囲内で電圧指令Vを制限する修正を複数回繰り返し、電圧指令Vを漸減させるので、急激な電圧指令Vの変化を回避しながら過電流によるモータMの減磁等の損傷を有効に防止することができ、モータ動作を安定させることが可能となる。電圧指令Vの制限を解除する場合も同様である。
【0038】
特に、本実施形態では、第一の制限手段2aと第二の制限手段2bとを有し、第二の制限手段2bで用いる調整抜き電流閾値Th
maxを第一の制限手段2aで用いる最大電流閾値Th
maxよりも低い値に設定しているので、急激な電圧指令Vの変化を回避することによるモータ動作の安定化と、モータMに対する最大電流閾値Th
max以上の通電をカットすることによるモータMの損傷の確実な防止とを適切に両立させることが可能となる。
【0039】
その他、本実施形態では、電流値情報取得部3は、電流値情報としてモータMに流れる電流値Irefを検出する電流検出部30であるので、モータMに流れる電流を直接検出して、実際の値に基づく精度のよい制御が可能となる。
【0040】
以上、本発明の一実施形態について説明したが、各部の具体的な構成は、上述した実施形態のみに限定されるものではない。
【0041】
例えば、
図4に示すように、電圧指令Vに応じてモータMに流れるべき電流値を演算により算出するための状態変数等を用いたモータモデル103aを有し、電圧制御部1に入力する電圧指令Vとモータモデル103aとに基づきモータMに流れるべき電流値を前記電流値情報として算出する電流値演算部103bを設けて電流値情報取得部103を構成してもよい。このように構成すれば、モータMに流れる電流を検出する高価な電流検出部30を不要としてコストを低減させることが可能となる。
【0042】
また、本実施形態では、第二の制限手段2bにおいて検出電流値が調整抜き閾値Th
zを下回った場合に、調整ゲインGを制限を解除する方向に修正しているが、検出電流値が調整抜き閾値Th
z以上になった場合に、事前に設定していた所定時間の間隔で一定勾配で一度調整ゲインGを低下させ、調整ゲインGを所定の値(例えば0.5)まで下げた後、再度一定勾配で調整ゲインGを元に戻すようにしてもよい。
【0043】
また、本実施形態では、第一の制限手段2a及び第二の制限手段2bを両方備えたものであるが、いずれか一方だけを備えたものであってもよい。
【0044】
その他、本発明の趣旨を逸脱しない範囲で種々変形が可能である。