JPH04112690A - サーボモータの制御方式 - Google Patents

サーボモータの制御方式

Info

Publication number
JPH04112690A
JPH04112690A JP2232848A JP23284890A JPH04112690A JP H04112690 A JPH04112690 A JP H04112690A JP 2232848 A JP2232848 A JP 2232848A JP 23284890 A JP23284890 A JP 23284890A JP H04112690 A JPH04112690 A JP H04112690A
Authority
JP
Japan
Prior art keywords
mechanical system
servo motor
speed
torque
mechanical
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
JP2232848A
Other languages
English (en)
Inventor
Heisuke Iwashita
平輔 岩下
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 JP2232848A priority Critical patent/JPH04112690A/ja
Priority to EP19910914193 priority patent/EP0498891A4/en
Priority to PCT/JP1991/001065 priority patent/WO1992004668A1/ja
Publication of JPH04112690A publication Critical patent/JPH04112690A/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
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/19Numerical 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
    • 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/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Artificial Intelligence (AREA)
  • Power Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Control Of Electric Motors In General (AREA)
  • Control Of Position Or Direction (AREA)
  • Feedback Control In General (AREA)

Abstract

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

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は工作機械の送り軸やロボットアーム等を制御す
るサーボモータの制御方式に関し、特に制御系に対する
外乱トルクをソフト的に抑圧するようにしたサーボモー
タの制御方式に関する。
〔従来の技術〕
産業用ロボットや工作機械では、送り軸やロボットアー
ム等の機械系に加わる外乱トルクの影響によってサーボ
機構に指令された速度や位置に誤差が生じる。したがっ
て機械系の駆動源となるサーボモータを制御するときに
は、外乱トルクの影響を除去するために、機械系入力に
対する外乱トルクを推定してサーボモータへのトルク指
令を補正する必要がある。
第4図は、従来の速度制御系の一例を示すブロック線図
である。伝達要素1は積分ゲインに1と比例ゲインに2
を含むPI制御回路を示し、伝達要s2はトルク定数k
tを含むトルク指令の増幅回路を示している。
サーボモータ3は、その実速度Vmがフィードバックル
ープ4によって速度指令Vcと比較され、その差信号に
より制御されるが、一般にこのような差信号に基づく上
記トルク指令には外乱トルクTaが加わる。そこで、こ
の外乱トルクTaの大きさに応じてトルク指令を補正す
る必要から、実速度信号から微分要素5により実加速度
aを、伝達要素2の入力端のトルク指令信号によりサー
ボモータ3の推定加速度anをそれぞれ演算し、この外
乱トルクTaの大きさを推定し、制御誤差を補正するだ
めのマイナルーブを構成している。
すなわちサーボモータ3の推定加速度を演算する演算器
6は、推定トルク定数ktnを推定モータイナーシャJ
mnで除した比例定数(k t n/Jmn)を有し、
伝達要素7はその逆数の比例定数(Jmn/ktn)を
有している。そして伝達要素7では信号aとanとの偏
差Δaに対して演算を施して外乱トルクの推定値を決定
し、その推定された外乱に対応する正規化された補正値
を出力している。伝達要素8は0〜1の間で任意に設定
可能な補正係数αを含む補正回路である。
上記構成のサーボモータの制御方式によれば、サーボモ
ータ3と結合される機械系に一定の剛性があれば、外乱
トルクの影響をある程度まで除去することが可能である
〔発明が解決しようとする課題〕
しかし、従来のサーボモータの制御方式では、サーボモ
ータ3と機械系とがリジッドに結合されていない場合に
、モータ速度と機械系の速度との偏差に応じて外乱トル
ク値が変動するため、モータ加速度に外乱トルクが直接
には反映されない。
そのため、特に機械系の共振周波数の半分を越す大きさ
の外乱に対しては、有効に制御誤差を補正することが出
来なくなるという問題がある。
本発明はこのような点に鑑みてなされたものであり、機
械系の剛性が低いサーボ系に対する外乱の影響を有効に
除去できるサーボモータの制御方式を提供することを巨
的とする。
〔課題を解決するための手段〕
本発明では上記課題を解決するために、剛性の低い機械
系を駆動するサーボモータを制御対象とし、この機械系
にがかる外乱トルクの推定値によってサーボモータのト
ルク指令値に対する制御誤差を補正するようにしたサー
ボモータの制御方式において、前記機械系の実速度から
機械系の実加速度を演算する演算手段と、前記サーボモ
ータのトルク指令を、このトルク指令に基づく前記機械
系の推定加速度に変換する信号変換手段と、前記演算手
段および前記信号変換手段の出力の偏差を演算して前記
機械系にがかる外乱トルクを推定する推定手段とを有す
ることを特徴とするサーボモータの制御方式が提供され
る。
〔作用〕
本発明のサーボモータの制御方式では、剛性の低い機械
系をサーボモータにより速度制御或いは位置制御する時
に、サーボモータへの電流指令と機械系の実加速度に基
づいて外乱トルクの推定値を求めて制御誤差を補正する
ことによって、ばね定数やダンパ定数により非線型に変
化する外乱のトルク指令に対する影響を抑制している。
〔実施例〕
以下、本発明の一実施例を図面に基づいて説明する。
第1図は、本発明のサーボモータの制御方式を示すブロ
ック線図であり、第2図には制御対象であるサーボモー
タとその出力軸に接続された負荷系との結合部分をなす
ばね系のモデルを示している。
第2図において、2.3はそれぞれ第4図の伝達要素2
およびサーボモータ3に対応しており、ここで外乱トル
クTbとは、機械側Aの加算器10への入力として想定
される、たとえば切削負荷などである。機械側へとモー
タ側Bは、モータシャフトに接続される変速手段などに
よってばね結合されており、その結果、加算器11から
モータ速度Vmと機械速度VLとの偏差かばね定数Km
とダンパ定数Cmを含むねじれ要素12において堆幅さ
れ、この伝達要素12の出力が、それぞれ機械側Aとモ
ータ側Bへの外乱として与えられる。
従って、負荷トルクJLを含む機械系の伝達要素13に
は、切削負荷などの外乱Tb以外に摩擦やトルクリップ
ルなどのモータ側Bからの外乱が加算器10への十入力
として、またモータ側Bの加算器14には一人力として
供給されることになる。
第1図に示すものは、このような剛性の低い機械系を駆
動するサーボモータ3を制御対象とするサーボモータの
制御方式の一例である。サーボモータ3の速度指令Vc
に対する補償回路である伝達要素1.2フよびフィード
バックループ4は、第4図の1.2および4とそれぞれ
対応している。
ここでは更に速度制御系の外側に、図には示していない
位置ループを設けて、いわゆるクローズド・ループ方式
により位置精度を高めることが可能である。
本発明では、上記伝達要素13の出力、すなわち機械速
度Vlを制御系にフィードバックすることによって、制
御誤差を補正するだめのマイナループを構成し、機械系
にかかる外乱トルクTbの推定値によってサーボモータ
のトルク指令値Tcに対する制御誤差を補正するように
している。
第1図の実施例では、微分要素15にモータ速度Vmで
はなく機械速度Vlを入力し、実加速度aとして機械速
度Vlを微分した値を使用している。この実加速度aは
、伝達要素2の入力側のトルク指令信号を変換して得ら
れる機械系の推定加速度anと比較され、機械系にかか
る外乱トルクTbの大きさを推定している。
すなわち、機械系の推定加速度anを演算する伝達要素
16は、推定トルク定数ktnを推定モータイナーシャ
Jmnと推定負荷トルクJLnとの和で除した比例定数 k tn/ (Jmn+JLn) により構成されている。更に演算器17によって、実加
速度aと推定加速度anとの偏差Δaを演算して、伝達
要素18ではこの偏差Δaに対して演算を施して外乱ト
ルクの推定値を決定し、さらに伝達要素19からその推
定された外乱トルクの大きさに対応する正規化された補
正値を出力している。この場合に、トルク定数ktやモ
ータイナーシャJm及び負荷トルクJLは、いずれも制
御系や機械系に固有な値であって、しかも所定の周波数
特性を持つため、ここでは第4図の従来方式のものと同
様にそれらの推定値ktn、Jmn、JLnが使用され
ている。
伝達要素19は、上記したように推定された外乱トルク
値を補正する補正回路であって、0〜1の間で任意に設
定可能な補正係数αを含むものである。この係数値αは
機械側とモータ側との結合定数を決定する上記ねじれ要
素12に応じて設定されるが、一般に0.8程度が選択
される。
第3図は、第1図の速度制御系を用いて位置ループを組
んだ時の外乱トルクに対する位置の制御誤差を示す図で
ある。ここで従来例として示す曲線は、第4図の制御系
をシミュレートした場合の制御特性であって、横軸は外
乱トルクの周波数を対数表示によって示す対数軸、縦軸
は機械位置の制御誤差を示す対数軸である。従来例も本
発明もそのカットオフ周波数が30Hz、ダンピング係
数が0.1となるように伝達要素12の係数値KmSC
mを設定して、伝達要素20から帰還される補正出力が
100%となるように、計数値αを1としてソフトウェ
アプログラムによってシミュレートされたものである。
ここに示されるように、本発明方式では機械系の剛性が
低い場合に、機械系にがかる外乱の影響を低減でき、指
令された制御量に正確に追従するサーボ系を構成できる
〔発明の効果〕
以上説明したように本発明によれば、サーボモータへの
電流指令と機械系の実加速度に基づいて外乱トルクの推
定値を求めて制御誤差を補正することによって、ばね定
数やダンパ定数により非線形に変化する外乱のトルク指
令に対する影響を抑制しているので、指令された制御量
に正確に追従させることができる。
示す図、 第4図は、従来の速度制御系の一例を示すブロック線図
である。
15  ° 微分要素(演算手段) 16 ・・ 伝達要素(信号変換手段)17 ・ °演
算器 18 °゛°゛′伝達要素(推定手段)a ・−実加速
度 an・ 推定加速度 特許出願人  ファナック株式会社 代理人    弁理士  服部毅巖
【図面の簡単な説明】
第1図は本発明の一実施例方式を示す制御系のブロック
線図、

Claims (3)

    【特許請求の範囲】
  1. (1)剛性の低い機械系を駆動するサーボモータを制御
    対象とし、この機械系にかかる外乱トルクの推定値によ
    ってサーボモータのトルク指令値に対する制御誤差を補
    正するようにしたサーボモータの制御方式において、 前記機械系の実速度から機械系の実加速度を演算する演
    算手段と、 前記サーボモータのトルク指令を、このトルク指令に基
    づく前記機械系の推定加速度に変換する信号変換手段と
    、 前記演算手段および前記信号変換手段の出力の偏差を演
    算して前記機械系にかかる外乱トルクを推定する推定手
    段と、 を有することを特徴とするサーボモータの制御方式。
  2. (2)前記推定手段で推定された外乱トルク値を補正す
    る補正手段をさらに有し、この補正出力を前記サーボモ
    ータのトルク指令値に加えることによって制御誤差を補
    正するようにしたことを特徴とする請求項1記載のサー
    ボモータの制御方式。
  3. (3)前記補正手段は、0乃至1の範囲で可変設定され
    る補正係数を含み、前記機械系のダンピング係数に応じ
    て補正出力を決定して制御誤差を補正するようにしたこ
    とを特徴とする請求項2記載のサーボモータの制御方式
JP2232848A 1990-09-03 1990-09-03 サーボモータの制御方式 Pending JPH04112690A (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2232848A JPH04112690A (ja) 1990-09-03 1990-09-03 サーボモータの制御方式
EP19910914193 EP0498891A4 (en) 1990-09-03 1991-08-08 System for controlling servomotor
PCT/JP1991/001065 WO1992004668A1 (en) 1990-09-03 1991-08-08 System for controlling servomotor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2232848A JPH04112690A (ja) 1990-09-03 1990-09-03 サーボモータの制御方式

Publications (1)

Publication Number Publication Date
JPH04112690A true JPH04112690A (ja) 1992-04-14

Family

ID=16945756

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2232848A Pending JPH04112690A (ja) 1990-09-03 1990-09-03 サーボモータの制御方式

Country Status (3)

Country Link
EP (1) EP0498891A4 (ja)
JP (1) JPH04112690A (ja)
WO (1) WO1992004668A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5710500A (en) * 1994-04-28 1998-01-20 Matsushita Electric Industrial Co., Ltd. Motor speed control apparatus using phase-advance based estimated disturbance signal
JP2016164697A (ja) * 2015-03-06 2016-09-08 富士電機株式会社 位置制御システム
JP2019159733A (ja) * 2018-03-13 2019-09-19 富士電機株式会社 速度・位置制御システム

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6519169B1 (en) 1999-03-29 2003-02-11 Abb Ab Multiphase inverter with series of connected phase legs
SE516720C2 (sv) 1999-04-01 2002-02-19 Abb Ab Utrustning för styrning av en industrirobot och förfarande för programmering och/eller justering av robotens rörelse
CN112448636B (zh) * 2020-12-04 2022-07-29 岳阳市爱达兴智能科技有限公司 一种电动车加速度的控制方法
CN113517833A (zh) * 2021-06-17 2021-10-19 美的威灵电机技术(上海)有限公司 电机的控制方法、控制装置、控制系统和可读存储介质

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6315692A (ja) * 1986-07-07 1988-01-22 Hitachi Ltd 電動機の速度制御装置
JPS6464577A (en) * 1987-08-31 1989-03-10 Fanuc Ltd Servomotor controller
JP2663526B2 (ja) * 1988-06-28 1997-10-15 三菱マテリアル株式会社 アクチュエータの制御装置
JPH02136906A (ja) * 1988-11-17 1990-05-25 Mitsubishi Electric Corp 可動体の制御装置
JPH087624B2 (ja) * 1989-08-24 1996-01-29 株式会社ミツトヨ 外乱トルク補償装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5710500A (en) * 1994-04-28 1998-01-20 Matsushita Electric Industrial Co., Ltd. Motor speed control apparatus using phase-advance based estimated disturbance signal
JP2016164697A (ja) * 2015-03-06 2016-09-08 富士電機株式会社 位置制御システム
JP2019159733A (ja) * 2018-03-13 2019-09-19 富士電機株式会社 速度・位置制御システム

Also Published As

Publication number Publication date
EP0498891A1 (en) 1992-08-19
WO1992004668A1 (en) 1992-03-19
EP0498891A4 (en) 1993-09-15

Similar Documents

Publication Publication Date Title
US5691615A (en) Adaptive PI control method
JP3506157B2 (ja) 電動機の位置制御装置
JP2573120B2 (ja) 同期形交流サーボモータの速度制御方法及び制御装置
JPH05216504A (ja) バネ系を含む制御対象に対する適応的スライディングモード制御方式
JP2004272883A (ja) サーボ制御装置
JPH03118618A (ja) 制振効果を持つスライディングモード制御による制御方式
JPS61226804A (ja) 多自由度非線形機械システムの制御装置
JPH07104856A (ja) 振動制御方法
JPH10309684A (ja) マニピュレータのコンプライアンス制御方式
JPH10329063A (ja) ロボット制御装置
WO1992014195A1 (en) Oscillation damper
JPH04112690A (ja) サーボモータの制御方式
JP4658181B2 (ja) サーボ制御装置
JPH0962363A (ja) 電動機の位置決め制御方法
EP0474888A1 (en) Method of regulating gain of motor control
JPH0888990A (ja) モータの位置制御装置
JPH08234801A (ja) モータ駆動式関節アームのための制御装置及び制御方法
Guo et al. On a linearized model and adaptive controller implementation for manipulator motion
JP2790634B2 (ja) 運動機械系の制御装置
JPS61217802A (ja) ロボツト制御装置
JPS603716A (ja) ロボツトの制御装置
KR920004081B1 (ko) 로보트 토오크 제어방법
JP3329163B2 (ja) サーボモータの制御装置
JP2709766B2 (ja) サーボモータのフィードフォワード制御方式
JPS62126403A (ja) 速度制御方式