JPS6165303A - デイジタルサ−ボ装置 - Google Patents

デイジタルサ−ボ装置

Info

Publication number
JPS6165303A
JPS6165303A JP59186784A JP18678484A JPS6165303A JP S6165303 A JPS6165303 A JP S6165303A JP 59186784 A JP59186784 A JP 59186784A JP 18678484 A JP18678484 A JP 18678484A JP S6165303 A JPS6165303 A JP S6165303A
Authority
JP
Japan
Prior art keywords
target value
controlled object
milliseconds
time
generates
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.)
Granted
Application number
JP59186784A
Other languages
English (en)
Other versions
JPH0792701B2 (ja
Inventor
Hidenori Sekiguchi
英紀 関口
Katsushi Nishimoto
西本 克史
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.)
Fujitsu Ltd
Original Assignee
Fujitsu 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 Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to JP59186784A priority Critical patent/JPH0792701B2/ja
Publication of JPS6165303A publication Critical patent/JPS6165303A/ja
Publication of JPH0792701B2 publication Critical patent/JPH0792701B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime 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/00Program-control systems
    • G05B19/02Program-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 program 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 program 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
    • G05B19/21Numerical 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 program 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 using an incremental digital measuring device
    • G05B19/23Numerical 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 program 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 using an incremental digital measuring device for point-to-point control

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

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

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、サンプリング制御を行なうディジタルサーボ
装置に関する。
〔従来の技術〕
数値制御(NC)工作機械およびロボットなどには、第
5図に示すようなディジタルサーボ装置が設けられる。
この図で10は目標値関数発生機構、12はサーボ機構
、14は制御対象、例えば負荷に連結された直流電動機
である。また、15はディジタルサーボ装置であって、
関数発生機構10とサーボ機構12とを備え、マイクロ
プロセッサ等より成る。目標値関数発生機構10はサー
ボ機構12が追従できるように変化する目標値rを出力
し、サーボ機構12は該目標値rと制御対象の制御量y
例えば位置、速度などを受けて、時間変化する該目標値
rに制御量yが追従するように操作Nuを出力する。例
えば現在位置roにある制御対象14を他の位置r1に
移動させたい場合、機構10が出力する目標値rをro
からrlにステップ状に変化させると目標値変化が急激
になり過ぎ、制御対象14は追従できないので、目標値
rは第6図の曲線C2のように現在位置r。
から目標位置r1へなだらかに変化させる。曲線C1は
制御対象を時間T1の間一定加速度で加速し、最大速度
に達したらその速度で時間T2の開動作さセ、然るのち
時間T3の間一定減速度で減速して停止さセる場合の時
間−距離曲線であり、この場合の時間−速度曲線は第6
図の曲線CIになる。目標値「をこのようになだらかに
変化させると制御対象はよく追従でき、そして上記−重
加、減速度をそれぞれ最大値に選ふと、位置決めを最も
(可及的に)速やかに行なうことができる。サーボ機構
12が出力する1築作量Uは目標値rと制御量(帰il
量)yにより決定され、比例制御なら両者の差に、積分
制御なら差の積分値であり、そして微分制御を加えるな
ら該差の微分値がプラスされる。
このような制御をアナログ式に行なう場合は目標値rは
當時(時間的に連続して)出力され、制御量yも常時帰
還され、操作量1λも常時出力される。しかしディジタ
ル式に行なう場合は一定時間間隔で目標値rの算出、制
御量yの取込み、操作Myの出力が行なわれ、連続時間
系から%lIl !&待時間になる。この一定時間間隔
(ナンプリング周期)をTとすると、r (tl、  
Y (tl、  u (tl等の量はr (kT) 、
 y (kT) 、 u (kT) 、こ\でに−0゜
1.2.・・・・・・1等と離散化される。なおこれら
の離散量は以後r (kl、  y fk)、  u 
fk)と記す。
〔発明が解決しようとする問題点〕
サンプリング制御理論によれば、これらの目標値r (
klの発生、制御量Y (klの観察、操作量u (k
lの発生は同一時刻でなければならない。しかしこの種
制御は一般にデジタル計算機を用いて行なわれ、これは
逐次処理型であるから同時発生は不可能で、まずr (
k)を発生し、次にy(ト))を観察し、これらの量か
らu (klを発生させることになる。
これらの発生、観察が逐次的にはなるが、該発生、観察
が一定周期、一定相互間遅れで行なわれるなら一定周期
、同時処理に近く、許容できるが、一定周期も維持でき
ないのでは問題である。計算機に上記処理を行なわせる
にはタイマ割込み処理等を利用するが、第3図に示すよ
うに割込み後に目標値r (klの発生、制御量y(k
lの観察、操作量U(k)の発生を行なうと、第4図に
示すように割込みは一定間隔で起きているのに、V (
klの観察、u (klの発生が一定間隔で起らない可
能性がある。この第4図で■は目標値r (klの発生
、■ばy(klの観察、■は操作量u (klの発生を
示し、各々のプロ・7りの長さは時間を示す。割込みは
3.0ミリ秒の一定時間間隔で起り、この割込みが受付
けられると先ず■、次に■、最後に■の処理が行なわれ
、各周期でこれが繰り返される。
図示のようにy(klの観察■及びu (klの発生■
の所要時間はは一゛一定であり、これに対して目標値r
 fk)の発生所要時間はかなり変動する。これば、r
 (klの発生要領は加速時、定速時、減速時、及びこ
れら相互間の過渡時で異なり、この結果演算所要時間が
変ることによる。図示の例ではケースA(例えば、定速
時)の場合■には0.5ミリ秒、■には0.1ミリ秒、
■には1.0ミリ秒、計1.6ミリ秒であるが、ケース
B(例えば、減速時)の場合は■には1.0ミリ秒、■
には0.1ミリ秒、■には1.0ミリ秒、計2.5ミリ
秒を要した。このように変るとケースA間では■、■、
■の各々について一定周期が確保できるが、ケースA、
B間では■については一定周期を維持できるものの、■
、■については一定周期にならない(3ミリ秒から3゜
5ミリ秒に変る)。本発明はか−る点を改善し、各処理
■、■、■について一定周期が維持できるようにしよう
とするものである。
〔問題点を解決するための手段および作用〕本発明は、
一定時間間隔で制御対象の目標値を発生する目標値関数
発生手段と、該目標値に制御対象の制御量が追従するよ
うに該制御対象に加える操作量を発生するサーボ機構を
備えたディジタルサーボ装置において、一定時間間隔で
該サーボ機構に、目標値関数発生機構が発生した目標値
及び検出した制御対象の制御量をもとに操作量を発生さ
せ、次いで目標値関数発生機構に次の時間間隔時の目標
値を計算させるようにしてなることを特徴とするもので
ある。
〔実施例〕
第1図に示すように本発明では割込め発生でこれが受付
けられたら先ず制御1 y (k)の観察を行ない、前
の周期で求めておいた目標値「(k)と上記観察したy
(klを用いてり′−ポ機構は操作量IJ (klを算
出し、これを制御対象へ加える。ごごで、制御■y(k
lの観察は、制御対象をモータとする場合、モータに取
付けられたロータリエンコーダにより行ない、検出され
た角度が制御量である。然るのち目標値関数発生機構が
、次の周期で使用する目標値r (kl1)を演算し、
この演算処理終了で割込み処理終了とし、引算機は他の
割込み又はジョブの処理に入る。なお第5図のサーボ機
構12は詳しくは操作量Uの演!機構であり、目標値関
数発生機構10と共に計重機のマイクロプログラムで構
成される。制御対象14はこ\では直流電動機とその負
荷を想定している。制御量yは該電動機の回転軸に取付
けられたパルス発生器などにより検出され、計算機のI
10ボートへ導かれる。
この本発明方式によれば前記発生、観察をそれぞれ一定
周期で行なうことができる。これを第2図で説明すると
、タイマ割込み周期はやはり3.0ミリ秒とし、目標値
r fklの発生■は0.5ミリ秒又は1.0ミリ秒、
yfklの観察■は0.1ミリ秒、操作量u (klの
発生■は1.0ミリ秒とすると、目標値r(klの発生
に0.5ミリ秒を要するケースA−,これに1.0ミリ
秒を要するケースBの場合は図示の如くなり、■、■、
■の処理周期はいずれも3ミリ秒である。処理■に長時
間を要する場合は、各処理サイクル間の遊び期間(計算
機が他の割込み又はジョブを処理している期間)が短く
なるだけである。
第2図と第4図を比べれば明らかなように、本発明では
その周期で使用すべき目標値算出を、1つ前の周期で行
なっている。このようにしても別に支障はない。即ち目
標値rは例えば第6図の曲線C2であり、到達位置など
により定めた速度曲線C1を時間積分(離散的であるか
ら、増分を足し又は引いたりして)して得られるもので
あるから、1サイクル前での計算も格別支障ない。
〔発明の効果〕
以上説明したように本発明によれば処理時間が変動する
目標値演算は前の処理サイクルの束部で済ませておくと
いう手法によって各処理をそれぞれ一定周期で実行でき
、正確なサンプリング制御を行なうことができる。
【図面の簡単な説明】
第1図は本発明の制御方式の説明図、第2図は第1図の
各処理の周期の説明図、第3図は従来の制御方式の説明
図、第4図は第3図の各処理の周期の説明図、第5図は
ディジタルサーボ装置の構成を示すブロック図、第6図
は目標値の説明図である。 図面で14は制御対象、10は目標値関数発生機構、1
2はサーボ機構、■は目標値発生、■は制御量の観察、
■は操作量発生を示す。

Claims (1)

  1. 【特許請求の範囲】 一定時間間隔で制御対象の目標値を発生する目標値関数
    発生機構と、該目標値に制御対象の制御量が追従するよ
    うに該制御対象に加える操作量を発生するサーボ機構を
    備えたディジタルサーボ装置において、 一定時間間隔で該サーボ機構に、目標値関数発生機構が
    発生した目標値及び検出した制御対象の制御量をもとに
    操作量を発生させ、次いで目標値関数発生機構に次の時
    間間隔時の目標値を計算させるようにしてなることを特
    徴とするディジタルサーボ装置。
JP59186784A 1984-09-06 1984-09-06 ディジタルサーボ装置の制御方法 Expired - Lifetime JPH0792701B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP59186784A JPH0792701B2 (ja) 1984-09-06 1984-09-06 ディジタルサーボ装置の制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP59186784A JPH0792701B2 (ja) 1984-09-06 1984-09-06 ディジタルサーボ装置の制御方法

Publications (2)

Publication Number Publication Date
JPS6165303A true JPS6165303A (ja) 1986-04-03
JPH0792701B2 JPH0792701B2 (ja) 1995-10-09

Family

ID=16194532

Family Applications (1)

Application Number Title Priority Date Filing Date
JP59186784A Expired - Lifetime JPH0792701B2 (ja) 1984-09-06 1984-09-06 ディジタルサーボ装置の制御方法

Country Status (1)

Country Link
JP (1) JPH0792701B2 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04135819U (ja) * 1991-06-12 1992-12-17 関東自動車工業株式会社 ラツゲージドアロツクシリンダの取付け構造
JP2016173708A (ja) * 2015-03-17 2016-09-29 アズビル株式会社 制御装置および制御方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS55121299U (ja) * 1979-02-20 1980-08-28
JPS5726991U (ja) * 1980-07-22 1982-02-12

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS55121299U (ja) * 1979-02-20 1980-08-28
JPS5726991U (ja) * 1980-07-22 1982-02-12

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04135819U (ja) * 1991-06-12 1992-12-17 関東自動車工業株式会社 ラツゲージドアロツクシリンダの取付け構造
JP2016173708A (ja) * 2015-03-17 2016-09-29 アズビル株式会社 制御装置および制御方法

Also Published As

Publication number Publication date
JPH0792701B2 (ja) 1995-10-09

Similar Documents

Publication Publication Date Title
EP0417312B1 (en) Feedforward control unit for servomotor
KR940003005B1 (ko) 동기형 교류 서보모터의 속도제어방법
EP0208788A1 (en) Speed control system for servo motors
JPH063994B2 (ja) 複数台デイジタルサーボの制御方法
JPH06245561A (ja) サーボモータの異常負荷検出制御方法
JP2875646B2 (ja) バックラッシ加速補正装置
EP0357778B1 (en) Method of speed control for servomotor
KR920002760B1 (ko) 속도제어장치
JP3545487B2 (ja) モータで駆動する機械系のイナーシャおよび摩擦トルクの推定方法
JPH06339292A (ja) 外乱負荷推定による力制御方法
EP0271590B1 (en) Robot control apparatus
JPS6165303A (ja) デイジタルサ−ボ装置
JPH06131050A (ja) サーボモータで駆動される可動部の衝突検出方法
JP2733881B2 (ja) Pi制御ループをベースにした適応スライディングモード制御方式
JPH04362710A (ja) サーボモータの最適加減速制御方式
US5034672A (en) Reference-point return method
EP0454853A1 (en) Feedback position control method
JPH0682346A (ja) イナーシャ、外乱トルクの推定及び異常負荷検出方法
JPS6337597B2 (ja)
JP2000099105A (ja) 負荷機械の制御方法
JPH01292405A (ja) ディジタル位置サーボ装置
EP0556412A1 (en) Method of controlling feed-forward of servo motor
KR960016799B1 (ko) 서보모터의 정밀위치제어방법 및 그 장치
JP2709766B2 (ja) サーボモータのフィードフォワード制御方式
JP2653130B2 (ja) 加減速制御装置