JP2820820B2 - サーボモータの制御装置 - Google Patents
サーボモータの制御装置Info
- Publication number
- JP2820820B2 JP2820820B2 JP3322425A JP32242591A JP2820820B2 JP 2820820 B2 JP2820820 B2 JP 2820820B2 JP 3322425 A JP3322425 A JP 3322425A JP 32242591 A JP32242591 A JP 32242591A JP 2820820 B2 JP2820820 B2 JP 2820820B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- gain
- torque command
- control
- 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 - Lifetime
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41024—High gain for low command speed, torque or position error equals or near zero
Description
【０００１】
【産業上の利用分野】本発明は、工作機械やロボットの
駆動源として使用されるサーボモータの制御装置に関す
る。
駆動源として使用されるサーボモータの制御装置に関す
る。
【０００２】
【従来の技術】工作機械の送り軸やロボットのアーム等
はサーボモータで駆動され、該サーボモータによって速
度ループ制御や位置ループ制御が行われている。この従
来のサーボモータの制御においては、速度ループのゲイ
ンは常に一定にされ、機械的な共振を引き起こすゲイン
レベルに対してある程度のマージンをもった値に設定さ
れている。図１はサーボモータ位置制御系の一例のブロ
ック図で、１は位置制御部でＫｐは位置ループゲインで
ある。また、２は速度制御部でｋ１は積分ゲイン、ｋ２
は比例ゲインである。３はモータ，機械系で、４は速度
を積分して位置を求める項を示している。位置指令θｄ
から位置検出器等で検出される位置θを減じて位置偏差
を求め、該位置偏差に位置ループゲインを乗じて速度指
令ｖｄを求め、該速度指令ｖｄから速度検出器等で検出
される実速度ｖを減じて速度偏差を求め該速度偏差を積
分し、その積分値に積分ゲインｋ１を乗じた値と、速度
偏差に比例ゲインｋ２を乗じた値を加算してトルク指令
（電流指令）Ｔｃを求め、このトルク指令に基づいて
（さらには電流ループ制御を行って）サーボモータを駆
動することが一般的に行われている。また、位置ループ
制御を行わず、速度ループ制御のみのサーボモータの制
御も一般的に行われている。
はサーボモータで駆動され、該サーボモータによって速
度ループ制御や位置ループ制御が行われている。この従
来のサーボモータの制御においては、速度ループのゲイ
ンは常に一定にされ、機械的な共振を引き起こすゲイン
レベルに対してある程度のマージンをもった値に設定さ
れている。図１はサーボモータ位置制御系の一例のブロ
ック図で、１は位置制御部でＫｐは位置ループゲインで
ある。また、２は速度制御部でｋ１は積分ゲイン、ｋ２
は比例ゲインである。３はモータ，機械系で、４は速度
を積分して位置を求める項を示している。位置指令θｄ
から位置検出器等で検出される位置θを減じて位置偏差
を求め、該位置偏差に位置ループゲインを乗じて速度指
令ｖｄを求め、該速度指令ｖｄから速度検出器等で検出
される実速度ｖを減じて速度偏差を求め該速度偏差を積
分し、その積分値に積分ゲインｋ１を乗じた値と、速度
偏差に比例ゲインｋ２を乗じた値を加算してトルク指令
（電流指令）Ｔｃを求め、このトルク指令に基づいて
（さらには電流ループ制御を行って）サーボモータを駆
動することが一般的に行われている。また、位置ループ
制御を行わず、速度ループ制御のみのサーボモータの制
御も一般的に行われている。
【０００３】
【発明が解決しようとする課題】上述したようなサーボ
モータの制御において、位置偏差が小さくなり、かつ速
度偏差も小さくなると、当然トルク指令Ｔｃを小さくな
り、サーボモータの出力トルクが小さくなることから、
位置偏差や速度偏差の速やかな収束が難しい。速やかな
収束を行うには、速度制御部の積分ゲイン，比例ゲイン
を高くすればよく、ゲインを高くすれば収束が速くなる
と共に、応答性も高くなり外乱要素にも強くなって制御
系の性能は向上する。しかし、トルク指令が大きくなっ
たとき、ゲインが高いと機械的な共振を引き起こし、ま
た、速度指令の変化が大きいと、オーバシュート，アン
ダーシュートが生じふらつきが生じる。
モータの制御において、位置偏差が小さくなり、かつ速
度偏差も小さくなると、当然トルク指令Ｔｃを小さくな
り、サーボモータの出力トルクが小さくなることから、
位置偏差や速度偏差の速やかな収束が難しい。速やかな
収束を行うには、速度制御部の積分ゲイン，比例ゲイン
を高くすればよく、ゲインを高くすれば収束が速くなる
と共に、応答性も高くなり外乱要素にも強くなって制御
系の性能は向上する。しかし、トルク指令が大きくなっ
たとき、ゲインが高いと機械的な共振を引き起こし、ま
た、速度指令の変化が大きいと、オーバシュート，アン
ダーシュートが生じふらつきが生じる。
【０００４】そこで、従来はのゲインを固定する方式で
は機械的な共振が生じる発振限界によって上記ゲインが
制限されてしまい、サーボの制御性能もこれにより制限
を受けることになる。そこで本発明の目的は、位置偏差
や速度偏差の収束を速くすると共に、応答性がよく外乱
にも強く、かつ機械的共振が生じないサーボモータの制
御装置を提供することにある。
は機械的な共振が生じる発振限界によって上記ゲインが
制限されてしまい、サーボの制御性能もこれにより制限
を受けることになる。そこで本発明の目的は、位置偏差
や速度偏差の収束を速くすると共に、応答性がよく外乱
にも強く、かつ機械的共振が生じないサーボモータの制
御装置を提供することにある。
【０００５】
【課題を解決するための手段】本発明は、ゲイン調整手
段により、速度制御部により出力されるトルク指令の大
きさが小さい場合には速度ループのゲインを大きくし、
トルク指令の大きさが大きい場合には速度ループのゲイ
ンを小さくして制御することによって上記目的を解決し
た。
段により、速度制御部により出力されるトルク指令の大
きさが小さい場合には速度ループのゲインを大きくし、
トルク指令の大きさが大きい場合には速度ループのゲイ
ンを小さくして制御することによって上記目的を解決し
た。
【０００６】
【作用】速度制御部より出力されるトルク指令の大きさ
が小さいときには、ゲインをあげて、トルク指令を大き
くしサーボモータを駆動する。その結果、位置偏差及び
速度偏差の収束は速くなり応答性は向上する。一方、ト
ルク指令が大きいときには、もともと制御量が大きいの
で、ゲインを余り大きくせず、機械的共振が起きないよ
うにする。その結果、応答性がよくなりかつ外乱に対し
ても強くなると共に機械的共振も生じなく、優れたサー
ボ制御特性が得られる。
が小さいときには、ゲインをあげて、トルク指令を大き
くしサーボモータを駆動する。その結果、位置偏差及び
速度偏差の収束は速くなり応答性は向上する。一方、ト
ルク指令が大きいときには、もともと制御量が大きいの
で、ゲインを余り大きくせず、機械的共振が起きないよ
うにする。その結果、応答性がよくなりかつ外乱に対し
ても強くなると共に機械的共振も生じなく、優れたサー
ボ制御特性が得られる。
【０００７】
【実施例】以下本発明の一実施例について説明する。図
２は、本発明のサーボモータ制御装置の一実施例の要部
ブロック図で、図１に示す速度制御部（比例・積分制
御）２と同等の速度制御部２ａにゲイン調整手段２ｂが
追加され、速度フィードバック制御部を構成している。
すなわち、制御部２ａには従来の速度制御部２と同様に
速度偏差（ｖｄ−ｖ）が入力され、比例・積分制御を行
ってトルク指令Ｔｃ１を出力する。そして、ゲイン調整
手段２ｂでは、このトルク指令Ｔｃ１の大きさによって
調整用のゲインＧを求め、この求められたゲインＧをト
ルク指令Ｔｃ１に乗じてモータへのトルク指令Ｔｃ２と
して出力する。
２は、本発明のサーボモータ制御装置の一実施例の要部
ブロック図で、図１に示す速度制御部（比例・積分制
御）２と同等の速度制御部２ａにゲイン調整手段２ｂが
追加され、速度フィードバック制御部を構成している。
すなわち、制御部２ａには従来の速度制御部２と同様に
速度偏差（ｖｄ−ｖ）が入力され、比例・積分制御を行
ってトルク指令Ｔｃ１を出力する。そして、ゲイン調整
手段２ｂでは、このトルク指令Ｔｃ１の大きさによって
調整用のゲインＧを求め、この求められたゲインＧをト
ルク指令Ｔｃ１に乗じてモータへのトルク指令Ｔｃ２と
して出力する。
【０００８】上記ゲイン調整手段２ｂで求めるゲイン
は、本実施例においては次の第１式の演算を行って求め
るようにしている。 Ｇ＝（Ｔｃ２／Ｔｃ１）＝１＋｛Ｉｍａｘ／（｜Ｔｃ１｜＋δ）｝ …（１） なお、上記第１式において、δは制御対象によって調整
用のゲインの大きさを決めるパラメータであり、サーボ
モータによって駆動される機械及び動作に応じて設定す
る値である。また、Ｉｍａｘはトルク指令として出力さ
れる駆動電流の最大値である。
は、本実施例においては次の第１式の演算を行って求め
るようにしている。 Ｇ＝（Ｔｃ２／Ｔｃ１）＝１＋｛Ｉｍａｘ／（｜Ｔｃ１｜＋δ）｝ …（１） なお、上記第１式において、δは制御対象によって調整
用のゲインの大きさを決めるパラメータであり、サーボ
モータによって駆動される機械及び動作に応じて設定す
る値である。また、Ｉｍａｘはトルク指令として出力さ
れる駆動電流の最大値である。
【０００９】上記第１式で示されるゲインの様子をグラ
フで表すと、図３に示すようになる。なお、この図３の
横軸は速度制御部２ａから出力されるトルク指令Ｔｃ１
の値であり、上記パラメータδが小さくなる程調整用ゲ
インＧは大きくなる。また、制御部２ａから出力される
トルク指令Ｔｃ１の絶対値が小さくなる程調整用ゲイン
Ｇは大きくなる。
フで表すと、図３に示すようになる。なお、この図３の
横軸は速度制御部２ａから出力されるトルク指令Ｔｃ１
の値であり、上記パラメータδが小さくなる程調整用ゲ
インＧは大きくなる。また、制御部２ａから出力される
トルク指令Ｔｃ１の絶対値が小さくなる程調整用ゲイン
Ｇは大きくなる。
【００１０】図４は本発明の一実施例を適用した機械の
サーボモータ制御の要部ブロック図で、図中、１０は機
械を制御する数値制御装置等の制御装置、１１は該制御
装置１０から出力されるサーボモータへの各種指令等を
受信し、デジタルサーボ回路１２のプロセッサに受け渡
すための共有メモリ、１２はデジタルサーボ回路であ
り、プロセッサ，ＲＯＭ，ＲＡＭ等で構成され、プロセ
ッサによってサーボモータ１４の位置，速度，電流制御
の処理を行うものである。１３はトランジスタインバー
タ等で構成されるサーボアンプ、１４はサーボモータ、
１５はサーボモータ１４の回転位置及び速度を検出しデ
ジタルサーボ回路１２に位置・速度をフィードバックす
る位置・速度検出器である。
サーボモータ制御の要部ブロック図で、図中、１０は機
械を制御する数値制御装置等の制御装置、１１は該制御
装置１０から出力されるサーボモータへの各種指令等を
受信し、デジタルサーボ回路１２のプロセッサに受け渡
すための共有メモリ、１２はデジタルサーボ回路であ
り、プロセッサ，ＲＯＭ，ＲＡＭ等で構成され、プロセ
ッサによってサーボモータ１４の位置，速度，電流制御
の処理を行うものである。１３はトランジスタインバー
タ等で構成されるサーボアンプ、１４はサーボモータ、
１５はサーボモータ１４の回転位置及び速度を検出しデ
ジタルサーボ回路１２に位置・速度をフィードバックす
る位置・速度検出器である。
【００１１】上記構成はロボットや工作機械等のサーボ
モータの制御における公知のデジタルサーボ回路の構成
と同一である。
モータの制御における公知のデジタルサーボ回路の構成
と同一である。
【００１２】図５は上記ディジタルサーボ回路１２のプ
ロセッサが位置・速度ループ処理周期毎実施する処理の
フローチャートである。ディジタルサーボ回路１２のプ
ロセッサは、共有メモリ１１を介して制御装置１０から
送られてきた移動指令を読み取り、従来の位置ループ制
御と同様に、位置・速度ループ処理周期毎の移動指令θ
ｄを求め該移動指令θｄから、位置・速度検出器１５か
ら出力される位置のフィードバック量を減じて位置偏差
を求め、この位置偏差にポジションゲインＫｐを乗じて
速度指令を求める（ステップＳ１）。次に、求められた
速度指令から位置・速度検出器１５からの速度フィード
バック量を減じて速度偏差を求め、従来の速度制御と同
様に比例・積分制御を行ってトルク指令Ｔｃ１を求める
（ステップＳ２）。この求められたトルク指令Ｔｃ１と
予め設定されているパラメータ値δと駆動電流の最大値
Ｉｍａｘより上記第１式の演算を行って調整用ゲインＧ
を求める（ステップＳ３）。そして、求められたゲイン
ＧをステップＳ２で求められたトルク指令Ｔｃ１に乗じ
て調整されたトルク指令Ｔｃ２を求め、このトルク指令
Ｔｃ２を電流ループに引き渡して当該周期の位置・速度
ループ処理を終了する（ステップＳ４，Ｓ５）。以下各
位置・速度ループ処理周期毎上記ステップＳ１〜Ｓ５の
処理を繰り返し実施する。
ロセッサが位置・速度ループ処理周期毎実施する処理の
フローチャートである。ディジタルサーボ回路１２のプ
ロセッサは、共有メモリ１１を介して制御装置１０から
送られてきた移動指令を読み取り、従来の位置ループ制
御と同様に、位置・速度ループ処理周期毎の移動指令θ
ｄを求め該移動指令θｄから、位置・速度検出器１５か
ら出力される位置のフィードバック量を減じて位置偏差
を求め、この位置偏差にポジションゲインＫｐを乗じて
速度指令を求める（ステップＳ１）。次に、求められた
速度指令から位置・速度検出器１５からの速度フィード
バック量を減じて速度偏差を求め、従来の速度制御と同
様に比例・積分制御を行ってトルク指令Ｔｃ１を求める
（ステップＳ２）。この求められたトルク指令Ｔｃ１と
予め設定されているパラメータ値δと駆動電流の最大値
Ｉｍａｘより上記第１式の演算を行って調整用ゲインＧ
を求める（ステップＳ３）。そして、求められたゲイン
ＧをステップＳ２で求められたトルク指令Ｔｃ１に乗じ
て調整されたトルク指令Ｔｃ２を求め、このトルク指令
Ｔｃ２を電流ループに引き渡して当該周期の位置・速度
ループ処理を終了する（ステップＳ４，Ｓ５）。以下各
位置・速度ループ処理周期毎上記ステップＳ１〜Ｓ５の
処理を繰り返し実施する。
【００１３】以上のように、通常の速度ループ制御処理
（速度制御部２ａの処理）で求められるトルク指令Ｔｃ
１に対して、ステップＳ３で調整用ゲインＧを求めこの
ゲインＧを上記トルク指令Ｔｃ１に乗じてモータへのト
ルク指令Ｔｃ２を求めるようにしたから、位置偏差，速
度偏差が小さく、トルク指令Ｔｃ１の値が小さいときに
は、大きな調整用ゲインＧがこのトルク指令Ｔｃ１に乗
じられて速度ループゲインが高くされるため、位置偏差
及び速度偏差は急速に収束することになり、応答性のよ
い制御系を得ることができる。また、位置偏差，速度偏
差が大きくトルク指令Ｔｃ１が大きいときには調整用ゲ
インＧは小さな値となるので、全体的の速度ループゲイ
ンは格別高くなることはなく、機械的共振が生じるよう
なことはない。
（速度制御部２ａの処理）で求められるトルク指令Ｔｃ
１に対して、ステップＳ３で調整用ゲインＧを求めこの
ゲインＧを上記トルク指令Ｔｃ１に乗じてモータへのト
ルク指令Ｔｃ２を求めるようにしたから、位置偏差，速
度偏差が小さく、トルク指令Ｔｃ１の値が小さいときに
は、大きな調整用ゲインＧがこのトルク指令Ｔｃ１に乗
じられて速度ループゲインが高くされるため、位置偏差
及び速度偏差は急速に収束することになり、応答性のよ
い制御系を得ることができる。また、位置偏差，速度偏
差が大きくトルク指令Ｔｃ１が大きいときには調整用ゲ
インＧは小さな値となるので、全体的の速度ループゲイ
ンは格別高くなることはなく、機械的共振が生じるよう
なことはない。
【００１４】図６及び図７は、移動指令として２５．４
ｍｍの移動指令を出し高速位置決めを行ったときの従来
の方法（図６）と本実施例による方法（図７）による位
置偏差の状態を検出したものであり、本実施例において
は上記パラメータδの値をＩｍａｘ／２として実験した
ものである。図６，図７の横軸は時間で縦軸は位置偏差
であり、１パルスは１μｍ（１Ｐ＝１μｍ）である。図
６に示す従来の方法ではオーバシュート，アンダシュー
トが生じ位置偏差の収束も１８０ｍｓｅｃ程度で、位置
ぎめに時間を要している。一方、図７に示す本発明の方
法では、オーバシュート，アンダシュートは生ぜず、位
置偏差の収束も１２０ｍｓｅｃと短い時間で収束してい
ることが分かる。
ｍｍの移動指令を出し高速位置決めを行ったときの従来
の方法（図６）と本実施例による方法（図７）による位
置偏差の状態を検出したものであり、本実施例において
は上記パラメータδの値をＩｍａｘ／２として実験した
ものである。図６，図７の横軸は時間で縦軸は位置偏差
であり、１パルスは１μｍ（１Ｐ＝１μｍ）である。図
６に示す従来の方法ではオーバシュート，アンダシュー
トが生じ位置偏差の収束も１８０ｍｓｅｃ程度で、位置
ぎめに時間を要している。一方、図７に示す本発明の方
法では、オーバシュート，アンダシュートは生ぜず、位
置偏差の収束も１２０ｍｓｅｃと短い時間で収束してい
ることが分かる。
【００１５】また、図８は半径１０ｍｍの円弧切削を従
来の方法で行ったときの切削形状をを表したものであ
る。また、図９は上記パラメータδの値をＩｍａｘ／２
として本発明の方法で切削を行ったときの切削形状を表
したものである。図８，図９において、符号２０は指令
の円弧形状であり、符号２１は切削円弧形状を示すもの
である。この図８，図９から、本発明の方法の方が切削
精度が各段に向上していることが分かる。
来の方法で行ったときの切削形状をを表したものであ
る。また、図９は上記パラメータδの値をＩｍａｘ／２
として本発明の方法で切削を行ったときの切削形状を表
したものである。図８，図９において、符号２０は指令
の円弧形状であり、符号２１は切削円弧形状を示すもの
である。この図８，図９から、本発明の方法の方が切削
精度が各段に向上していることが分かる。
【００１６】なお、上述した実施例では、調整用のゲイ
ンＧを上記第１式の演算を行うことによって求めるよう
にしたが、必ずしも上記第１式の演算を行って調整用ゲ
インＧを求めなくても従来の速度制御部（速度制御部２
ａ）から出力されるトルク指令Ｔｃ１の大きさによっ
て、該トルク指令Ｔｃ１が大きいときは小さく、トルク
指令Ｔｃ１が小さいときには大きな調整用ゲインＧにす
る他の方法でもよい。また、第１式のような演算を行っ
て調整用ゲインＧを求めなくても、従来の速度制御部
（速度制御部２ａ）から出力されるトルク指令Ｔｃ１の
大きさを何段かの領域に分割し、各領域毎に調整用ゲイ
ンを設定しておき、上記トルク指令Ｔｃ１がどの領域か
を判断し、対応する領域の調整用ゲインＧを求めるよう
にしてもよい。
ンＧを上記第１式の演算を行うことによって求めるよう
にしたが、必ずしも上記第１式の演算を行って調整用ゲ
インＧを求めなくても従来の速度制御部（速度制御部２
ａ）から出力されるトルク指令Ｔｃ１の大きさによっ
て、該トルク指令Ｔｃ１が大きいときは小さく、トルク
指令Ｔｃ１が小さいときには大きな調整用ゲインＧにす
る他の方法でもよい。また、第１式のような演算を行っ
て調整用ゲインＧを求めなくても、従来の速度制御部
（速度制御部２ａ）から出力されるトルク指令Ｔｃ１の
大きさを何段かの領域に分割し、各領域毎に調整用ゲイ
ンを設定しておき、上記トルク指令Ｔｃ１がどの領域か
を判断し、対応する領域の調整用ゲインＧを求めるよう
にしてもよい。
【００１７】また、上記実施例では、サーボ制御をディ
ジタルサーボで行った例を説明したが、ディジタルサー
ボ制御ではなく、アナログのサーボ制御においても、本
発明は適用できるものである。さらに、本実施例では速
度制御部の制御を比例・積分制御の例で説明したが、積
分・比例制御の場合にも本発明は適用できる。また、位
置ループ制御にフィードフォワード制御を導入したとき
にも本発明は適用できるものである。また、位置ループ
制御を行わず、速度制御のみを行うときも本発明は適用
できるものである。要するに、速度制御部から出力され
るトルク指令Ｔｃ１の大きさが大きいときは低く、小さ
いときには高く調整用ゲインＧを変化させることによっ
て、位置偏差，速度偏差の収束を速くし、応答性を向上
させ、かつ、機械的共振を発生させず、速度指令の変化
が大きいときにもふらつきやオーバシュート，アンダシ
ュートを発生させず、外乱に対して強いサーボ制御装置
を得ることができるものである。
ジタルサーボで行った例を説明したが、ディジタルサー
ボ制御ではなく、アナログのサーボ制御においても、本
発明は適用できるものである。さらに、本実施例では速
度制御部の制御を比例・積分制御の例で説明したが、積
分・比例制御の場合にも本発明は適用できる。また、位
置ループ制御にフィードフォワード制御を導入したとき
にも本発明は適用できるものである。また、位置ループ
制御を行わず、速度制御のみを行うときも本発明は適用
できるものである。要するに、速度制御部から出力され
るトルク指令Ｔｃ１の大きさが大きいときは低く、小さ
いときには高く調整用ゲインＧを変化させることによっ
て、位置偏差，速度偏差の収束を速くし、応答性を向上
させ、かつ、機械的共振を発生させず、速度指令の変化
が大きいときにもふらつきやオーバシュート，アンダシ
ュートを発生させず、外乱に対して強いサーボ制御装置
を得ることができるものである。
【００１８】
【発明の効果】本発明は、速度偏差が小さくトルク指令
が小さい場合には速度制御のゲインを高くして応答性を
よくし、位置偏差や速度偏差を急速に収束することがで
きる。また、トルク指令が大きいときには速度制御部の
ゲインを高くしないことによって機械的共振の発生を防
止する。その結果、速度指令の変化が大きくても、速度
のふらつきやオーバシュート，アンダーシュートを低減
させ、外乱に強いサーボ制御方式を得ることができる。
が小さい場合には速度制御のゲインを高くして応答性を
よくし、位置偏差や速度偏差を急速に収束することがで
きる。また、トルク指令が大きいときには速度制御部の
ゲインを高くしないことによって機械的共振の発生を防
止する。その結果、速度指令の変化が大きくても、速度
のふらつきやオーバシュート，アンダーシュートを低減
させ、外乱に強いサーボ制御方式を得ることができる。
【図１】速度制御を含むサーボモータの位置制御系のブ
ロック図である。
ロック図である。
【図２】本発明の一実施例における速度制御部のブロッ
ク図である。
ク図である。
【図３】同実施例におけるゲイン調整手段により求めら
れる調整用ゲインを説明する説明図である。
れる調整用ゲインを説明する説明図である。
【図４】本発明の一実施例を実施する機械のサーボモー
タ制御の要部ブロック図である。
タ制御の要部ブロック図である。
【図５】同一実施例におけるディジタルサーボ回路のプ
ロセッサが実施する処理のフローチャートである。
ロセッサが実施する処理のフローチャートである。
【図６】従来の方法で高速位置決めを行ったときの位置
偏差の様子を示す図である。
偏差の様子を示す図である。
【図７】本発明の方法により、図６と同じ条件で高速位
置決めを行ったときの位置偏差の様子を示す図である。
置決めを行ったときの位置偏差の様子を示す図である。
【図８】従来の方法で円弧切削を行ったときの様子を示
す図である。
す図である。
【図９】本発明の方法により、図８と同じ条件で円弧切
削を行ったときの様子を示す図である。
削を行ったときの様子を示す図である。
１ 位置制御部 ２ 速度制御部 ３ モータ機械系 ２ａ 速度制御部 ２ｂ ゲイン調整手段 １０ 制御装置 ２０ 指令円弧形状 ２１ 切削円弧形状
───────────────────────────────────────────────────── フロントページの続き (72)発明者 岩下 平輔 山梨県南都留郡忍野村忍草字古馬場3580 番地 ファナック株式会社 商品開発研 究所 内 (56)参考文献 特開 昭59−189401（ＪＰ，Ａ) 特開 昭62−171016（ＪＰ，Ａ) 特開 昭61−204715（ＪＰ，Ａ) 特開 平２−61706（ＪＰ，Ａ) (58)調査した分野(Int.Cl.6，ＤＢ名) G05D 3/12 305 G05D 3/12 306 G05D 13/02 G05D 13/04 H02P 5/00
Claims (2)
- 【請求項１】 比例、積分の速度ループ制御を行う速度
制御部を有するサーボモータの制御装置において、速度
制御部により出力されるトルク指令の大きさに応じて、
該トルク指令が小さい場合には速度ループのゲインを大
きくし、トルク指令の大きさが大きい場合には速度ルー
プのゲインを小さくするゲイン調整手段を備えたことを
特徴とするサーボモータの制御装置。 - 【請求項２】 比例、積分の速度ループ制御を行う速度
制御部を有するサーボモータの制御装置において、上記
速度制御部は設定された速度ループゲインで速度ループ
制御を行いトルク指令値をＴｃ１を求め、該速度制御部
から出力されるトルク指令値Ｔｃ１を入力し、出力可能
なトルク指令の最大値Ｉｍａｘｄ，制御系によって設定
されたゲイン調整値δとにより次の式の演算を行ってゲ
インＧを求め、 Ｇ＝１＋｛Ｉｍａｘ／（｜Ｔｃｌ｜＋δ）｝ 求められたゲインＧを速度制御部から出力された上記ト
ルク指令値Ｔｃ１に乗じて、モータへトルク指令して出
力するゲイン調整手段を備えたことを特徴とするサーボ
モータの制御装置。
Priority Applications (6)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3322425A JP2820820B2 (ja) | 1991-11-12 | 1991-11-12 | サーボモータの制御装置 |
| US08/087,749 US5374882A (en) | 1991-11-12 | 1992-11-10 | Method of controlling servomotor |
| PCT/JP1992/001453 WO1993010489A1 (en) | 1991-11-12 | 1992-11-10 | Method of controlling servomotors |
| EP92923001A EP0566747B1 (en) | 1991-11-12 | 1992-11-10 | Method of controlling servomotors |
| DE69211533T DE69211533T2 (de) | 1991-11-12 | 1992-11-10 | Verfahren zur servomotorsteuerung |
| KR1019930702034A KR0135308B1 (ko) | 1991-11-12 | 1993-07-07 | 서보 모터의 제어방법 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3322425A JP2820820B2 (ja) | 1991-11-12 | 1991-11-12 | サーボモータの制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH05134760A JPH05134760A (ja) | 1993-06-01 |
| JP2820820B2 true JP2820820B2 (ja) | 1998-11-05 |
Family
ID=18143524
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP3322425A Expired - Lifetime JP2820820B2 (ja) | 1991-11-12 | 1991-11-12 | サーボモータの制御装置 |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US5374882A (ja) |
| EP (1) | EP0566747B1 (ja) |
| JP (1) | JP2820820B2 (ja) |
| KR (1) | KR0135308B1 (ja) |
| DE (1) | DE69211533T2 (ja) |
| WO (1) | WO1993010489A1 (ja) |
Families Citing this family (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5684374A (en) * | 1995-07-27 | 1997-11-04 | Allen-Bradley Company, Inc. | Method and apparatus for tuning a motion control system having an external velocity loop |
| JP3628119B2 (ja) * | 1996-07-24 | 2005-03-09 | ファナック株式会社 | サーボモータの制御方法 |
| US6078114A (en) * | 1998-04-08 | 2000-06-20 | Universal Instruments Corporation | Method and apparatus for vibration reduction/control in a variable reluctance linear motor |
| JP3526022B2 (ja) * | 2000-03-06 | 2004-05-10 | 株式会社安川電機 | サーボ制御系の発振臨界検出方法 |
| GB2401441B (en) * | 2002-04-05 | 2005-08-10 | Mitsubishi Electric Corp | Motor control device |
| CN1330063C (zh) | 2002-08-22 | 2007-08-01 | 日产自动车株式会社 | 车辆开/合体的控制部件 |
| JP2008029177A (ja) * | 2006-07-25 | 2008-02-07 | Ricoh Co Ltd | 半導体装置 |
| JP2015033213A (ja) * | 2013-08-02 | 2015-02-16 | パナソニック株式会社 | サーボアンプ |
| JP6961961B2 (ja) * | 2017-03-15 | 2021-11-05 | オムロン株式会社 | サーボシステム及び、サーボモータ制御のゲイン調整方法 |
Family Cites Families (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS58151885A (ja) * | 1982-03-03 | 1983-09-09 | Hitachi Ltd | モ−タの位置制御方法 |
| JPS5954020A (ja) * | 1982-09-22 | 1984-03-28 | Akai Electric Co Ltd | 垂直磁気ヘツド |
| JPS59189401A (ja) * | 1983-04-13 | 1984-10-27 | Fanuc Ltd | 位置制御装置 |
| JPS6054020A (ja) * | 1983-09-01 | 1985-03-28 | Mitsubishi Electric Corp | 可動体の制御装置 |
| JPS615302A (ja) * | 1984-06-19 | 1986-01-11 | Nissan Motor Co Ltd | マニピユレ−タの制御装置 |
| JPS6132121A (ja) * | 1984-07-24 | 1986-02-14 | Hitachi Ltd | 移動体の位置決め制御機構 |
| JPS62171016A (ja) * | 1986-01-23 | 1987-07-28 | Canon Inc | 位置決め制御装置 |
| JPS62212802A (ja) * | 1986-03-14 | 1987-09-18 | Fanuc Ltd | ロボツトア−ムの制御装置 |
| JPS63274385A (ja) * | 1987-04-30 | 1988-11-11 | Fanuc Ltd | サ−ボモ−タの速度制御装置 |
| JPH01258009A (ja) * | 1988-04-07 | 1989-10-16 | Fuji Electric Co Ltd | 位置決め制御装置 |
| JP2770982B2 (ja) * | 1989-05-25 | 1998-07-02 | 株式会社豊田中央研究所 | マニピユレータの位置と力の協調制御装置 |
| JPH03210607A (ja) * | 1990-01-13 | 1991-09-13 | Fuji Electric Co Ltd | アナログサーボ制御装置 |
| JPH03289385A (ja) * | 1990-04-03 | 1991-12-19 | Fanuc Ltd | モータ制御のゲイン調整方法 |
| US5063335A (en) * | 1990-09-11 | 1991-11-05 | Allen-Bradley Company, Inc. | Two-input control with independent proportional and integral gains for velocity error and velocity feedforward including velocity command limiting |
| US5223778A (en) * | 1992-09-16 | 1993-06-29 | Allen-Bradley Company, Inc. | Automatic tuning apparatus for PID controllers |
-
1991
- 1991-11-12 JP JP3322425A patent/JP2820820B2/ja not_active Expired - Lifetime
-
1992
- 1992-11-10 EP EP92923001A patent/EP0566747B1/en not_active Expired - Lifetime
- 1992-11-10 WO PCT/JP1992/001453 patent/WO1993010489A1/ja active IP Right Grant
- 1992-11-10 US US08/087,749 patent/US5374882A/en not_active Expired - Fee Related
- 1992-11-10 DE DE69211533T patent/DE69211533T2/de not_active Expired - Fee Related
-
1993
- 1993-07-07 KR KR1019930702034A patent/KR0135308B1/ko not_active IP Right Cessation
Also Published As
| Publication number | Publication date |
|---|---|
| KR930703637A (ko) | 1993-11-30 |
| US5374882A (en) | 1994-12-20 |
| DE69211533T2 (de) | 1996-10-10 |
| JPH05134760A (ja) | 1993-06-01 |
| EP0566747A4 (ja) | 1994-03-09 |
| DE69211533D1 (de) | 1996-07-18 |
| EP0566747B1 (en) | 1996-06-12 |
| EP0566747A1 (en) | 1993-10-27 |
| KR0135308B1 (ko) | 1998-05-15 |
| WO1993010489A1 (en) | 1993-05-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPH0816246A (ja) | ディジタルサーボによるタンデム制御方法 | |
| KR950007104B1 (ko) | 서어보 모우터용 제어장치 | |
| JP2820820B2 (ja) | サーボモータの制御装置 | |
| JP3545006B2 (ja) | ２自由度制御装置及び電動機のサーボ制御装置 | |
| KR970002258B1 (ko) | 서보모터의 제어방법 | |
| US5986422A (en) | Control mode changing over method for servo control system | |
| JPH07104856A (ja) | 振動制御方法 | |
| JP3322826B2 (ja) | サーボモータによる加圧制御方法及び装置 | |
| KR970002259B1 (ko) | 서보모터의 제어방법 | |
| US7190140B2 (en) | Sliding mode controller position control device | |
| US6122998A (en) | Force control method for a bar feeder of a lathe | |
| JPH11231914A (ja) | 数値制御装置 | |
| JP2002091570A (ja) | サーボ制御方法 | |
| JP2733881B2 (ja) | Ｐｉ制御ループをベースにした適応スライディングモード制御方式 | |
| JP2003084804A (ja) | 最適指令作成装置 | |
| JPH0752365B2 (ja) | 数値制御装置 | |
| JPH08263143A (ja) | 外乱オブザーバを用いた制御ゲイン切り替え方式 | |
| JPS6140616A (ja) | 位置制御方式 | |
| JPH10105247A (ja) | サーボモータのオーバーシュート防止方法 | |
| JP3176003B2 (ja) | 制御装置 | |
| JP4300384B2 (ja) | 位置決めサーボコントローラ | |
| JPH08297512A (ja) | スライディングモード制御による位置決め制御方法 | |
| JPH08116688A (ja) | サーボモータの発振検出方法及びサーボモータの速度ゲイン調整方法 | |
| JPS6132120A (ja) | 位置決め制御方式 | |
| JPH0784647A (ja) | 位置制御装置 |