JPS60200788A - 速度制御方式 - Google Patents

速度制御方式

Info

Publication number
JPS60200788A
JPS60200788A JP59055114A JP5511484A JPS60200788A JP S60200788 A JPS60200788 A JP S60200788A JP 59055114 A JP59055114 A JP 59055114A JP 5511484 A JP5511484 A JP 5511484A JP S60200788 A JPS60200788 A JP S60200788A
Authority
JP
Japan
Prior art keywords
speed
signal
speed control
torque command
control system
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
JP59055114A
Other languages
English (en)
Inventor
Mitsuo Kurakake
鞍掛 三津雄
Keiji Sakamoto
坂本 啓二
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 JP59055114A priority Critical patent/JPS60200788A/ja
Priority to PCT/JP1985/000141 priority patent/WO1985004534A1/ja
Publication of JPS60200788A publication Critical patent/JPS60200788A/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
    • G05B17/00Systems involving the use of models or simulators of said systems
    • G05B17/02Systems involving the use of models or simulators of said systems electric

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Electric Motors In General (AREA)
  • Control Of Direct Current Motors (AREA)
  • Control Of Velocity Or Acceleration (AREA)

Abstract

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

Description

【発明の詳細な説明】 (産業上の利用分野) 本発明は、速度制御方式に係り、特に、低剛性負荷を有
するサーボモータの速度制御方式に関する。
(従来技術とその問題点) 従来のDCモータを用いた速度制御系は、第1図のよう
示すことができる。図中、K1は比例ケイン K2は積
分ケイン、Kvは電力増幅器ゲイン、Raは電機子抵抗
、Laは電機子インタフタンス、Jmはモータロータイ
ナーシャ、JLは負荷慣性イナーシャ、Keは誘起電圧
定数、K丁はl・ルク定数である。このような一般的な
速度系は′上刃増幅器ケインKvが成る程度大きければ
筒中(ヒして第2図のように示すことができる。ただし
、これは、モータロータイナーシャJmと負荷慣性イナ
一シャJLがリジ〉・ドに結合された場合のことであり
、通常、結合におけるハネ係数K(Nm/rad)を考
慮した場合には第3図のようになる。
しかし、第3図においては、次の式、即ち、となり、バ
ネ係数にの値によっては、非常にダンピングの悪い系と
なる。
そこで、」二記の系の欠点を解消し、連応性、安定性を
向」ニさせるために第4図のような速度制御系が採用さ
れる。即ち、第3図の速度制御系に、機械負荷送り系お
よび機械負荷先端からのフィートハ、り回路を伺加する
ように構成する。そして、第4図においては、次の式、
即ち、 が成立する。
しかし、実際的には、K3、K4のフィートパンクをと
るためには、機械負荷送り系の変位dおよび機械負荷の
先端の速度viを検出するセンサが必要であった。
ところがこのようなセンサは、コストが高くなる上に、
取り4qけ場所及び精度等の問題があり、」二記のよう
な速度制御系を実現することは容易なことではないとい
うのが現状であった。
(発明の目的) 本発明は、サーボモータに接続される機械負荷における
機械負荷の先端の速度および負荷送り系のトルク応力ま
たは弾性変位を推定器を用いて推定し、該推定値に基づ
いて速度帰還を行ない、センサを要しない」二にコスト
が低減され、しかも連応性、安定性に優れた速度制御方
式を提供することを目的とする。
(発明の概要) 本発明は、機械負荷を駆動するサーボモータに取り付け
られた速度検出器からの速度信号をフィートパンクし、
該サーボモータへのトルク指令信号を生成するようにし
た速度制御方式において、該速度信号と該トルク指令信
号から機械負荷の先端速度および負荷送り系のトルク応
力または弾性変位を推定器によって搦定し、該4(L定
値からのフィードバック信号をトルク指令に加えるよう
に構成する。
(実施例) 以下、本発明の一実施例を図面に基づいて説明する。第
5図は本発明に係る速度制御方式の一実施例プロ、り図
である。図中、K1、K3.K。
は比例ゲイン、K2は積分ゲイン、Jmはモータロータ
・rナーシャ、Kはバネ係数、JLは真前慣性イナーシ
ャ、dは機械負荷送り系の変位、VUは機械負荷の先端
速度、rはトルク指令、■は速度信号、11はトルク指
令信号である。なお、Sはd/dtを表す。この実施例
においては、第4図において行なわれる機械負荷送り系
の変位dおよび機械負荷の先端速度7文をフィートパン
クする回路を設ける代りに速度信号■とトルク指令信号
Uとから機械負荷送り系のトルク応力又は弾性変位dお
よびR械負荷の先端速度7文を推定器1でそして、得ら
れた推定値はトルク指令に加えるように構成している。
次に、推定器lについて説明する。該推定器は公知のオ
ブザーバ(オブザー、<の理論として公知である。例え
ば、「システムと制御」・層液書店、「システム制御論
理人間」・実教出版参照)を用いており、このオブザー
バの構成方法にはいろいろあるか、ここでは最小次元オ
ブザーバを用いた例を示す。
速度制御系を簡単化して表わすと、第6図に示すとおり
となる。これを状態方程式で記述すると状5店変数でv
、d、■9.のうぢ、■のみが検出できるので、これと
制’+kU入力Uとを用いて、下式の最小次元オブザー
バか構成できる。
へ vt″′ じへ −ノ・・し=−、、、、(λ)れの真
の検出値d1、vlに収束する特性を決める定数であり
、上式の微分方程式の固有値を考慮して決定される。
ト述の最小次元オブザーバは第7図のプロ、り図で表わ
される。
そこで、上記(1)及び(2)式を用いて第5図を変形
すれは、第8図のように表わすことができる。
そして、第8図においてオブザーバ部分、即ち推定器l
は、第9図のように構成することができる。
図中、2.3.4.5は増幅器、R,−R日は抵抗、c
、、C2はコンデンサ、Uはトルク指令信号、■は速度
信号、Wlは機械負荷の送り系のトルク応力又は弾性変
位dの推定値d、w2は機械負荷の先端速度7文の推定
値7文である。
尚、ここでは、 の関係にある。
以I−は、アナログ回路による構成にしたか、マイクロ
プロセッサの演算機能を用いても当該速度制御方式か実
現できることは汀うまでもない。また、速度信りはサー
ボモータにロータリーエンコータを設け、該ロータリー
エンコーダからの位置情報に)1(ついて前記速度信号
を得るようにしても良い。
尚、本発明を一実施例に基づいて説明したが、本発明は
前述の実施例に限定されるものではなく、本発明の主旨
の範囲で種々の変形が可能であり、これらを本発明の範
囲から排除するものではない。
(発明の効果) 未発明によれば、サーボモータの速度信号とトルク指令
信号とから機械負荷の元端の速度および負荷送り系のト
ルク応力または弾性変位を推定器によって推定するよう
にしたので、センサを用いることなく、低コストで、し
かも連応性、安定性に優れた速度制御系を実現すること
ができる。
【図面の簡単な説明】
第1図は従来のDCモータを用いた速度制御系ブロツク
図、第2図は第1図を簡略化した速度制御系プロ、り図
、第3図はバネ係数を考慮した場合の速度制御系ブロツ
ク図、第4図は速絶:性、安定例を有する速度制御系ブ
ロツク図、第5図は本発明に係る速度制御方式の原理を
示すブロック図、第6図は制御対象を簡略化して示した
ブロフク図、第7図は最小次元オブザーバを示すプロ、
り図、第8図は本発明に係る速度制御方式の一実施例ブ
ロフク図、第9図は1イ1定器の具体的回路図である。 1・・・推定器、2.3.4.5・・・増幅器、C1、
C2・・・コンデンサ、R1〜R日・・・抵抗。 第1図 第 2 図 第 3 図 第4図 第 5 図 第 ○ 図 第 7 図

Claims (2)

    【特許請求の範囲】
  1. (1)機械負荷を駆動するサーボモータに取す付けられ
    た速度検出器からの速度信号をフィード/\、りし、該
    サーボモータへのトルク指令信号成するようにした速度
    制御方式において、該速度信吟と該トルク指令信号とか
    ら機械負荷の先端の速度および負荷送り系のトルク応力
    または弾性変位を推定器によって推定し、該tft定仙
    からのフィードバンク信号をトルク指令に加えるように
    したことを特徴とする速度制御方式。
  2. (2)前記サーボモータにロータリーエンコーダを設け
    、該ロータリーエンコータからの位置情報から、前記速
    度信号を得るようにしたことを特徴とする特許請求の範
    囲第(1)JJ”tに記載の速度制御方式。
JP59055114A 1984-03-22 1984-03-22 速度制御方式 Pending JPS60200788A (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP59055114A JPS60200788A (ja) 1984-03-22 1984-03-22 速度制御方式
PCT/JP1985/000141 WO1985004534A1 (en) 1984-03-22 1985-03-22 Speed control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP59055114A JPS60200788A (ja) 1984-03-22 1984-03-22 速度制御方式

Publications (1)

Publication Number Publication Date
JPS60200788A true JPS60200788A (ja) 1985-10-11

Family

ID=12989722

Family Applications (1)

Application Number Title Priority Date Filing Date
JP59055114A Pending JPS60200788A (ja) 1984-03-22 1984-03-22 速度制御方式

Country Status (2)

Country Link
JP (1) JPS60200788A (ja)
WO (1) WO1985004534A1 (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1987002485A1 (en) * 1985-10-17 1987-04-23 Fanuc Ltd Speed control system
WO1987003432A1 (en) * 1985-11-27 1987-06-04 Fanuc Ltd Speed control system
JPS62207187A (ja) * 1986-03-05 1987-09-11 Yaskawa Electric Mfg Co Ltd サ−ボモ−タの駆動方式
JPS63201705A (ja) * 1987-02-17 1988-08-19 Daihen Corp マニピユレ−タの防振制御装置
JPH01157283A (ja) * 1987-10-26 1989-06-20 Siemens Ag ばねモーメントおよび差回転数の検出および調節方法
JPH03235687A (ja) * 1990-02-08 1991-10-21 Mitsubishi Electric Corp 外乱抑圧制御システム

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2660183C1 (ru) * 2017-09-14 2018-07-05 федеральное государственное бюджетное образовательное учреждение высшего образования "Национальный исследовательский университет "МЭИ" (ФГБОУ ВО "НИУ "МЭИ") Способ автоматического регулирования координат электропривода и устройство для его осуществления

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS57199487A (en) * 1981-06-03 1982-12-07 Fuji Electric Co Ltd Controller for speed of motor

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5613326B2 (ja) * 1974-04-10 1981-03-27
DE2802224C2 (de) * 1978-01-19 1982-06-09 Siemens AG, 1000 Berlin und 8000 München Schaltungsanordnung zur proportional-integralen Drehzahlregelung einer von einem Elektromotor angetriebenen Arbeitsmaschine mit veränderlicher Belastung

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS57199487A (en) * 1981-06-03 1982-12-07 Fuji Electric Co Ltd Controller for speed of motor

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1987002485A1 (en) * 1985-10-17 1987-04-23 Fanuc Ltd Speed control system
WO1987003432A1 (en) * 1985-11-27 1987-06-04 Fanuc Ltd Speed control system
JPS62126883A (ja) * 1985-11-27 1987-06-09 Fanuc Ltd 速度制御方式
JPS62207187A (ja) * 1986-03-05 1987-09-11 Yaskawa Electric Mfg Co Ltd サ−ボモ−タの駆動方式
JPS63201705A (ja) * 1987-02-17 1988-08-19 Daihen Corp マニピユレ−タの防振制御装置
JPH01157283A (ja) * 1987-10-26 1989-06-20 Siemens Ag ばねモーメントおよび差回転数の検出および調節方法
JPH03235687A (ja) * 1990-02-08 1991-10-21 Mitsubishi Electric Corp 外乱抑圧制御システム

Also Published As

Publication number Publication date
WO1985004534A1 (en) 1985-10-10

Similar Documents

Publication Publication Date Title
US5073749A (en) Mobile robot navigating method
JP3712876B2 (ja) 電動式パワーステアリング制御装置
JP2762364B2 (ja) サーボモータのフィードフォワード制御方法
US5691615A (en) Adaptive PI control method
US4816734A (en) Speed control system
JPH0615340B2 (ja) 操舵反力制御装置
JPH0230522B2 (ja)
KR0137340B1 (ko) 위치제어시스템 및 그 위치제어방법
JPS60200788A (ja) 速度制御方式
US4842088A (en) Electric power steering system
JPS59169380A (ja) 改良されたトルク制限のある航空機用サ−ボモ−タ制御装置
JP2580502B2 (ja) 減速機付モ−タの力・トルク制御方法
JP3246572B2 (ja) 電動機駆動系の負荷定数測定方法
WO1992004668A1 (en) System for controlling servomotor
JPH0523988B2 (ja)
JPH0378643B2 (ja)
JPH0695299B2 (ja) 位置決めサーボ系の制御方法
JPS62126403A (ja) 速度制御方式
JP3196266B2 (ja) 電動機の速度制御装置
SU1278804A1 (ru) Комбинированна система управлени
JPH06214656A (ja) 制振要素を持つスライディングモード制御方法
JPH05150820A (ja) Nc装置
JP2512975B2 (ja) 無人搬送車の走行制御装置
JPH01136582A (ja) 速度制御装置
JPS62173371A (ja) 操舵反力制御装置