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
Links
Classifications
-
- 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
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems 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図のようになる。
示すことができる。図中、K1は比例ケイン K2は積
分ケイン、Kvは電力増幅器ゲイン、Raは電機子抵抗
、Laは電機子インタフタンス、Jmはモータロータイ
ナーシャ、JLは負荷慣性イナーシャ、Keは誘起電圧
定数、K丁はl・ルク定数である。このような一般的な
速度系は′上刃増幅器ケインKvが成る程度大きければ
筒中(ヒして第2図のように示すことができる。ただし
、これは、モータロータイナーシャJmと負荷慣性イナ
一シャJLがリジ〉・ドに結合された場合のことであり
、通常、結合におけるハネ係数K(Nm/rad)を考
慮した場合には第3図のようになる。
しかし、第3図においては、次の式、即ち、となり、バ
ネ係数にの値によっては、非常にダンピングの悪い系と
なる。
ネ係数にの値によっては、非常にダンピングの悪い系と
なる。
そこで、」二記の系の欠点を解消し、連応性、安定性を
向」ニさせるために第4図のような速度制御系が採用さ
れる。即ち、第3図の速度制御系に、機械負荷送り系お
よび機械負荷先端からのフィートハ、り回路を伺加する
ように構成する。そして、第4図においては、次の式、
即ち、 が成立する。
向」ニさせるために第4図のような速度制御系が採用さ
れる。即ち、第3図の速度制御系に、機械負荷送り系お
よび機械負荷先端からのフィートハ、り回路を伺加する
ように構成する。そして、第4図においては、次の式、
即ち、 が成立する。
しかし、実際的には、K3、K4のフィートパンクをと
るためには、機械負荷送り系の変位dおよび機械負荷の
先端の速度viを検出するセンサが必要であった。
るためには、機械負荷送り系の変位dおよび機械負荷の
先端の速度viを検出するセンサが必要であった。
ところがこのようなセンサは、コストが高くなる上に、
取り4qけ場所及び精度等の問題があり、」二記のよう
な速度制御系を実現することは容易なことではないとい
うのが現状であった。
取り4qけ場所及び精度等の問題があり、」二記のよう
な速度制御系を実現することは容易なことではないとい
うのが現状であった。
(発明の目的)
本発明は、サーボモータに接続される機械負荷における
機械負荷の先端の速度および負荷送り系のトルク応力ま
たは弾性変位を推定器を用いて推定し、該推定値に基づ
いて速度帰還を行ない、センサを要しない」二にコスト
が低減され、しかも連応性、安定性に優れた速度制御方
式を提供することを目的とする。
機械負荷の先端の速度および負荷送り系のトルク応力ま
たは弾性変位を推定器を用いて推定し、該推定値に基づ
いて速度帰還を行ない、センサを要しない」二にコスト
が低減され、しかも連応性、安定性に優れた速度制御方
式を提供することを目的とする。
(発明の概要)
本発明は、機械負荷を駆動するサーボモータに取り付け
られた速度検出器からの速度信号をフィートパンクし、
該サーボモータへのトルク指令信号を生成するようにし
た速度制御方式において、該速度信号と該トルク指令信
号から機械負荷の先端速度および負荷送り系のトルク応
力または弾性変位を推定器によって搦定し、該4(L定
値からのフィードバック信号をトルク指令に加えるよう
に構成する。
られた速度検出器からの速度信号をフィートパンクし、
該サーボモータへのトルク指令信号を生成するようにし
た速度制御方式において、該速度信号と該トルク指令信
号から機械負荷の先端速度および負荷送り系のトルク応
力または弾性変位を推定器によって搦定し、該4(L定
値からのフィードバック信号をトルク指令に加えるよう
に構成する。
(実施例)
以下、本発明の一実施例を図面に基づいて説明する。第
5図は本発明に係る速度制御方式の一実施例プロ、り図
である。図中、K1、K3.K。
5図は本発明に係る速度制御方式の一実施例プロ、り図
である。図中、K1、K3.K。
は比例ゲイン、K2は積分ゲイン、Jmはモータロータ
・rナーシャ、Kはバネ係数、JLは真前慣性イナーシ
ャ、dは機械負荷送り系の変位、VUは機械負荷の先端
速度、rはトルク指令、■は速度信号、11はトルク指
令信号である。なお、Sはd/dtを表す。この実施例
においては、第4図において行なわれる機械負荷送り系
の変位dおよび機械負荷の先端速度7文をフィートパン
クする回路を設ける代りに速度信号■とトルク指令信号
Uとから機械負荷送り系のトルク応力又は弾性変位dお
よびR械負荷の先端速度7文を推定器1でそして、得ら
れた推定値はトルク指令に加えるように構成している。
・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とを用いて、下式の最小次元オブザー
バか構成できる。
となる。これを状態方程式で記述すると状5店変数でv
、d、■9.のうぢ、■のみが検出できるので、これと
制’+kU入力Uとを用いて、下式の最小次元オブザー
バか構成できる。
へ
vt″′ じへ −ノ・・し=−、、、、(λ)れの真
の検出値d1、vlに収束する特性を決める定数であり
、上式の微分方程式の固有値を考慮して決定される。
の検出値d1、vlに収束する特性を決める定数であり
、上式の微分方程式の固有値を考慮して決定される。
ト述の最小次元オブザーバは第7図のプロ、り図で表わ
される。
される。
そこで、上記(1)及び(2)式を用いて第5図を変形
すれは、第8図のように表わすことができる。
すれは、第8図のように表わすことができる。
そして、第8図においてオブザーバ部分、即ち推定器l
は、第9図のように構成することができる。
は、第9図のように構成することができる。
図中、2.3.4.5は増幅器、R,−R日は抵抗、c
、、C2はコンデンサ、Uはトルク指令信号、■は速度
信号、Wlは機械負荷の送り系のトルク応力又は弾性変
位dの推定値d、w2は機械負荷の先端速度7文の推定
値7文である。
、、C2はコンデンサ、Uはトルク指令信号、■は速度
信号、Wlは機械負荷の送り系のトルク応力又は弾性変
位dの推定値d、w2は機械負荷の先端速度7文の推定
値7文である。
尚、ここでは、
の関係にある。
以I−は、アナログ回路による構成にしたか、マイクロ
プロセッサの演算機能を用いても当該速度制御方式か実
現できることは汀うまでもない。また、速度信りはサー
ボモータにロータリーエンコータを設け、該ロータリー
エンコーダからの位置情報に)1(ついて前記速度信号
を得るようにしても良い。
プロセッサの演算機能を用いても当該速度制御方式か実
現できることは汀うまでもない。また、速度信りはサー
ボモータにロータリーエンコータを設け、該ロータリー
エンコーダからの位置情報に)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 図
図、第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)機械負荷を駆動するサーボモータに取す付けられ
た速度検出器からの速度信号をフィード/\、りし、該
サーボモータへのトルク指令信号成するようにした速度
制御方式において、該速度信吟と該トルク指令信号とか
ら機械負荷の先端の速度および負荷送り系のトルク応力
または弾性変位を推定器によって推定し、該tft定仙
からのフィードバンク信号をトルク指令に加えるように
したことを特徴とする速度制御方式。 - (2)前記サーボモータにロータリーエンコーダを設け
、該ロータリーエンコータからの位置情報から、前記速
度信号を得るようにしたことを特徴とする特許請求の範
囲第(1)JJ”tに記載の速度制御方式。
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)
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2660183C1 (ru) * | 2017-09-14 | 2018-07-05 | федеральное государственное бюджетное образовательное учреждение высшего образования "Национальный исследовательский университет "МЭИ" (ФГБОУ ВО "НИУ "МЭИ") | Способ автоматического регулирования координат электропривода и устройство для его осуществления |
Citations (1)
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)
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 |
-
1984
- 1984-03-22 JP JP59055114A patent/JPS60200788A/ja active Pending
-
1985
- 1985-03-22 WO PCT/JP1985/000141 patent/WO1985004534A1/ja unknown
Patent Citations (1)
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)
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) | 操舵反力制御装置 |