JPS59194207A - 数値制御におけるサ−ボ系の遅れ誤差補正方式 - Google Patents

数値制御におけるサ−ボ系の遅れ誤差補正方式

Info

Publication number
JPS59194207A
JPS59194207A JP6838883A JP6838883A JPS59194207A JP S59194207 A JPS59194207 A JP S59194207A JP 6838883 A JP6838883 A JP 6838883A JP 6838883 A JP6838883 A JP 6838883A JP S59194207 A JPS59194207 A JP S59194207A
Authority
JP
Japan
Prior art keywords
servo
movement command
delay
servo system
tape
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
JP6838883A
Other languages
English (en)
Inventor
Hideaki Kawamura
川村 英昭
Takao Sasaki
隆夫 佐々木
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 JP6838883A priority Critical patent/JPS59194207A/ja
Publication of JPS59194207A publication Critical patent/JPS59194207A/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
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41192Compensation for different response times, delay of axis
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/42Servomotor, servo controller kind till VSS
    • G05B2219/42155Model

Landscapes

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

Abstract

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

Description

【発明の詳細な説明】 利用分野と従来技術 本発明は、工作機械等の数値制御II@置において、該
数値側n装置のり一ボ系の理れを補正づるり−ポ系遅れ
誤差補正制御方式にl[lする。
第1図は、従来のX、Y2軸を例にとった#l1Wr制
m装置におけるサーボモータ制御ブロック線図である。
この図が示1ように、テープ1からの移動指令を指令プ
ログラム解読部2で解読し、送り速度制御部4で急激な
変化がないように加速、減速処理を行い、パルス分配器
3から各軸へ移動指令としで出力Pt 、Qiされる。
この出力を勺−ボ系5,6は入力し、サーボ系5.6で
はサーボモータ11.12で駆動される機械の位置検出
器14.16からの現在値と指令値Pt、Qtとの差を
サーボ位置制御部7.9に入力し、さらに、速度検出器
13.15からのイを号とによりサーボ速度制御部8.
10でサーボモータの位置及び速度制御を行い、サーボ
モータ11.12をパルス分配B3からの指令値Pt、
Qtまで移動させる。
このように、移動指令Pt 、Qtに対し、現右のサー
ボモータで駆動される機械の位置との差位によってサー
ボモータを駆動させるから、本質的にサーボモータで駆
動される機械は指令に対して遅れをもって駆動すること
になる。
そのため、カム加工、クランピング加工1円弧補間等に
おいて、サーボモータで駆動される工具等は指令した円
弧の軌跡を描かず、上記遅れのため、指令した円弧の内
側を通る軌跡を描き、形状誤差を発生するという欠点を
有している。
発明の目的 本発明は、上記サーボ系の遅れ誤差を補正して指令した
円弧にできるだけ合致した軌跡を描くようにして、上記
欠点を改善した数値制御におけるサーボ系の遅れ誤差補
正方式を提供することを目的としている。
発明の構成 前述したように、第1図において、パルス分配器3から
の移動指令Pi 、Qtに対し、サーボモータ11.1
2で駆動される機械の移動はある遅れをもって応答する
。そこで、上記遅れを考慮して移動指令を与えれば、み
かけ上、真の移動指令に対してサーボモータで駆動され
る機械は遅れのない応答をして移動することになる。今
、、この遅れをもった、機械をも含めたサーボ系の伝達
関数をG(S)とすると(X軸、Y軸それぞれのサーボ
系の伝達関数はほとんど同じで差はない。)、この伝達
関数G(S)の逆数、すなわち、1/G(S)なる伝達
関数H(S)をもった補正処理を上記移動指令に対して
施せば、上記移動指令からみてサーボ系の移動量を出力
とする伝達関数は、補正処理の伝達間、数H(S)−1
/G (S)とサーボ系の伝達関数G(S)がカスケー
ド結合した次式で示す値となるため、 H(S)・G (S)−1/G (S)・G(S)1 みかけ上、遅れのない加工を行うことができる。
第2図は、この補正処理を施した本発明の数値制御にお
けるサーボ系の遅れ誤差補正方式のブロック線図である
。20は補正移動指令作成部、テープ1からの移動指令
をパルス分配シュミレー8部21で各軸(X、Y2軸に
ついてのみ図示している。)にパルス分配し、次に上述
したサーボ系による遅れ誤差補正22.23を行う。こ
れは、サーボ系5.6の伝道関数を該化3IrIA数が
時間的変化のない線形の伝達関数G(S)であるものと
して、理論上及び実験上から近似して求める。そして、
その逆数、すなわち、1/G(S)−H(S)が伝達関
数となるような補正処理22゜23を行い、移動指令作
成部24でサーボ系の遅れ補正を施した補正テープ1′
を作成プる。該補正テープ1′を、従来の数値制御1装
置に入力すればよい。ずなわら、第1図と同じ処理を施
せば、移動指令に対し、みか(プよ、遅れのない処理を
行うことができる。なお、補正テープ1′を作成するこ
となく、移動指令作成部24の出力を直接指令プログラ
ム解読部へ入力づるようにしてもよい実施例 上記サーボ系5.6の伝道関数G(S)が第(1)式で
示す2次遅れの速度と加速度まで考慮した線形の伝f関
数で近似されたときの一実施例について述べる。
G (S)= (1/KA S’ +KC3+1 >・
・・・・・(1) この棚台、サーボ遅れ誤差補正!lm20.21の伝達
関数)−1(S)は、次の第(2)式で示プものとなる
H(S)−1/G (S) =Ka SQ+Kc S+1 −”・(2)そこで、上
記伝達関数H(S)のサーボ遅れ誤差補正をデジタル処
理して行うには、第2図に示すように パルス分配シュ
ミレー8部21がら一定周期T毎に出力される位置の指
令Nt  (以下、X軸成分についてのみ述べる。他軸
成分についても同様である。)に対して、サーボ遅れ誤
差補正された位置の指令Nt’ は、上記伝達関数)−
1(S)から、比例成分に一次の項すなわち速度成分に
定数KCを乗詐したものを加え、さらに、2次の項すな
わち加速度成分に定数に^を乗算したものを加えたもの
になる。その結束、パルス分配シュミレー8部21がら
の位置の指令Ntとサーボ遅れ誤差補正された位置指令
Nt’の関係は、次の第(3)式で示されるものとなる
Nt ’ −Nt +Kc ・<Nt −Nt−1)/
T十に^・((Ni −Ni−1)/T −(Nt −+ −Nt−2>/T)/T−Ni +K
c ・(Nt −Nt −+ )/T十に^・(N< 
−2Nt−++Nt −2)/T2・・・・・・(3) なお、K^、Kcは、上記第(1)式で求められた定数
、王はパルス分配シュミレー8部21が位置の指令Nt
を出す周期、Nt−1は、Ntより1周期前の位置の指
令で、N、−2は2周期前の位置の指令である。
そこで、上記第(3)式で示す処理をパルス分配シュミ
レー8部21からの位置の指令Niに施ゼば、みかけ上
、遅れのないサーボ制御が行え得る。この処理フローを
第3図に示す。パルス分配シュミレー8部21から位置
の指令Niが出力される周期Tmに、レジスタ×3にレ
ジスタ×2の記憶値を寵き込み、レジスタ×2にはレジ
スタ×1の値を、レジスタ×1には入力された位置の指
令Ntを記憶させる(ステップSt、S2゜Ss)。そ
の結果、レジスタ×1には現在の位置指令値Ntが記憶
され、レジスタx2には1周期前の位置指令値Ni−1
が、レジスタ×3には2周期前の位置指令値Nt−2が
記憶されたことになる。
そこで、第3図ステップS4で示す処理、すなわち、第
(3)式の計算を行い、得られた値N、Iを出力する。
この処理を一定周期Tmに繰返し行い出力する。そして
、この出りをサーボ系5(6)に入力してやれば、みか
1プ上の遡れはなくなる。
なお、上記実施例では、サーボ系の伝達関数を2次の伝
達関数で近似させたが、必要に応じて1次、3次、4次
・・・・・・・・・の伝311Il数に近似してもよい
発明の効果 本発明は、数値制御における移動指令をパルス分配し、
シュミレート部で各軸へパルス分配し、該分配パルスに
対してり−ボ系の遅れ誤区補正処理を施した移動指令を
作成するようにしたため、移動指令に対し、みか4プ上
サーボ系の遅れはなくなったため、カム加工、クランピ
ング加工9円弧補I!j熔に83 <プるシーボにれに
よる形状WltLを小さくすることができる。さらに、
本発明は、上記サーボ後れ誤11処坤を施した移動指令
を移動指令を移動指令補正テープとして打出すことがで
きるので、従来の数値制御&@に上記補正テープを入力
することによってサーボ系の遅れFIA差補正ができ、
従来の数値IIIJIII装葭に適用可能なサーボ系の
if tL l’i M補正方式を得ることができる。
【図面の簡単な説明】 第1図は、従来の数値制m+装置にお(プるサーボモー
タ制御ブロック線図、第2図は、本発明の数値1.II
 IIIにおけるサーボ系の遅れ誤差補正制御方式のブ
ロック線図、a′!3図は、リーボ遅れ誤を補正処理フ
ローである。 5.6・・・サーボ系、13.15・・・速度検出器、
14.16・・・位置検出器、21・・・補正移動指令
作成部。 特許出願人 ファナック 株式会社 (ばか1名)

Claims (2)

    【特許請求の範囲】
  1. (1)数値IIJ1111にa3ける移動指令に対し、
    パルス分配シコミレート部で各軸にパルス分配し、各軸
    への分配パルスに刺し、数輪制御ll装置におりるサー
    ボ系の伝達関数の逆数の伝達関数の補正処理を施し、サ
    ーボ系の遅れ誤差補正を行った移動指令を作成し、該補
    正移動指令により数値制御1111を作動させるように
    した数値制御におりるサーボ系の近れ誤差補正方式。
  2. (2)上記サーボ系の遅れ誤差補正を行った移動指令を
    テープに打出し、該補正テープを数値lll1IIl鼓
    麿に入力するようした特!’l簡求の範囲第1項記載の
    数値制御におけるサーボ系の遅れ誤差補正方式。
JP6838883A 1983-04-20 1983-04-20 数値制御におけるサ−ボ系の遅れ誤差補正方式 Pending JPS59194207A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP6838883A JPS59194207A (ja) 1983-04-20 1983-04-20 数値制御におけるサ−ボ系の遅れ誤差補正方式

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP6838883A JPS59194207A (ja) 1983-04-20 1983-04-20 数値制御におけるサ−ボ系の遅れ誤差補正方式

Publications (1)

Publication Number Publication Date
JPS59194207A true JPS59194207A (ja) 1984-11-05

Family

ID=13372279

Family Applications (1)

Application Number Title Priority Date Filing Date
JP6838883A Pending JPS59194207A (ja) 1983-04-20 1983-04-20 数値制御におけるサ−ボ系の遅れ誤差補正方式

Country Status (1)

Country Link
JP (1) JPS59194207A (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63233402A (ja) * 1987-03-20 1988-09-29 Mitsubishi Heavy Ind Ltd 軌跡デ−タ補正装置
US4873793A (en) * 1986-09-22 1989-10-17 Toyoda-Koki Kabushiki-Kaisha Numerically controlled machine tool
US4902951A (en) * 1987-08-25 1990-02-20 Toyoda-Koki Kabushiki-Kaisha Numerically controlled machine tool
JPH03105403A (ja) * 1989-09-19 1991-05-02 Nec Corp ドリル穴明け機
WO2015104736A1 (ja) * 2014-01-07 2015-07-16 三菱電機株式会社 軌跡制御装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54134272A (en) * 1978-04-11 1979-10-18 Toyoda Mach Works Ltd Tape checker
JPS54141968A (en) * 1978-04-26 1979-11-05 Toshiba Corp Numerical control device
JPS5615601U (ja) * 1979-07-14 1981-02-10
JPS5851308A (ja) * 1981-09-22 1983-03-26 Sankyo Seiki Mfg Co Ltd 工業用ロボツトのプログラム修正制御方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54134272A (en) * 1978-04-11 1979-10-18 Toyoda Mach Works Ltd Tape checker
JPS54141968A (en) * 1978-04-26 1979-11-05 Toshiba Corp Numerical control device
JPS5615601U (ja) * 1979-07-14 1981-02-10
JPS5851308A (ja) * 1981-09-22 1983-03-26 Sankyo Seiki Mfg Co Ltd 工業用ロボツトのプログラム修正制御方法

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4873793A (en) * 1986-09-22 1989-10-17 Toyoda-Koki Kabushiki-Kaisha Numerically controlled machine tool
JPS63233402A (ja) * 1987-03-20 1988-09-29 Mitsubishi Heavy Ind Ltd 軌跡デ−タ補正装置
US4902951A (en) * 1987-08-25 1990-02-20 Toyoda-Koki Kabushiki-Kaisha Numerically controlled machine tool
JPH03105403A (ja) * 1989-09-19 1991-05-02 Nec Corp ドリル穴明け機
WO2015104736A1 (ja) * 2014-01-07 2015-07-16 三菱電機株式会社 軌跡制御装置
JP5935958B2 (ja) * 2014-01-07 2016-06-15 三菱電機株式会社 軌跡制御装置
CN105900027A (zh) * 2014-01-07 2016-08-24 三菱电机株式会社 轨迹控制装置
CN105900027B (zh) * 2014-01-07 2018-09-21 三菱电机株式会社 轨迹控制装置
US10481580B2 (en) 2014-01-07 2019-11-19 Mitsubishi Electric Corporation Trajectory control device

Similar Documents

Publication Publication Date Title
US7274165B2 (en) Numerical controller
US5303333A (en) Method for controlling the acceleration and velocity of at least one controllable axis of a machine tool or robot
EP0553356A1 (en) Method and apparatus for prediction repetition control of servo motor
JP2004280772A (ja) サーボモータ駆動制御装置
JPS59194207A (ja) 数値制御におけるサ−ボ系の遅れ誤差補正方式
JPS63229506A (ja) 軸速度出力方式
JPS59194206A (ja) 数値制御におけるサ−ボ系の遅れ誤差補正制御方式
WO1990007737A1 (en) Brake control system for gravity shafts
US20080269915A1 (en) Numerical controller with function of decelerating reference variable in path table operation
US6999844B2 (en) Numerical controller
US5510996A (en) Method for determining auxiliary position-control parameters
US4521721A (en) Numerical control method
JP3628119B2 (ja) サーボモータの制御方法
EP1197821B1 (en) Acceleration/deceleration method
US4020331A (en) Feed rate control system for numerical control machine tool
JP3023648B2 (ja) 位置制御装置
JPH0580805A (ja) Pi制御ループをベースにした適応スライデイングモード制御方式
JPH03160510A (ja) フレキシブル・フィードバック方法
JPH01292405A (ja) ディジタル位置サーボ装置
JPH0421101A (ja) 学習コントローラの飽和処理方式
JPH02275508A (ja) フィードフォワード制御方式
JP2006113960A (ja) 位置指令作成方法およびこれを実行する位置制御装置
JPH02309402A (ja) サーボシステム
JPS59194212A (ja) 数値制御装置
JP2629758B2 (ja) 軌跡補正方法