(57)【要約】  電流制御ループの応答性を向上させることができると共に、サーボモータが発振するのを防止できるサーボモータの制御装置を提供する。  本発明のサーボモータの制御装置は、電流制御ループでフィードバックされるサーボモータの出力電流値を検知する電流検知手段と、検知した出力電流値があらかじめ設定されたしきい値よりも小さいときは、電流制御ループのゲインを大きくする一方、検知した出力電流値があらかじめ設定されたしきい値よりも大きいときは、電流制御ループのゲインを小さくする電流ループゲイン切替え手段と、を備える。
2007126024.tif 000002
【特許請求の範囲】
【請求項１】
サーボモータに流れる電流をフィードバック制御する電流制御ループを有するサーボモータの制御装置において、
前記電流制御ループでフィードバックされるサーボモータの出力電流値を検知する電流検知手段と、
検知した前記出力電流値があらかじめ設定されたしきい値よりも小さいときは、前記電流制御ループのゲインを大きくする一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、前記電流制御ループのゲインを小さくする電流ループゲイン切替え手段と、を備えることを特徴とするサーボモータの制御装置。
【請求項２】
前記サーボモータの制御装置は、電流のフィードバック制御をｄ−ｑ座標を用いたＰＩ制御により行い、
そして、電流ループゲイン切替え手段は、検知した前記出力電流値があらかじめ設定された前記しきい値よりも小さいときは、あらかじめ設定された大小二つの交差角周波数のうち、大きい方の交差角周波数を用いて前記電流制御ループのゲインを算出して、前記電流制御ループのゲインを大きくする一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、小さい方の交差角周波数を用いて前記電流制御ループのゲインを算出して、前記電流制御ループのゲインを小さくすることを特徴とする請求項１に記載のサーボモータの制御装置。
【請求項３】
前記しきい値はサーボモータの定格電流値であることを特徴とする請求項１又は２に記載のサーボモータの制御装置。
【請求項４】
前記サーボモータの制御装置は、前記電流制御ループの外側にサーボモータの速度をフィードバック制御する速度制御ループを有し、且つ、前記速度制御ループの外側にサーボモータの位置をフィードバック制御する位置制御ループを有することを特徴とする請求項１又は２に記載のサーボモータの制御装置。
【請求項５】
サーボモータに流れる電流をフィードバック制御する電流制御ループを有するサーボモータの制御方法において、
前記電流制御ループでフィードバックされるサーボモータの出力電流値を検知する電流検知工程と、
検知した前記出力電流値があらかじめ設定されたしきい値よりも小さいときは、前記電流制御ループのゲインを大きくする一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、前記電流制御ループのゲインを小さくする電流ループゲイン切替え工程と、を備えることを特徴とするサーボモータの制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、サーボモータの制御装置に関し、特にサーボモータに流れる電流をフィードバック制御する電流制御ループを有するサーボモータの制御装置に関する。
【背景技術】
【０００２】
サーボモータの一種である永久磁石同期モータは、永久磁石で界磁磁束を作り、界磁磁束と合成ベクトルが直交するように三相電機子電流を流すことによりトルクを発生させる。永久磁石同期モータのシステム構成を図８に示す。永久磁石同期モータ４１とそれに電力を供給する電圧型ＰＷＭインバータ等の電力変換器４２、電力変換器４２が永久磁石同期モータ４１に供給する電圧、あるいは流す電流の位相を決定するための磁極位置検出器４３、及び電流制御を行うための電流制御器４４が基本構成になる。速度制御を行う場合はそのための速度制御器４５及び検出器４３、さらに位置制御を行う場合はそのための位置制御器４６及び検出器４３が付加される。磁極位置検出器、速度検出器及び位置検出器は共用されることが多い。【０００３】
速度制御器４５や位置制御器４６では、従来から制御ループのゲインを切替えることが行われている（例えば特許文献１参照）。特許文献１に記載の発明では、速度制御ループにより出力されるトルク指令の大きさが小さい場合には速度制御ループのゲインを大きくし、トルク指令の大きさが小さい場合には速度制御ループのゲインを小さくしている。これにより、トルク指令の大きさが小さい場合には、位置偏差及び速度偏差の収束が速くなり応答性が向上する。その一方、トルク指令が大きいときには、機械的振動が起きるのを防止している。【０００４】
【特許文献１】特開平５−１３４７５０号公報
【発明の開示】
【発明が解決しようとする課題】
【０００５】
制御系は位置制御ループ、速度制御ループ、電流制御ループの三つから構成される。位置制御ループがメインループで、速度制御ループ、電流制御ループの順でよりマイナーなループになる。電流制御ループは最も内側にあるループだから、応答性のよい制御ループを組む必要がある。なぜならば、電流制御ループのゲインを上げて応答性を良くしなければ、その上位ループとなる速度制御ループ及び位置制御ループのゲインを上げても応答性が向上しないからである。つまり、マイナーループである電流制御ループの応答を外側のループの応答より十分高くなるように設定する（言い換えれば、マイナーループの交差角周波数をその外側のループの交差角周波数より高くする）ことで、外側のループの応答性や安定性の向上が図れる。【０００６】
電流制御系は、モータの電気系や電力変換器などで構成され、系の状態変化が小さい。したがって、速度制御器や位置制御器と異なり、電流制御器のゲインは一般に固定値に設定される。しかし、高応答で制御を行うため電流制御ループのゲインを大きくし、サーボモータに大きな電流を流すと、サーボモータのパラメータ（電機子巻線抵抗Ｒ，電機子巻線抵抗自己インピーダンスＬ）によっては、サーボモータが発振してしまう。【０００７】
そこで、本発明は電流制御ループの応答性を向上させることができると共に、サーボモータが発振するのを防止できるサーボモータの制御装置及び方法を提供することを目的とする。
【課題を解決するための手段】
【０００８】
上記課題を解決するために、請求項１に記載の発明は、サーボモータに流れる電流をフィードバック制御する電流制御ループを有するサーボモータの制御装置において、前記電流制御ループでフィードバックされるサーボモータの出力電流値を検知する電流検知手段と、検知した前記出力電流値があらかじめ設定されたしきい値よりも小さいときは、前記電流制御ループのゲインを大きくする一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、前記電流制御ループのゲインを小さくする電流ループゲイン切替え手段と、を備えることを特徴とする。【０００９】
請求項２に記載の発明は、請求項１に記載のサーボモータの制御装置において、前記サーボモータの制御装置は、電流のフィードバック制御をｄ−ｑ座標を用いたＰＩ制御により行い、そして、電流ループゲイン切替え手段は、検知した前記出力電流値があらかじめ設定された前記しきい値よりも小さいときは、あらかじめ設定された大小二つの交差角周波数のうち、大きい方の交差角周波数を用いて前記電流制御ループのゲインを算出して、前記電流制御ループのゲインを大きくする一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、小さい方の交差角周波数を用いて前記電流制御ループのゲインを算出して、前記電流制御ループのゲインを小さくすることを特徴とする。【００１０】
請求項３に記載の発明は、請求項１又は２に記載のサーボモータの制御装置において、前記しきい値はサーボモータの定格電流値であることを特徴とする。【００１１】
請求項４に記載の発明は、請求項１ないし３いずれかに記載のサーボモータの制御装置において、前記サーボモータの制御装置は、前記電流制御ループの外側にサーボモータの速度をフィードバック制御する速度制御ループを有し、且つ、前記速度制御ループの外側にサーボモータの位置をフィードバック制御する位置制御ループを有することを特徴とする。【００１２】
請求項５に記載の発明は、サーボモータに流れる電流をフィードバック制御する電流制御ループを有するサーボモータの制御方法において、前記電流制御ループでフィードバックされるサーボモータの出力電流値を検知する電流検知工程と、検知した前記出力電流値があらかじめ設定されたしきい値よりも小さいときは、前記電流制御ループのゲインを大きくする一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、前記電流制御ループのゲインを小さくする電流ループゲイン切替え工程と、を備えることを特徴とする。
【発明の効果】
【００１３】
請求項１に記載の発明によれば、電流制御ループの応答性を向上することができると共にサーボモータが発振するのを防止することができる。【００１４】
請求項２に記載の発明によれば、大小二つの交差角周波数を用いてゲインを算出するので、電流制御ループのゲインを切替えるためのプログラムを容易にすることができる。【００１５】
請求項３に記載の発明によれば、サーボモータに定格電流が流れるときまではゲインを大きくし、定格電流より大きい電流が流れるときはゲインを小さくすることができる。このため、電流制御ループの応答性を向上させた上でサーボモータの発振を確実に防止できる。【００１６】
請求項４に記載の発明によれば、電流制御ループの応答性を向上できるので、上位ループとなる速度制御ループ及び位置制御ループの応答性も向上させることができる。【００１７】
請求項５に記載の発明によれば、電流制御ループの応答性を向上することができると共にサーボモータが発振するのを防止することができる。
【図面の簡単な説明】
【００１８】
【図１】可動コイル型永久磁石同期リニアモータの斜視図
【図２】ｄ−ｑ座標系を用いた永久磁石同期モータの制御の全体構成図
【図３】電流制御器を付加した永久磁石同期モータのブロック線図
【図４】オープンループ伝達関数から得られるボード線図
【図５】クローズドループ伝達関数から得られるボード線図
【図６】電流制御プログラムのフローチャート
【図７】ゲインの切替えを示す概念図
【図８】永久磁石同期モータのシステム構成図
【符号の説明】
【００１９】
１…固定子
２…永久磁石
３…可動子
４…コイル
５…サーボモータ
６…電力変換器
７…検出器
８…速度制御器
９…速度検出器
１０…位置制御器
１１…位置検出器
１２…ｄ軸電流制御器
１３…ｑ軸電流制御器
１４…ベクトル回転器・３相２相変換器
１５…電流検出器
１６…位相検出器
１７…ベクトル回転器・２相３相変換器
【発明を実施するための最良の形態】
【００２０】
以下添付図面に基づいて本発明の実施形態を詳細に説明する。本実施形態では、図１に示されるように、サーボモータ５として可動コイル型永久磁石同期リニアモータを使用する。この可動コイル型永久磁石同期リニアモータでは、固定子１側にＮ極とＳ極の永久磁石２が交互に配置され、可動子３側にＵ，Ｖ，Ｗ相のコイル４が巻かれる。コイル４に三相電機子電流を流すことによって直線的に移動する移動界磁が発生し、可動子３が固定子１に対して直線的に移動する。【００２１】
界磁が直線的に移動する可動コイル型永久磁石同期リニアモータでも、界磁が回転する回転界磁型同期モータと同様に、回転座標のｄ−ｑ座標系を用いてｄ，ｑ軸電機子電流を制御する。モータの固定された部分と回転する部分をともに、回転する直交座標へ変換するのがｄ−ｑ変換であり、その座標系がｄ−ｑ座標系である。ｑ軸はｄ軸に対してπ／２進んだ位相にある。永久磁石同期モータの場合、ｄ軸は界磁の作る磁束の方向に採るのが一般的である。【００２２】
図２は、ｄ−ｑ座標系を用いたサーボモータ５の制御の全体構成を示す。サーボモータ５とそれに電力を供給する電圧形ＰＷＭインバータ等の電力変換器６、電力変換器６がサーボモータ５に印加する電圧、あるいは流す電流の位相を決定するためのリニアスケール等の磁極位置検出器７、及び電流制御を行うための電流制御器１２，１３が基本構成である。速度制御を行う場合はそのための速度制御器８及び速度検出器９、さらに位置制御を行う場合はそのための位置制御器１０及び位置検出器１１が付加される。速度検出器９、位置検出器１１は磁極位置検出器７と共用される。制御系は位置制御ループ、速度制御ループ、電流制御ループの三つから構成される。位置制御ループがメインループで、速度制御ループ、電流制御ループの順でよりマイナーなループになる。【００２３】
位置制御器１０は、上位制御装置から出力される位置指令値θ＊rmと位置検出器１１からの位置帰還値θrmの偏差に基づいて速度指令ω＊rmを演算する。速度制御器８は、速度指令値ω＊rmと速度検出器９からの速度帰還値ωrmの偏差に基づいて推力指令を演算し、さらにｑ軸電流指令ｉ＊qを演算する。ｄ軸電流制御器１２は、ｄ軸と同方向の電流成分であるｄ軸電流指令ｉ＊dを演算する。永久磁石同期モータでは、磁石によるｄ軸磁束が確立されているので、ｄ軸電流指令ｉ＊dは通常０にして制御する。モータ力率を良くしたり、皮相電力を小さくしたりする観点からｄ軸電流をｄ軸と逆方向に流すこともある。【００２４】
ベクトル回転器・３相２相変換器１４は、電流検出器１５からの三相帰還電流値ｉｕ，ｉｖ，ｉｗを位相検出器１６からの電気角信号θreに基づいて、ｄ軸電流ｉdとｑ軸電流ｉqに変換する。ｄ軸電流制御器１２は、ｄ軸電流指令ｉ＊dとｄ軸電流ｉdとの偏差を取り、ｄ軸電圧の指令値ｖ＊dを演算する。ｑ軸電流制御器１３は、ｑ軸電流指令ｉ＊qとｑ軸電流ｉqとの偏差を取り、ｑ軸電圧の指令値ｖ＊qを演算する。ベクトル回転器・２相３相変換器１７は、これらの電圧指令ｖ＊d，ｖ＊q及び電気角信号θreに基づいて、三相電圧指令ｖ＊u，ｖ＊v，ｖ＊wを出力する。電力変換器６はこれらの電圧指令に基づいて出力電圧をＰＷＭ制御し、最終的にはサーボモータ５に流れる電流を制御する。以上のようにして、サーボモータ５としての永久磁石同期モータに交流電流が供給されることにより、サーボモータ５に推力が発生する。【００２５】
サーボモータ５ではトルクの高速応答制御が必要なので、電流のフィードバック制御が不可欠になる。図３は電流制御器１２，１３を付加した永久磁石同期モータのブロック線図を示す。このブロック線図では、ｄ軸電流ｉd，ｑ軸電流ｉqを理論的に制御し易い状態にする方法として非干渉制御法を用いている。永久磁石同期モータにはｄ，ｑ軸間で干渉し合う速度起電力がある。それらはｉd，ｉqに影響するが直接制御できるものではない。その速度起電力を求めておいてそれを打ち消す制御が非干渉制御法である。非干渉制御を行うと、ｉd，ｉqはｖ´d，ｖ´qで単純に制御できる。ここで、ｖ´d，ｖ´qはｄ，ｑ軸の電機子巻線インピーダンス印加電圧を表し、伝達関数Ｇid（ｓ），Ｇiq（ｓ）で表したｉd，ｉq電流制御器の出力として得られる。またこのブロック線図において、ｉd，ｉqはｄ，ｑ軸電機子電流，φｆは電機子巻線鎖交磁束数，Ｒは電機子巻線抵抗，Ｌは電機子巻線の自己インダクタンス，Ｐ（＝ｄ／ｄｔ）は微分演算子，Ｔeはモータの推力，ＴLはモータの負荷推力，Ｊはモータの慣性モーメント，ωrmは同期モータの出力軸の回転角速度（機械角），ωreは界磁の角速度（電気角）である。同期モータの出力軸の回転角速度（機械角）ωrmは極対数をｐとすると、ωre／ｐである。【００２６】
電流制御としては比例積分（ＰＩ）制御を用いる。この場合、ｉd，ｉq電流制御器の出力ｖ´d，ｖ´qは、
[数式１]
ｖ´d＝Ｋid（１＋１／Ｔidｓ）（ｉ＊d−ｉd）
ｖ´q＝Ｋiq（１＋１／Ｔiqｓ）（ｉ＊q−ｉq）
となる。【００２７】
このとき、ｉd，ｉq制御系のオープンループ伝達関数Ｇoid（ｓ），Ｇoiq（ｓ）は、式を簡単にするためにＴid＝Ｔiq＝Ｌ／Ｒ（電気時定数）に選ぶと、
[数式２]
Ｇoid（ｓ）＝１／（Ｌｓ／Ｋid）
Ｇoiq（ｓ）＝１／（Ｌｓ／Ｋiq）
となり、単なる積分要素になる。
ここで、Ｋid，Ｋiq及びＴid，Ｔiqはｉd，ｉq制御器のゲイン及び積分時間であり、Ｋid＝Ｋiq，Ｔid＝Ｔiqである。【００２８】
図４はこのオープンループ伝達関数から得られるボード線図で、交差角周波数ωcは、
[数式３]
ωc＝Ｋi／Ｌ    （Ｋi＝Ｋid＝Ｋiq）
である。【００２９】
数式２が満足されるときｉd，ｉq制御系のクローズドループ伝達関数Ｇcid（ｓ），Ｇciq（ｓ）は、
[数式４]
Ｇcid（ｓ）＝１／（Ｌｓ／Ｋid＋１）
Ｇciq（ｓ）＝１／（Ｌｓ／Ｋiq＋１）
となる。【００３０】
図５はクローズドループ伝達関数から得られるボード線図である。ｓ＝０のときのゲインはＫid，Ｋiqに関係なく０ｄＢであり、定常偏差が０になることがわかる。【００３１】
電流制御をＰＩ制御で行う場合、上述のように積分時間Ｔid，Ｔiqは電気時定数（Ｌ／Ｒ）に合わせる。また[数式３]に示される、交差角周波数ωcから求められるゲイン（Ｋid，Ｋiq）は反応性を上げるためにできるだけ高くするのがよい。マイナーループの交差角周波数をその外側のループの交差角周波数より高くすることで、外側のループの応答性や安定性の向上が図れるからである。しかし、電流制御ループのゲインを高く設定してモータに大きな電流を流すと、モータが発振してしまうことがある。そこで本実施形態では、電流制御ループでフィードバックされるサーボモータの出力電流値にしきい値を設け、電流制御ループのゲインを切替えている。【００３２】
図６はサーボモータの制御装置のプロセッサで実行される電流制御プログラムのフローチャートを示す。この電流制御プログラムにおいて、制御装置のプロセッサ（請求項１に記載の電流ループゲイン切替え手段に相当）はまず、電流制御ループでフィードバックされるサーボモータの出力電流値があらかじめ設定されたしきい値以上か否かを判断する（Ｓ１）。ここで、しきい値はサーボモータの定格電流値、すなわち定格推力を生じさせる電流値に設定される。しきい値データはあらかじめ制御装置のメモリに記憶されている。またサーボモータの出力電流値とは、図２に示されるベクトル回転器・３相２相変換器１４からフィードバックされるｑ軸電流ｉqの値である。このため請求項１に記載の電流検知手段は、ベクトル回転器・３相２相変換器１４、電流検出器１５、位相検出器１６によって構成される。【００３３】
次に制御装置のプロセッサは、検知した出力電流値があらかじめ設定されたしきい値よりも小さいときは、あらかじめ設定された大小二つの交差角周波数ωc1，ωc2のうち、大きい方の交差角周波数ωc1を用いて電流制御ループのゲインを算出して、電流制御ループのゲインを大きくする（Ｓ２）。その一方、検知した出力電流値があらかじめ設定されたしきい値よりも大きいときは、小さい方の交差角周波数ωc2を用いて電流制御ループのゲインを算出し、電流制御ループのゲインを小さくする（Ｓ３）。【００３４】
大きい方の交差角周波数ωc1（例えば２０００rad/s）は、サーボモータに定格電流を流したときにサーボモータが発振しない範囲で最も大きい値になるように設定される。小さい方の交差角周波数ωc2（例えば１０００rad/s）は、サーボモータに定格電流を超えた最大電流を流したときにサーボモータが発振しない範囲で最も大きい値になるように設定される。制御装置のメモリには、大小二つの交差角周波数ωc1，ωc2が記憶される。これら大小二つの交差角周波数ωc1，ωc2から[数式３]を用いてゲインＫiを算出する。【００３５】
次に制御装置のプロセッサは、ゲインＫid，Ｋiq、積分時間Ｔid，Ｔiq、ｄ軸電流指令ｉ＊d，ｑ軸電流指令ｉ＊q、及びフィードバックされたｄ軸電流ｉd，ｑ軸電流ｉqの偏差から、[数式１]を用いてｖ´d（＝ｄ軸電圧の指令値ｖ＊d）及びｖ´q（ｑ軸電圧の指令値ｖ＊q）を算出する（Ｓ４）。【００３６】
なお、制御装置のプロセッサは、電流制御ループの処理と共に速度制御ループ及び位置制御ループの処理を行う。速度制御系では、電流制御系と同様に偏差を０にするためにＰＩ制御が用いられる。電流制御系の交差角周波数ωcを速度制御系の交差角周波数ωscよりも数倍以上高くすると、交差角周波数がωscの付近では、電流制御系のクローズドループ伝達関数を１とみなすことができ、電流制御系の特性が速度制御系に及ぼす影響を無視することができる。位置制御系では位置のステップ応答がオーバシュートを生じるのを防止するためにＰ制御が用いられる。速度制御系の交差角周波数ωscを位置制御系の交差角周波数ωpよりも数倍以上高くすると、交差角周波数がωpの付近では、速度制御系のクローズドループ伝達関数を１とみなすことができ、速度制御系の特性が位置制御系に及ぼす影響を無視することができる。【００３７】
以上に記載の電流制御法により、定格電流まではゲインを大きくし、定格電流を超えたときはゲインを小さくするゲインの切替えが可能になる。図７はゲインの切替えを示す概念図である。この図７において、サーボモータの出力電流値が時間の経過に比例して上昇する。図中点線は発振する電流値（例えば定格電流値）を示す。サーボモータの出力電流値が発振する電流値（例えば定格電流値）より小さいときは、サーボモータが発振するおそれもないので、ゲインを大きい方の交差角周波数ωc1（例えば２０００rad/s）を用いて算出して、電流制御ループの応答性を向上させる。一方、サーボモータの出力電流値が発振する電流値を超えたときにもゲインを大きく設定したままだと、サーボモータの電流の振幅が大きくなってサーボモータが発振する。このため、小さい方の交差角周波数ωc2（例えば１０００rad/s）を用いてゲインを算出し直し、ゲインを小さい値に切替えて、サーボモータの発振を防止する。以上により、電流制御ループの応答性を向上させることと、サーボモータの発振を防止することとを両立させることが可能になる。【００３８】
なお、本発明は上記実施形態に限られることなく、本発明の要旨を変更しない範囲で種々変更可能である。例えば上記実施形態では、サーボモータとして可動コイル型永久磁石同期リニアモータを用いた例について説明したが、本発明のサーボモータの制御装置は、回転型の永久磁石同期モータや、誘導モータに適用することができる。【００３９】
本明細書は、２００６年４月２８日出願の特願２００６−１２４９５４に基づく。この内容はすべてここに含めておく。
【図１】
2007126024.tif 000003
【図２】
2007126024.tif 000004
【図３】
2007126024.tif 000005
【図４】
2007126024.tif 000006
【図５】
2007126024.tif 000007
【図６】
2007126024.tif 000008
【図７】
2007126024.tif 000009
【図８】
2007126024.tif 000010
【手続補正書】
【提出日】平成20年3月17日(2008.3.17)
【手続補正１】
【補正対象書類名】特許請求の範囲
【補正対象項目名】請求項２
【補正方法】変更
【補正の内容】
【請求項２】
前記サーボモータの制御装置は、電流のフィードバック制御をｄ−ｑ座標を用いたＰＩ制御により行い、
そして、電流ループゲイン切替え手段は、検知した前記出力電流値があらかじめ設定された前記しきい値よりも小さいときは、あらかじめ設定された大小二つの交差角周波数のうち、大きい方の交差角周波数を用いて算出した大きい方の電流制御ループゲインに切り替える一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、小さい方の交差角周波数を用いて算出した小さい方の電流制御ループゲインに切り替えることを特徴とする請求項１に記載のサーボモータの制御装置。
【手続補正２】
【補正対象書類名】明細書
【補正対象項目名】０００３
【補正方法】変更
【補正の内容】
【０００３】
値があらかじめ設定された前記しきい値よりも小さいときは、あらかじめ設定された大小二つの交差角周波数のうち、大きい方の交差角周波数を用いて算出した大きい方の電流制御ループゲインに切り替える一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、小さい方の交差角周波数を用いて算出した小さい方の電流制御ループゲインに切り替えることを特徴とする。
［００１０］
請求項３に記載の発明は、請求項１又は２に記載のサーボモータの制御装置において、前記しきい値はサーボモータの定格電流値であることを特徴とする。
［００１１］
請求項４に記載の発明は、請求項１ないし３いずれかに記載のサーボモータの制御装置において、前記サーボモータの制御装置は、前記電流制御ループの外側にサーボモータの速度をフィードバック制御する速度制御ループを有し、且つ、前記速度制御ループの外側にサーボモータの位置をフィードバック制御する位置制御ループを有することを特徴とする。
［００１２］
請求項５に記載の発明は、サーボモータに流れる電流をフィードバック制御する電流制御ループを有するサーボモータの制御方法において、前記電流制御ループでフィードバックされるサーボモータの出力電流値を検知する電流検知工程と、検知した前記出力電流値があらかじめ設定されたしきい値よりも小さいときは、前記電流制御ループのゲインを大きくする一方、検知した前記出力電流値があらかじめ設定された前記しきい値よりも大きいときは、前記電流制御ループのゲインを小さくするループゲイン切替え工程と、を備えることを特徴とする。
発明の効果
［００１３］
請求項１に記載の発明によれば、電流制御ループの応答性を向上することができると共にサーボモータが発振するのを防止することができる。
［００１４］
請求項２に記載の発明によれば、大小二つの交差角周波数を用いてゲインを算出するので、電流制御ループのゲインを切替えるためのプログラムを容易にすることができる。
［００１５］
請求項３に記載の発明によれば、サーボモータに定格電流が流れるときまではゲインを大きくし、定格電流より大きい電流が流れるときはゲインを小さくすることができる
【国際調査報告】
2007126024.tif 000011
2007126024.tif 000012