JPH03289385A - モータ制御のゲイン調整方法 - Google Patents

モータ制御のゲイン調整方法

Info

Publication number
JPH03289385A
JPH03289385A JP2088670A JP8867090A JPH03289385A JP H03289385 A JPH03289385 A JP H03289385A JP 2088670 A JP2088670 A JP 2088670A JP 8867090 A JP8867090 A JP 8867090A JP H03289385 A JPH03289385 A JP H03289385A
Authority
JP
Japan
Prior art keywords
gain
feedback
feedforward
motor control
learning
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.)
Pending
Application number
JP2088670A
Other languages
English (en)
Inventor
Nobutoshi Torii
信利 鳥居
Akira Nihei
亮 二瓶
Tetsuro Kato
哲朗 加藤
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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Priority to JP2088670A priority Critical patent/JPH03289385A/ja
Priority to PCT/JP1991/000434 priority patent/WO1991015893A1/ja
Priority to EP19910906574 priority patent/EP0474888A4/en
Priority to US07/776,418 priority patent/US5191272A/en
Publication of JPH03289385A publication Critical patent/JPH03289385A/ja
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0265Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0205Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
    • G05B13/024Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P23/00Arrangements or methods for the control of AC motors characterised by a control method other than vector control
    • H02P23/16Controlling the angular speed of one shaft

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明はロボット等のモータ制御のゲイン調整方法に関
し、特にモータ制御ループのフィードバックゲインを自
動的に調整するようにしたモータ制御のゲイン調整方法
に関する。
〔従来の技術〕
ロボットのようなアームの伸縮状態によって、負荷イナ
ーシャが大幅に変化し、かつサーボモータと機構部の減
速比が大きい機械可動部を有する系においてフィードフ
ォワード制御を行なうことは非常に難かしい。なぜなら
、フィードフォワードゲインはフィードバックでない為
、パラメータがピッタリ当っていないと効果がない。
しかし、従来の方法では、イナーシャ値が未知の場合に
はフィードフォワードゲインを計算することができない
。また、イナーシャ変動があった場合などは、その平均
的な値を計算することが非常に困難であり、例え行って
も非常に手間の掛かる作業になる。
このような問題を解決するものとして、本出願人による
平成2年2月21日付けの発明の名称を「モータ制御の
フィードフォワードゲインの学習方法」とする出願があ
る。この出願では、フィードフォワードゲインを、学習
によって決定している。
一方、フィードバックループのフィードバックゲイン、
すなわち比例ゲイン等は、系のステップ応答等を検討し
て、決定されている。
〔発明が解決しようとする課題〕
しかし、フィードバックゲインをステップ応答等によっ
て判断して決定すると、このための計測、時間等に相当
の時間を要する。また、決定に当たっては相当の熟練等
が必要であり、客観的に適性な値に決定することが困難
であった。
本発明はこのような点に鑑みてなされたものであり、フ
ィードバックゲインを自動的に調整するモータ制御のゲ
イン調整方法を提供することを目的とする。
また、本発明の他の目的はフィードバックゲインをフィ
ードフォワードゲインから計算して求めるモータ制御の
ゲイン調整方法を提供することである。
〔課題を解決するための手段〕
本発明では上記課題を解決するために、負荷イナーシャ
が大幅に変動する制御システムのモータ制御でのフィー
ドバックゲインの調整を行う、モータ制御のゲイン調整
方法において、フィードバック系での第1回目のフィー
ドバックゲインで、第1回目のフィードフォワードゲイ
ンを学習によって求め、前記第1回目のフィードフォワ
ードゲインから、第2回目のフィードバックゲインを計
算で求め、前記第2回目のフィードバックゲインで、学
習によって、第2回目のフィードフォワードゲインを求
め、モータ制御ループを構・戊することを特徴とするモ
ータ制御のゲイン調整方法が、提供される。
〔作用〕
まず、第1回目のフィードバックゲインを決める。この
値はモータ単体等から計算し、制御ループが発振しない
程度の値に決める。この第1回目のフィードバックゲイ
ンで、第1回目のフィードフォワードゲインを学習によ
って求める。次に求められた第1回目のフィードフォワ
ードゲインから、第2回目のフィードバックゲインを計
算によって求める。ついで、第2回目のフィードバック
ゲインで、再度、フィードフォワードゲインを学習によ
って求める。第2回目のフィードフォワードゲインと第
2回目のフィードバックゲインで制御システムを構成す
る。これによって、最適なフィードフォワードゲイン及
びフィードバックゲインを有する制御システムを求める
ことができる。
〔実施例〕
以下、本発明の一実施例を図面に基づいて説明する。
第2図は本発明を実施するためのロボットシステムのハ
ードウェアの構成図である。ホストプロセッサ1はロボ
ット全体を制御するプロセッサである。ホストプロセッ
サ1からはロボットの位置指令が共有RAM2に書き込
まれる。なお、ホストプロセッサに結合されるROMS
RAM等は省略しである。
ロボットに内蔵されたサーボモータ22を制御するDS
P (ディジタル・シグナル・プロセッサ)11はRO
M12のシステムプログラムに従って、共有RAM2の
位置指令を一定時間ごとに読み取り、軸制御回路(AX
C)14にトルク指令を出力する。なお、必要な計算等
はRAM13を使用して行う。
DSPIIは、内部に位置指令とサーボモータ22に内
蔵されたパルスコーダ23からの位置フィードバックと
の差分によるエラー量から速度指令を計算する。さらに
、位置フィードバックを微分して、速度フィードバック
を計算する。この速度フィードバックと速度指令との差
分からトルク指令を計算する。
サーボアンプ21はトルク指令を受けて、サーボモータ
22を駆動する。サーボモータ22は減速機を介して、
アーム26を駆動する。図では、減速機等の機械系のバ
ネ成分24(バネ定数Kc)、ダンピング成分25 (
ダンピング定数Bk)を模式的に表している。
また、DSPIIは後述のフィードフォワードゲインを
学習によって求め、フィードバックゲインを計算によっ
て求める。
次にフィードバックゲインを決定する問題を考える。ま
ず、例としてモータ制御における速度ループを考える。
第3図はモータ制御における速度ループのブロック図で
ある。速度指令値Uとフィードフォワードループの伝達
関数11を通したものとが加算器12で加算され、出力
Xとなる。Kはフィードフォワードゲインである。出力
Xは加算器13で速度フィードバック量Yを引き、伝達
関数14に送られる。K1は速度ゲインである。
ブロック14の出力は伝達関数15に入力される。
Ktはサーボモータのトルク定数、Jはサーボモータ軸
からみた機械系のイナーシャであり、ロボットの姿勢に
よって大幅に変動する。Sはラプラス演算子である。
ここで、 U* (1+Ks)=X ただし、Uは速度指令、Yは速度フィードバック量、(
U−Y)は速度偏差、Sはラプラス演算子である。この
式をUについて解くと、 U=X/ (1−+−IKS) X / U = 1 + K S   ・−(1)これ
は入力X1出力Yとするシステムの逆システムを同定し
たことになる。これを利用してに1を決定する。人力X
、出力Yとする伝達関数を考えると、 Y/X=1/ C(JS/ (K1*Kt)+1)1 
/ (T S +1 )       (2)となる。
ここで、Tはこの系の時定数であり、T=J/ (K1
*Kt) である。
ここで、(1)式の逆システムが(2)式に等しいとお
くと、 U/X=Y/X=1/ (1+KS) 1/(1+TS) 従って、フィードフォワードゲインKがフィードバック
ループの時定数を表していることが分かる。
今、希望するフィードバックループの時定数をT1とす
ると、 K 1 = K / T 1 * K 1 a    
   ゛°−−− (3)ただし、Klaは現在の比例
ゲイン、K1は新しく設定する比例ゲインである。この
新しい比例ゲインに1を設定すると、 T=J/ (K*に1 a*Kt/Tl)−(T 1/
K) * (J/K 1 a *K t)(Tl/K)
*に 1 となり、希望の時定数を持ったフィードバック系が得ら
れる。このに1を設定しなおした後、もう−度フイード
フォワードゲインの学習を行うことによりKを学習し、
最適なフィードフォワードゲインKが決まり、さらにこ
のに1を設定すれば系全体のゲインが最適値に収束する
次に本発明の処理について述べる。第1図は本発明のモ
ータ制御のゲイン調整方法のフローチャートである。図
において、Sに続く数値はステップ番号を示す。
〔S1〕適当なフィードバックループの比例ゲインに1
を設定する。この比例ゲインの値はモータ単体等から計
算して、系が発振しない程度の値とする。
〔S2〕このフィードバックループの状態で、学習によ
り、フィードフォワードゲインKを求める。
〔S3〕フイードフオワードゲインKから(3)式によ
って、比例ゲインKlを計算で求めて、設定する。
〔S4〕この比例ゲインに1で再度学習により、フィー
ドフォワードゲインKを求める。
以上のフィードフォワードゲインに1フイードバツクゲ
イン、すなわち比例ゲインに1でモータの制御ループを
構成すれば、最適な制御ループを構成することができる
上記の説明では、速度ループのフィードバックゲインと
フィードフォワードゲインについて述べたが、位置制御
ループのフィードバックゲイン及びフィードフォワード
ゲインについても同様に適用することができる。
〔発明の効果〕
以上説明したように本発明では、フィードフォワードゲ
インを学習によって求め、これからフィードバックゲイ
ンを計算するように構成したので、適性なフィードフォ
ワードゲインとフィードバックゲインを求めることがで
き、最適な制御ループを得ることができる。
特に、ロボット等の制御ループにおいて、振動の減少、
位置決め精度の向上が得られる。
【図面の簡単な説明】
第1図は本発明のモータ制御のゲイン調整方法のフロー
チャート、 第2図は本発明を実施するためのロボットシステムのハ
ードウェアの構成図、 第3図はモータ制御における速度ループのブロック図で
ある。 1  ・−ホストプロセッサ 2″ ・  共有RAM 11   −−D S P (ディジタル・シグナル・
プ4 2 l・・− 22゛ 6 0セツサ) ゛軸制御回路(AXC) ・・・サーボアンプ サーボモータ アーム

Claims (4)

    【特許請求の範囲】
  1. (1)負荷イナーシャが大幅に変動する制御システムの
    モータ制御でのフィードバックゲインの調整を行う、モ
    ータ制御のゲイン調整方法において、フィードバック系
    での第1回目のフィードバックゲインで、第1回目のフ
    ィードフォワードゲインを学習によって求め、 前記第1回目のフィードフォワードゲインから、第2回
    目のフィードバックゲインを計算で求め、前記第2回目
    のフィードバックゲインで、学習によって、第2回目の
    フィードフォワードゲインを求め、 モータ制御ループを構成することを特徴とするモータ制
    御のゲイン調整方法。
  2. (2)前記制御システムはロボットの機構部をサーボモ
    ータで制御する制御システムであることを特徴とする請
    求項1記載のモータ制御のゲイン調整方法。
  3. (3)前記フィードフォワードゲイン及び前記フィード
    バックゲインは速度制御ループのゲインであることを特
    徴とする請求項1記載のモータ制御のゲイン調整方法。
  4. (4)前記フィードフォワードゲイン及び前記フィード
    バックゲインは位置制御ループのゲインであることを特
    徴とする請求項1記載のモータ制御のゲイン調整方法。
JP2088670A 1990-04-03 1990-04-03 モータ制御のゲイン調整方法 Pending JPH03289385A (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2088670A JPH03289385A (ja) 1990-04-03 1990-04-03 モータ制御のゲイン調整方法
PCT/JP1991/000434 WO1991015893A1 (en) 1990-04-03 1991-04-01 Method of regulating gain of motor control
EP19910906574 EP0474888A4 (en) 1990-04-03 1991-04-01 Method of regulating gain of motor control
US07/776,418 US5191272A (en) 1990-04-03 1991-04-01 Method of adjusting gain for motor control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2088670A JPH03289385A (ja) 1990-04-03 1990-04-03 モータ制御のゲイン調整方法

Publications (1)

Publication Number Publication Date
JPH03289385A true JPH03289385A (ja) 1991-12-19

Family

ID=13949254

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2088670A Pending JPH03289385A (ja) 1990-04-03 1990-04-03 モータ制御のゲイン調整方法

Country Status (4)

Country Link
US (1) US5191272A (ja)
EP (1) EP0474888A4 (ja)
JP (1) JPH03289385A (ja)
WO (1) WO1991015893A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10133246B2 (en) 2014-09-12 2018-11-20 Canon Kabushiki Kaisha Position control device and position control method, optical device, and image pickup apparatus
WO2020261649A1 (ja) * 2019-06-28 2020-12-30 オムロン株式会社 パラメータ調整方法

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2820820B2 (ja) * 1991-11-12 1998-11-05 ファナック株式会社 サーボモータの制御装置
JP3127688B2 (ja) * 1993-12-03 2001-01-29 トヨタ自動車株式会社 フィードバックゲイン決定方法
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
US6470225B1 (en) 1999-04-16 2002-10-22 Siemens Energy & Automation, Inc. Method and apparatus for automatically tuning feedforward parameters
US6198246B1 (en) 1999-08-19 2001-03-06 Siemens Energy & Automation, Inc. Method and apparatus for tuning control system parameters
TWI243291B (en) * 2003-05-13 2005-11-11 Asml Netherlands Bv Control system, lithographic apparatus, device manufacturing method, and device manufactured thereby
TWI302233B (en) * 2005-08-19 2008-10-21 Delta Electronics Inc Method for estimating load inertia and a system for controlling motor speed by using inverse model
CN1925310B (zh) * 2005-08-30 2010-05-12 台达电子工业股份有限公司 利用逆算模型的马达速度控制系统和负载惯量估测方法
JP2008029177A (ja) * 2006-07-25 2008-02-07 Ricoh Co Ltd 半導体装置
JP6748135B2 (ja) * 2018-03-19 2020-08-26 ファナック株式会社 機械学習装置、サーボ制御装置、サーボ制御システム、及び機械学習方法
CN112847352B (zh) * 2020-12-31 2022-10-14 上海新时达机器人有限公司 机器人控制方法、电阻设备、存储介质

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3408551A1 (de) * 1984-03-08 1985-09-12 Siemens AG, 1000 Berlin und 8000 München Verfahren zum verringern von bahnfehlern bei rechnergesteuerten werkzeugmaschinen oder industrierobotern
US4841208A (en) * 1986-09-11 1989-06-20 Toshiba Kikai Kabushi Kaisha Position control system including a quick response control
JPH0796248B2 (ja) * 1987-04-07 1995-10-18 東芝機械株式会社 射出成形機
JPH01137305A (ja) * 1987-11-25 1989-05-30 Mitsubishi Electric Corp フィードバック制御装置
US4885676A (en) * 1988-03-09 1989-12-05 Storage Technology Corporation Control loop instability detection and correction apparatus
JPH0738136B2 (ja) * 1988-08-22 1995-04-26 三菱電機株式会社 位置決め制御装置
US5049796A (en) * 1989-05-17 1991-09-17 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Robust high-performance control for robotic manipulators

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10133246B2 (en) 2014-09-12 2018-11-20 Canon Kabushiki Kaisha Position control device and position control method, optical device, and image pickup apparatus
WO2020261649A1 (ja) * 2019-06-28 2020-12-30 オムロン株式会社 パラメータ調整方法
JP2021006952A (ja) * 2019-06-28 2021-01-21 オムロン株式会社 パラメータ調整方法
US11809148B2 (en) 2019-06-28 2023-11-07 Omron Corporation Parameter adjustment method for adjusting control parameters for device that performs servo control

Also Published As

Publication number Publication date
EP0474888A4 (en) 1992-05-20
EP0474888A1 (en) 1992-03-18
WO1991015893A1 (en) 1991-10-17
US5191272A (en) 1993-03-02

Similar Documents

Publication Publication Date Title
JPS61226804A (ja) 多自由度非線形機械システムの制御装置
EP0012620A2 (en) Closed loop type numerical-controlled machine tool
JPH0683403A (ja) 適応pi制御方式
JPH03289385A (ja) モータ制御のゲイン調整方法
JP2882586B2 (ja) 適応制御装置
JPH04323706A (ja) 予見繰り返し制御装置
US5637969A (en) Vibration control method
US5986422A (en) Control mode changing over method for servo control system
JPS63274385A (ja) サ−ボモ−タの速度制御装置
US4771389A (en) Control method and unit for controlling a manipulator
US5444612A (en) Adaptive PI control system
US20030173928A1 (en) Servo control method
JP3599849B2 (ja) サーボ制御における移動指令の分配方法
JPH0392911A (ja) スライディングモード制御によるロボット制御方法
JP2733881B2 (ja) Pi制御ループをベースにした適応スライディングモード制御方式
JPH04112690A (ja) サーボモータの制御方式
EP0469151A1 (en) Method of learning feed-forward gain in motor control
EP0544001A1 (en) Adaptive pi control system
JP4038659B2 (ja) サーボ制御装置
JP3870767B2 (ja) 予測制御方法
JP2000020104A (ja) 速度制御ゲイン調整方法および装置
JPH06214656A (ja) 制振要素を持つスライディングモード制御方法
JP2709766B2 (ja) サーボモータのフィードフォワード制御方式
JP4362762B2 (ja) サーボ制御装置およびその調整方法
JPH01303084A (ja) デジタルサーボ制御方法