JPH0519862A - サーボ制御装置 - Google Patents

サーボ制御装置

Info

Publication number
JPH0519862A
JPH0519862A JP17555891A JP17555891A JPH0519862A JP H0519862 A JPH0519862 A JP H0519862A JP 17555891 A JP17555891 A JP 17555891A JP 17555891 A JP17555891 A JP 17555891A JP H0519862 A JPH0519862 A JP H0519862A
Authority
JP
Japan
Prior art keywords
feedforward
gain
gain error
position deviation
command
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.)
Withdrawn
Application number
JP17555891A
Other languages
English (en)
Inventor
Yoshiki Kato
義樹 加藤
Ichiro Awaya
伊智郎 粟屋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Heavy Industries Ltd
Original Assignee
Mitsubishi Heavy Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Mitsubishi Heavy Industries Ltd filed Critical Mitsubishi Heavy Industries Ltd
Priority to JP17555891A priority Critical patent/JPH0519862A/ja
Publication of JPH0519862A publication Critical patent/JPH0519862A/ja
Withdrawn legal-status Critical Current

Links

Landscapes

  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

(57)【要約】 【目的】 サーボ制御装置において、負荷変動などによ
り位置偏差が発生した場合でも、フィードフォワード制
御部におけるゲイン調整により、位置偏差を零にする。 【構成】 機械を正弦波駆動するサーボ制御装置におい
て、ゲイン可変のフィードフォワード制御部7Aを設け
ると共に、このフィードフォワード制御部7Aのゲイン
を制御するフィードフォワードゲイン誤差推定部21を
設ける。このフィードフォワードゲイン誤差推定部21
は、位置指令とそれに対する位置偏差の振幅比と位相差
からフィードフォワードのゲイン誤差を推定し、フィー
ドフォワード制御部7Aに出力する。フィードフォワー
ド制御部7Aは、上記ゲイン誤差推定部21により推定
されたゲイン誤差により、制御系に対して位置偏差が零
になるようにフィードフォワードゲインを調整する。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、機械を正弦波駆動する
サーボ制御装置に関する。
【0002】
【従来の技術】従来のフィードフォワード制御機能を備
えたサーボ制御装置は、図2に示すように構成されてい
る。すなわち、図2において1はモータ/機械系で、こ
のモータ/機械系1より角度θ及び角速度θ′が検出さ
れ、角度θが減算器2の−端子、角速度θ′が加減算器
−端子に入力される。一方、目標位置を示す正弦波の位
置指令θr が制御系における減算器2の+端子に入力さ
れ、位置指令θr から上記検出角度θが減算されて位置
偏差「θr −θ」が求められる。この位置偏差「θr −
θ」は、乗算器3に入力されて位置フィードバックゲイ
ンGpが乗算され、その乗算結果が加減算器4の+端子
に入力される。
【0003】また、上記位置指令θr は、上記制御系の
他、フィードフォワード制御部7へ送られる。このフィ
ードフォワード制御部7は、微分器8,10、乗算器
9、11により構成される。フィードフォワード制御部
7に入力された位置指令θr は、微分器8で微分されて
速度指令θ′r となり、乗算器9に入力され、速度フィ
ードフォワードゲインKVFF が乗算されて速度フィード
フォワード値となる。
【0004】この速度フィードフォワード値は、制御系
における加減算器4の+端子に入力される。従って、こ
の加減算器4では、乗算器3の出力に乗算器9からの速
度フィードフォワード値を加算すると共に、角速度を減
算して速度偏差を求め、乗算器5に出力する。乗算器5
は、上記速度偏差に速度フィードバックゲインGvを乗
算し、加算器6に出力する。
【0005】また、上記微分器6で微分された速度指令
θ′r は、微分器10で微分されて加速度指令θ″r と
なる。このθ″r は、乗算器11に入力されてトルクフ
ィードフォワードゲインJO が乗算され、トルクフィー
ドフォワード値となる。このトルクフィードフォワード
値は、制御系の加算器6に入力されて乗算器5の出力と
加算されてトルク指令uとなり、モータ/機械系1に入
力される。
【0006】
【発明が解決しようとする課題】上記のように従来のサ
ーボ制御装置は、フィードフォワード制御部7における
フィードフォワードゲインが固定であり、このため負荷
の変動などでフィードフォワードゲインのゲイン誤差が
存在する場合、位置偏差をフィードバックにより打ち消
しているが、高速な正弦波指令に対してはフィードバッ
クの遅れにより偏差を抑制できないという問題があっ
た。
【0007】本発明は上記実情に鑑みてなされたもの
で、フィードフォワードのゲインを速やかに自動調整す
ることで位置偏差を著しく低減し得るフィードフォワー
ド装置を提供することを目的とする。
【0008】
【課題を解決するための手段】本発明は、機械を正弦波
駆動するサーボ制御装置において、目標位置を示す位置
指令に従って被制御機械を駆動制御する制御系と、上記
位置指令とそれに対する位置偏差の振幅比と位相差から
フィードフォワードのゲイン誤差を推定するフィードフ
ォワードゲイン誤差推定部と、このゲイン誤差推定部に
より推定されたゲイン誤差により、上記制御系に対して
位置偏差が零になるようにフィードフォワードゲインを
調整するフィードフォワード制御部とを具備したことを
特徴とするものである。
【0009】
【作用】位置指令が与えられると、この位置指令に従っ
て制御系が動作し、被制御機械を駆動する。また、この
際、フィードフォワードゲイン誤差推定部が作動し、上
記位置指令とそれに対する位置偏差の振幅比と位相差か
らフィードフォワードのゲイン誤差、すなわち、トルク
フィードフォワードゲイン誤差ΔJと速度フィードフォ
ワードゲイン誤差ΔKVFF とを推定し、その推定値をフ
ィードフォワード制御部に出力する。このフィードフォ
ワード制御部は、ゲイン誤差推定部により推定されたゲ
イン誤差に基づき、上記制御系に対して位置偏差が零に
なるようにフィードフォワードゲインを調整する従っ
て、負荷変動などにより位置偏差が発生した場合でも、
フィードフォワード制御部におけるゲイン調整により、
位置偏差を低減することができる。
【0010】
【実施例】以下、図面を参照して本発明の一実施例を説
明する。
【0011】本発明は、図2に示した回路において、ゲ
イン固定のフィードフォワード制御部7に代えてゲイン
可変のフィードフォワード制御部7Aを設けると共に、
このフィードフォワード制御部7Aのゲインを制御する
フィードフォワードゲイン誤差推定部21を設けたもの
である。その他の構成は、図2の回路と同じであるの
で、図2と同一符号を付して詳細な説明は省略する。上
記フィードフォワード制御部7Aは、微分器8,10及
びゲイン可変の乗算器9a,11aを用いて回路を構成
している。
【0012】また、フィードフォワードゲイン誤差推定
部21は、位置指令θr と減算器2から出力される位置
偏差「θr −θ」から後述する(10),(11)式に
より、トルクフィードフォワードゲイン誤差ΔJと速度
フィードフォワードゲイン誤差ΔKVFF とを計算して出
力するようになっている。このトルクフィードフォワー
ドゲイン誤差ΔJにより乗算器11aのトルクフィード
フォワードゲインJOが「JO +ΔJ」に調整される。
同様に速度フィードフォワードゲイン誤差ΔKVFF によ
り乗算器9aの速度フィードフォワードゲインKVFF が
「KVFF +ΔKVFF 」に調整される。以上の自動調整に
より、位置偏差「θr −θ」が零に近づくように変更さ
れる。次に上記実施例の動作について説明する。図2に
示したゲイン固定のフィードフォワード制御部7を使用
した場合における系は、次の(1),(2)式で表わさ
れる。
【0013】すなわち、トルク指令をu、角度をθ、位
置指令をθr 、慣性モーメントをJ、モータの時定数を
T、速度フィードバックゲインをGv、位置フィードバ
ックゲインをGp、速度フィードフォワードゲインをK
VFF 、トルクフィードフォワードゲインをJO とする
と、モータ/機械系1の運動方程式は(1)式で、トル
ク指令uの式は(2)式で表わされる。 Jθ″=u/(1+TS) …(1) u=JO θ″r +Gv{KVFF θ′r −θ′+Gp(θr −θ)} …(2) 上記(1),(2)式により、位置指令θr から位置偏
差「θr −θ」への伝達関数は(3)式となる。
【0014】
【数1】 但し、 トルクフィードフォワードゲイン誤差 ΔJ =J−JO …(4) 速度フィードフォワードゲイン誤差 KVFF =1−KVFF …(5) である。(3)式の伝達関数で位置指令θr に振幅A、
一定周波数ωの正弦波として、
【0015】
【数2】 が加わるとすると、位置偏差「θr −θ」は(7)式と
なる。
【0016】
【数3】 ただし、ΔA、Δθは各々位置偏差の振幅、位相差で、
(8),(9)式となる。
【0017】
【数4】 上記(8),(9)式を変更し、ΔA、ΔθからΔJ、
ΔKVFF を求める式を導出すると、(10),(11)
式となる。
【0018】
【数5】
【0019】上記(10),(11)式を用いれば、位
置指令の振幅A、周波数ω及び位置偏差の振幅ΔAと位
相差Δθとからトルクフィードフォワードゲイン誤差Δ
J、速度フィードフォワードゲイン誤差ΔKVFF を求め
ることができる。このフィードフォワードゲイン誤差Δ
J、ΔKVFF を用いてフィードフォワードゲインJO、
KVFF を(12),(13)式のように自動調整するこ
とにより、正弦波指令θr に対する位置偏差「θr−
θ」を零にすることができる。 JO +ΔJ→JO …(12) KVFF +ΔKVFF →KVFF …(13)
【0020】
【発明の効果】以上詳記したように本発明によれば、フ
ィードフォワードゲイン誤差推定部21において、位置
指令とそれに対する位置偏差の振幅比と位相差から位置
偏差「θr −θ」を零にするように、トルクフィードフ
ォワードゲイン誤差ΔJと速度フィードフォワードゲイ
ン誤差ΔKVFF とが計算され、それによりトルクフィー
ドフォワードゲインJO と速度フィードフォワードゲイ
ンKVFF とが調整される。従って、負荷変動などにより
位置偏差「θr −θ」が発生した場合でも、フィードフ
ォワード制御部7Aの乗算器11,9におけるフィード
フォワードゲインJO ,KVFF の自動調整により、位置
偏差「θr −θ」を零にすることができる。
【図面の簡単な説明】
【図1】本発明の一実施例に係るサーボ制御装置のブロ
ック図。
【図2】従来のサーボ制御装置を示すブロック図。
【符号の説明】
1…モータ/機械系、2…減算器、3…乗算器(位置フ
ィードバックゲインGp)、4…加減算器、5…乗算器
(速度フィードバックゲインGv)、6…加算器、7,
7A…フィードフォワード制御部、8,10…微分器、
9…乗算器(速度フィードフォワードゲインKVFF )、
11…乗算器(トルクフィードフォワードゲインJO
)、21…フィードフォワードゲイン誤差推定部。

Claims (1)

  1. 【特許請求の範囲】 【請求項1】 機械を正弦波駆動するサーボ制御装置に
    おいて、目標位置を示す位置指令に従って被制御機械を
    駆動制御する制御系と、上記位置指令とそれに対する位
    置偏差の振幅比と位相差からフィードフォワードのゲイ
    ン誤差を推定するフィードフォワードゲイン誤差推定部
    と、このゲイン誤差推定部により推定されたゲイン誤差
    により、上記制御系に対して位置偏差が零になるように
    フィードフォワードゲインを調整するフィードフォワー
    ド制御部とを具備したことを特徴とするするサーボ制御
    装置。
JP17555891A 1991-07-16 1991-07-16 サーボ制御装置 Withdrawn JPH0519862A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP17555891A JPH0519862A (ja) 1991-07-16 1991-07-16 サーボ制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP17555891A JPH0519862A (ja) 1991-07-16 1991-07-16 サーボ制御装置

Publications (1)

Publication Number Publication Date
JPH0519862A true JPH0519862A (ja) 1993-01-29

Family

ID=15998184

Family Applications (1)

Application Number Title Priority Date Filing Date
JP17555891A Withdrawn JPH0519862A (ja) 1991-07-16 1991-07-16 サーボ制御装置

Country Status (1)

Country Link
JP (1) JPH0519862A (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009070396A (ja) * 2003-02-20 2009-04-02 Mitsubishi Electric Corp サーボ制御装置
JP2010524714A (ja) * 2007-04-23 2010-07-22 本田技研工業株式会社 関節を制御する方法及びトルク速度変換装置
CN101937193A (zh) * 2010-07-30 2011-01-05 东南大学 一种多内模并联型重复控制器及控制方法
JP2011226913A (ja) * 2010-04-20 2011-11-10 Shimadzu Corp 試験機
WO2015125909A1 (ja) * 2014-02-21 2015-08-27 三菱重工業株式会社 機械装置の制御装置及び摩擦補償用のゲイン決定方法

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009070396A (ja) * 2003-02-20 2009-04-02 Mitsubishi Electric Corp サーボ制御装置
JP2010524714A (ja) * 2007-04-23 2010-07-22 本田技研工業株式会社 関節を制御する方法及びトルク速度変換装置
JP2011226913A (ja) * 2010-04-20 2011-11-10 Shimadzu Corp 試験機
CN101937193A (zh) * 2010-07-30 2011-01-05 东南大学 一种多内模并联型重复控制器及控制方法
WO2015125909A1 (ja) * 2014-02-21 2015-08-27 三菱重工業株式会社 機械装置の制御装置及び摩擦補償用のゲイン決定方法
JP2015156194A (ja) * 2014-02-21 2015-08-27 三菱重工業株式会社 機械装置の制御装置及び摩擦補償用のゲイン決定方法
US10120396B2 (en) 2014-02-21 2018-11-06 Mitsubishi Heavy Industries, Ltd. Control device for machine apparatus and gain determination method for friction compensation

Similar Documents

Publication Publication Date Title
KR920010102B1 (ko) 서보모터용 제어장치
JP5169836B2 (ja) 位置制御装置
KR100437178B1 (ko) 위치 제어 장치
JP3981773B2 (ja) ロボット制御装置
JP2009303432A (ja) モータによる位置制御装置
JPWO2008062700A1 (ja) サーボ制御装置とその制御方法
JPH0519862A (ja) サーボ制御装置
JP3230571B2 (ja) 電動機の速度制御装置
KR0185519B1 (ko) 전동기의 위치제어장치
WO2005073818A1 (ja) サーボ制御装置
JPH06250702A (ja) サーボ制御装置
JP2882863B2 (ja) サーボ制御装置
JPH05252779A (ja) ロボットのサーボ制御装置
JPH08286759A (ja) 静摩擦を補償するロボット駆動制御方法
JP2001350525A (ja) 位置決めサーボコントローラ
JPH104692A (ja) 電動機の位置制御装置
JP3975537B2 (ja) 制御装置と制御方法
JPH0792702B2 (ja) 制御装置
CN106877771B (zh) 控制装置以及控制方法
JPH08147038A (ja) モータの駆動制御装置
JPH07111642B2 (ja) スライディングモード制御方式
JPH117303A (ja) サーボ系の駆動制御装置
JP3324482B2 (ja) 位置制御装置
WO2004077179A1 (ja) サーボ制御装置
JP2503415B2 (ja) マスタ・スレ−ブマニピュレ−タの制御方法

Legal Events

Date Code Title Description
A300 Withdrawal of application because of no request for examination

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 19981008