JPS5890206A - 位置制御方式 - Google Patents

位置制御方式

Info

Publication number
JPS5890206A
JPS5890206A JP56188596A JP18859681A JPS5890206A JP S5890206 A JPS5890206 A JP S5890206A JP 56188596 A JP56188596 A JP 56188596A JP 18859681 A JP18859681 A JP 18859681A JP S5890206 A JPS5890206 A JP S5890206A
Authority
JP
Japan
Prior art keywords
error
circuit
control
stored
switching
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
JP56188596A
Other languages
English (en)
Other versions
JPH0142401B2 (ja
Inventor
Hitoshi Matsuura
仁 松浦
Etsuo Yamazaki
悦雄 山崎
Hiroshi Sakurai
寛 桜井
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
Fujitsu Fanuc 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 Fanuc Corp, Fujitsu Fanuc Ltd filed Critical Fanuc Corp
Priority to JP56188596A priority Critical patent/JPS5890206A/ja
Priority to US06/442,424 priority patent/US4485338A/en
Priority to DE8282306250T priority patent/DE3279702D1/de
Priority to EP82306250A priority patent/EP0080375B1/en
Publication of JPS5890206A publication Critical patent/JPS5890206A/ja
Publication of JPH0142401B2 publication Critical patent/JPH0142401B2/ja
Granted 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23QDETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
    • B23Q35/00Control systems or devices for copying directly from a pattern or a master model; Devices for use in copying manually
    • B23Q35/04Control systems or devices for copying directly from a pattern or a master model; Devices for use in copying manually using a feeler or the like travelling along the outline of the pattern, model or drawing; Feelers, patterns, or models therefor
    • B23Q35/08Means for transforming movement of the feeler or the like into feed movement of tool or work
    • B23Q35/12Means for transforming movement of the feeler or the like into feed movement of tool or work involving electrical means
    • B23Q35/121Means for transforming movement of the feeler or the like into feed movement of tool or work involving electrical means using mechanical sensing
    • B23Q35/123Means for transforming movement of the feeler or the like into feed movement of tool or work involving electrical means using mechanical sensing the feeler varying the impedance in a circuit
    • 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
    • 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 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 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 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 using an incremental digital measuring device for point-to-point control
    • G05B19/231Numerical 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 using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
    • G05B19/232Numerical 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 using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude with speed feedback only
    • 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/41409Update position feedback during speed control
    • 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/42118Breaking of control loop, closing open control loop
    • 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/50Machine tool, machine tool null till machine tool work handling
    • G05B2219/50167Adapting to copying

Landscapes

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

Abstract

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

Description

【発明の詳細な説明】 置で1つのサーボモータを駆動するンステムに適用して
好適な位置制御方式に関する。
異なった装置で1つのサーボモータを駆ML、所定の機
械加工を行なうシステムがある。たとえば、複雑な形状
部分であってプログラミングが煩雑となる部分は倣い装
置欝により倣い加工を行ない、簡単な形状部分は数値制
御装置により通常の数値制御加工を行なって所望形状を
有する工作物を得る/ステムは周知である。第1図はか
\る倣い制御部(灯と数値制御装置によね1台の一す−
−ボモークを駆W+するンステトの説、開園である。
図中、101は数値制御装置t(以後NC装置という)
、102け倣いili制御装制御(以後TC装置という
)、103は工作機械である。 同、NC装置とT(2
装置1イ、〔は1つの1イ一体に組み込んでもよく、あ
るいけ別設にてもよい。NC装fl’r101  にお
いて、101aけNC指令データが穿孔でれている紙テ
ープ、1011)は紙テープリーク、101Cは制御部
である。f1i11憫1名1(1n1cけ紙テープ10
1からテープリーク1011)をしてN(’データを読
取らせると共に、胱取りたN(−゛データをll+’〔
胱し、たとえばM 、S 、T m、 Tiヒ命令等で
あれば図示しない強電盤を介して機械側へ送出[〜、又
移動指令であればインクリメンタル値の演算をしてパル
ス分配器に出力すると共に、現在位1n、残移動量の更
新制御などを行なう。又、iI]l制御部1016けN
CC装置101サーボ系から切1.さハたとき後述する
ツメローアップ制御を行なりてテーブル、工具などの可
動部の現在位置を記憶する。101圧はパルス分内己器
であり、指令さねたインクリメンタル値に基いて公知の
パルス分配(A算を実行L7で指令速度に応じた周波数
の分配パルス(、t8令パルス)Ps を発生する。1
01eは誤差演算り己憶円Sであわ、たとえば可逆カウ
ンタによh構成され、パルス分配器101dから発生し
7た指令パルスPSの数と後述するフィードバックパル
スFr>の叔の差(誤差) Frrを記憶する。101
fけ誤差Er fアナログ電圧に変換するI)A変換器
である。一方、工作機械、駆@部106において、10
3aは切換回路であり適宜切換えて後段の速度制御回路
にN c−+装置101或いはTC装置102を接続す
る。、103bけ速1梵Ill 御回路、103eは叶
−ボモータ(モータという)、103 dはモータの回
転速度に応じた実速度電圧を発生するタコメータ、10
3 eけモータが所定量回転する毎に1個のフィードバ
ックパルスF″pを発生するパルスコーグ等の検出器、
103fはボールスクリュー、106gはテーブル、1
05hは工具、103ii:ワークである。
今、切換回路103aによりNC装置1〒101が工作
機械106に接続されたものとする。この状態において
制御部101cから移動指令(各輔インクリメンタル値
)が出力されるとパルス分配器101dけ該インクリメ
ンタル)に基いてパルス分配演算を実行して分配パルス
IJSを誤差演算記憶部101eに入力する。 これに
より誤差演算記憶部101eの内界は零でなくなるから
、1)A変換器101fから該内容に応じた′市川が出
力され、速度制御回路1031)にまりモータ103c
は駆動され、テーブル103gが移動する。モータj0
3cが所定−…回転すわばパルスコータ103eからフ
ィードバックパルスFpが発生し誤差演算記憶部101
eに人力づれ、該誤差演算記憶部には指令パルスJJs
の数とフィードバックパルス■(ゝpの数との差Erが
記憶されることになる。そして、以後収差Erが零とな
るようにザーホIli制御さね、テーブル103gは加
工送りされ目標位置に移動せしせられる。同、上記処理
と4行してパルス分配器101dから発生した指令パル
スPsは制御部101Cに入力され、現在位置及び残移
動量の更新などが行われる。そ[7て、残移動量が零に
々ると内部的にパルス分配完了信号が発生する。
TC装置102において、102aはモデル、102 
Jjモデル表面に接触するスタイラス、102Cはトレ
ーサヘッド、102dはスタイラス102bの偏位信号
に基いて倣い速度の各軸成分を出力するアナログ演算回
路、102eけモータ制御回路、102fはモータ、1
02gはタコメータ、102hはモータ102fが所定
量回転する毎に1個のパルスを発生するパルスコーグ等
の検出器、1021はボールスクリュー、102Jけテ
ーブル、102にはオアゲート、102mは誤差演舞記
憶部であり、可逆カウンタにより構成され、パルスコー
グ102hより発伍したパルス(指令パルス)  Pc
O数と、パルスコーグ106eより発生したフィードバ
ックパルスFpO数の差Er’ を記憶する。102n
は誤差1hl をアナログ電圧に変換するDA変換器、
102n’id゛合成回路、102pは後述するフォロ
ーア、ツブを行カうフォローアツプ回路である。
切換回路103aによl)’]’(’装置102と工作
機械側103間が接続ζねでいる状12県において、テ
ーブル102Jが送り軸(Y軸)方向に駆動されると、
スクイラス102bけモナル102aの形状に応じて偏
位(7、その鈴位イバ号がアナログ演算回路102dに
入力される。この結果、アナログ演算回路102dより
スタイラスの偏位lこ応じた倣い速度の各軸by分が出
力され、モー々 102 fiは更に駆wJツれ、又モ
ータ103Cも回転する0 モータ102 f 、10
3 cが所定−1!:11転すわばパルスコーダ102
 h 、103 eより指令バ/l/ 7. PC、フ
ィードバックパルスFr)がそれぞれ発生し2、誤差演
算記憶部102mに人力きれる0 倣い側と機械側が完
全に同期している場合には誤差演算記憶部102mの内
容に零であるが、同ル](なくなるとその内容は零でな
くなる。このため、1)A変換器102nから該内容に
応じた電圧が出力され、合成回路102n’で指令電圧
と合成され、これにより倣い側と機械側の同期が維持さ
れる。即ち、収差Er′が零となるようにサーボ制御さ
れ、テーブル103gはテーブル102Jに追従(、て
(同期して)移動せし2められる。同、上記処理と腹材
し7てパルスコーダ102hから発生した指令パルスl
)Cは、フォローアツプ回路102pに入力され、内蔵
の現在位置レジスタの内容を更新する。
ところで、TC装置102と工作機械103間が接続さ
れて倣い制御が行われているときであっても、NC装置
101は内部的に工作機械の現在位置を常時記憶してい
なければならない。又、NC装[101と工作機械10
3間が接続されて通常のNC制御が行われているときで
あっても同様に、TC装置102は内部的に工作機械の
現在位置を常時記憶していなければガらhい。
そこで、工作機械103から切離きれていても、内部的
に記憶する現在g首を工作機、械の現在位置に常時追従
させるためにフォローアツプという手法が提案されてい
る。以下にTC装置102と工作機械103間が接続さ
れ、NC装置101がサーボ系から切離されている場合
においてフォローアツプ制御の概略を説明する。
倣い制御によりモータ103Cが回転するとバルスコー
ダ105eからモータ103Cの所定回転毎に1個のフ
ィードバックパルス’t”pが発生する。
このフィードバックパルスFpが発生する毎に誤差演算
記憶部101eの内容は正回転の場合1づつ減算されて
更新される。従って、初期時誤差演算記憶部101eの
内容が零であるどすればm1個ノフィードバックパルス
1(pの発生によね該誤差演算記憶部の内容は−m1と
なる。この誤差演算記憶部IC1eの内容−m、け制御
部101Cに読取られ、 M+m、1M(′Mの初期n+ilt? )  ・−・
・・−(11の演算を施されると共に、符号を変えてパ
ルス分配器101dに入力される。 パルス分配器10
1dはmlが指令され\ば直ちにパルス分配演算を行な
い分配パルスPsを出力する。この分配パルスPsけ誤
差演算記憶部101eに入力され、該誤差演算記憶部1
01eの内容を正方向に1づつ更新する0一方、これと
1行(2て誤差演算記憶部101eにはモータ103C
が回転し7ている限りフィードバックパルスFpが依然
として入力きれており、その内容を負方向に1づつ更新
している。従って、誤差演算記憶部101eからその内
’ll−m1が読みとられた時刻を11 、 m1個の
分配パルスpsが発生する時刻をt2とし、時刻1.と
t2の間にフィードバックパルス)pがm2個発生する
ものとすれば、時刻t2において誤差演算記憶部101
eの内容は−m2どなる。
ところで、指令量(mt)に等しい数の分配パルスPs
が発生すると制御部101 cij内部的にパルス分配
完了信号I)KNが発生する。そして、このパルス分配
完了信号DENにより制御部101Cは誤差演算記憶部
101eの内容(−m2)を再び読取り、 M + m2→M  ・・・・・・・・・・・・・・・
・・・・・・・・・・・・・・・・・・・・・(1)’
の加算演算を行なうと共にff12 fパルス分配器1
01dに指令する。■1lli、この(1)′の演算に
よりMけ(m、+m2)とガっている。以後、パルス分
配完了信号D E Nが発生する1σに制御部101C
け誤差演算記憶部101eの内N  ml・=1.2.
5)を読取り、 M−1−mi  −+ M(=Σmi)   ・・・・
・・・・・・川・・・・・・・・ (1)“の加算演算
を行なうと共に、数イ1〆4mi をパルス分配器10
1(Iに入力する。以後、−に記動作を繰返えす〇 以上Vtとめると下表の如くなる。伺、時刻t1け最初
に誤差演算記憶部101eの内容を読込んだ時刻であり
、ti(i=2.3.・・・)はパルス分配完了信号が
発生した時刻、miは時刻t1−1 からtiO間に発
生したフィードバックパルスFpの数である。この表か
ら明らかなように時刻 tj +1迄に発生1〜たフィ
ードバックパルス)pの総数Mは −1 で表現でき、まさり、 <表中の各時刻における誤差演
算記憶部101eの総和と一致する。従って、制御部1
01C内の現在位置レジスタは常にフォローアツプの手
法により工作機械の現在位置を記憶することに々る。
同、以上はNC装置101が工作機械のサーボ系より切
離されている場合であるが、TC装fit1o2が切離
されている場合にはフォローアツプ制御回路1021)
が前述のフォローアツプ制御を行ない、内部の現在位置
レジスタは常時工作機械の現在位置を記憶することにな
る。
第2図は第1図の7ステムを簡略化した図であり、図中
第1図と同一部分には同一符号を付している。同、10
1 g、102qは共に位置制御回路であり、それぞれ
禰差演智紀憶部101c、102mと、DA変換H31
01f、j02nと、オフセット電圧補償回路101h
、102 rと、合成回路101i。
102Sにより構成されている。このように異なった制
御装置1101,102によhlつのモータを駆動する
システムにおいては、各々の制御装置101.102の
位置制御回路101 g、102qを適宜切換回路10
3aにより選択し、て速度制御回路103bに接続し、
ある時には倣い制御を行ない、又ある時には通常のNC
制御を行かって所望の工作物を得る。ところで、各々の
位置制御回路101g、102q及びその周辺部分の回
路(たとえば1)A変換器101f、102n )lこ
はオフ−1てット電圧が存在する◇このため、位(L制
御回路101gが速度制御回路103bに接続されてク
ローズトループを形成している場合、胆差演′N記憶部
101eの内容(誤差) Erが零になってもモータ1
03Cは停止せず、該誤差Frrが11にガってけじめ
停止する。
又、位置fttll all 回路102 qカ速度f
llJ (fill 回路103 bに接続きれてクロ
ーズトループを形成している場合にも、誤差記憶部10
2m の内容(誤差) Er ’が零になってもモータ
103Cけ停止せず、該誤差が12になってはじめて停
止する。このように、誤差(定常偏差) l+ + 1
2が異なる理由は位置制御回路及び周辺部分の回路に存
在する電圧のオフセット等が異なり、各々の閉ループの
ドリフト値が異なるためである。このため制御装置の切
換時に該ドリフト値の差分だけモータ103Cが回転す
ることになる。
又、切離された制御装置が前述のフォローアツプの手法
で内部的に現在位置を更新t7ている場合には、指令パ
ルスが印加されなくても切換え毎にモータ103cが1
.或いは12移動して誤差が蓄積し、又制御装置内部の
現在位置も(Il+12)づつ更新され、現在位置表示
が変化する。第5図はか\る切換時の動きを1軸方向に
ついて説明する説明図である。図中CP、はNC装置内
部の現在位置、MPl、 MP2は機械位置、CF2は
TC装置内部の現在位置、l、 、 12はそれぞれN
C装置及びTC装置の定常偏差である。伺、機械位置は
説明の便宜上MP、、MP2の2つの記号で示している
初期時(第3図(A))においてNC装置が工作機械の
サーボ系に接続でれて停止(、ているものとする。この
とき、NCC装置内部」実在位置CP1けaを示し、機
械位置MP、、MP、けaより定常偏差11だけづれた
位置(a+I+)に停止している。又、TCC装置内部
現在位1蒔(′、IJ2はツメローアップにより(a+
l+)を示している。そして、誤差演算記憶部101 
e 、102mの内’<J fd−それぞれ−11゜0
になっている。この状態で、NC装置を切離し、T(’
装置を工作波、械の1ノーボ糸lこ接続すれば、TC装
置の定常偏差は12であるから、切換により機械位t 
M P 2け第2図Q3)に示すように12移動して安
定j〜、(a−4−11−1−12)の位置で停止する
。一方、機械位置が12動いたこと(こよりパルスコー
タ゛103e 、!: h l。個のフィードパ・ソゲ
パルスFpカ発生し、誤差演算記憶部101e、102
m  の内容けそねぞれ−(1++I2)、  +2に
なる。 しかる後、NC装(a内部の現在位置CP+N
フォローアツプにより(a+l++I2)になると共に
、誤差演算記憶部101eの内容は零になる(第3図(
B))。
即ち、NC装置からTC装置に切換えたことζこより、
機械位置は+2動ごき、又NC装置内部の現在位置は(
II+12)変化する。
この状態で、指令パルスを与えることなく再びTC装置
からNC装置に切換えれば、NC装置の定常偏差は11
であるから該切換え番こより機械位置MP、は第6図(
C)に示すように11移動して安定し、(a+211+
 12 )の位置で停止する。一方、機械位置が11動
いたことによりバルスコーダ103eより1.個のフィ
ードパックパルスFpが発生し、誤差演算記憶部102
m 、101 eの内容は−(” ”2 ) +  1
1になる。[2かる後、TC装置内部の現在位t1tC
P2はフォローアツプにより(a+211 +12 )
にhると共に、誤差演算記憶部102mの内容は零にな
る(第5図L′))。
以後、切換が行われる毎に機械位fiMP、、Ml−’
2は11と12だけ交互に移動し、又切離された制御装
置内部の現在位置は(lI+12)つつ増加していく。
以上のように、従来の方法でd゛定常偏差(ドリフト)
が2つの制御装置で異なると切換時にモータが回転して
テーブル等町勤部が移動する。又、フォローアツプによ
り制御装置内部の現在位置を機械位置に追従させる場合
には指令パルスを入力しなくても切換毎に機械位1片が
移動し、て誤差が累積すると共に、現在位置表示が変化
する。
以上から、本発明は異かりた制御装置によね1つのサー
ボ”モータを駆朋lするシステムにおいて制御装置の切
換により誤差が累積することか力く、又制御装置内部の
現在位置が変化せず従って現在゛位!表示が変化するこ
とがない位置制御回路を提供することを目的とする。
以下、本発明の実施例を図面に従って詳細に説明する。
従来のシステムにおいてけドリフト値の相異により制御
回路の切換を行りとき切換回路103a(第1図、第2
図)の出力が変化し、このため切換時に機械が動き、切
換前の機械位1をが保証されなくなる。
ところで、一般に位置制御回路は第2図に示すようにオ
フセット電圧補償回路(101b、102r)を有【7
、合成回路出力が静止安定時にεv十〇FSv+OF”
Sc =C(一定)になるようにしている。但し、 εVはループがクローズド状態で安定しているときのエ
ラー量に対する電圧値、 0FSvけ位置制御回路及びその他局辺部のオフセット
電圧、 0FScはループがクローズドで安定しているときのオ
フセット補償電圧 である。同、第1、第2の制御装置ではオフセット電圧
0F8vの相違により、機械がクローズド状態で安定、
静止している時の6V、オフセット補償電圧0FScは
異なっている。
さて、制御装置の切換時に切換回路の出力値が変化しな
ければ機械は動くことはない。換言すれば、切換時にお
いて g’/l +0F8v、+OB’Sc、= εv2+0
FSv2+0FSc。
・・・・・・・・・(1) の条件を成立ζせてやれば機械ij[+<ことはがい0
同、(1)式中サフィックス1,2は第1、第2の制御
装置(NC装置、TC装咋)に対応していることを示す
従って、本発明はεVl、εv2に対1.一方のオフセ
ット補償重圧を補正することをこより(1)式を満足さ
せ、切換時における機械の動きを可能な限り小さくし、
且つ誤差が累積することを防止している。
第4図は、本発明の位置制御方式の説明図である0 初期状態(第4図(A))において、NC装置がサーボ
系に接続づれて停止しているものとする。同、NC装置
内部の現在位置(1ハは21を示し、機械は定常偏差1
1だけずれた(R+l+)に停止し、又TC装置内部の
現在位置CP2けツメローアツブにより(a+1+)を
示し、更にNC装置及びTC装置ノf[&t’kLjl
記憶部1 o 1 e 、 102 m (M: 2図
)の内容は−1,、’20になっているものとする。
上記状態において、NC装+*からT(’装置に切換え
る前に各誤差演嘗:ile憶部101e、1[]’2m
にそれぞれ記憶されている誤差−11(−=H)、−1
20を読取って記憶する。
ついで、NC装置101からTC装置102に切換える
。この切換えにより機械けT(゛装置の安定位置に向か
って移動して停止する(第4図()3) )。
この移動量f(+2 12(+ )とすれば、同、制御
中にドリフト値が変化しなければ12””120である
、・ζルスコーダ103eから(12120)  個の
フィードバックパルスFアが発生し、TC装置102の
誤差演算記憶部102mの内容は−12になる。
しかる後、前記記憶した120及び記憶部102mφ 内容12を用て−(12120)を演算し、該演算結果
を補正電圧に質換してTC装置102のオフセット補償
電圧0FSCに加算する。これによりa械は(1212
o)だけ逆方向に移動[2、(a+It)の位置で停止
し第4図(A)の状態に戻る。そ(7て、この時、誤差
演算記憶部101e、102mの内容も’1+  ’2
0となる。
以後、NC装置101は内部的に記憶する機械現在位置
を、誤差演算記憶部101eに記憶されている誤差Aか
ら前記記憶した誤差]3を差引いた値(A、 −H)に
基いてフォローアツプの手法でliすると共に、誤差演
算記憶部101eへ容から(A−H)を減じるように1
.ている。即ち、誤差演算記憶部101eの内容が常に
−11になるようにフォローアツプ制御が行われて内部
現在位置が更新される。この結果、′1゛C装置102
の制御によす2械が移#][7ても第4図(5)に示す
捜械位置と内部現在位1にの関係が維持される。
次に上記状態において、TC装置101からNC装置1
02へ切救った場合を考察する。
切換前、TC装[102は前記加q略れた補正電圧によ
り静止安定時(])式を満足している。この結果、切換
によね切換回路103aの出力電圧(速度制御回路10
3bの入力電圧)は変化しないから機械は動かない。同
、′FC装f102の誤差演算記憶部102mの内容は
+20になっている。以後、フォローアツプの手法でT
 Cンi[102は内部的に記憶する機械現在位置を、
誤差演算記憶部102mに記憶されている誤差A′から
前記+20(=B’)を差引いた値(A/  13/ 
)に基いて更新すると共に、誤差演算記憶部102mの
内容から(A’ −B’ )を減じるようにしている。
即ち、誤差演算記憶部102mの内容が常に一12oに
なるようにフォローアツプ制御が行わねて内部現在位置
が更新される0 以後、切換毎に同様な動作が行われる。
以上の如く、本発明によれば切換時に1回だけ機械を動
かして、互の安定点の相対関係がみつかればそれ以後の
切換で機械は動くことはない。
同、位置制御回路のドリフト値が制御中に変化した場合
には以下の手段を講じると良い0部の内容を切換直後の
値と常時比較し7、差が発生したとき、該差分に対応し
てオフセット補償電圧0FSCを変化或いは補正電圧を
合成回路に加え、常に定常偏差を一定に保つ。
又、ループが開いている装置の位置制御回路のドリフト
値の変化に対しては、ループを閉じた時に帰還するフィ
ードバックパルス−1f′Iによってトリ移動り、た後
、該帰還gに応じてオフセ、、 ト補償電圧OFS C
を制御I7て棲械をもとの位置に戻す。以上11 F 
I+フト値が変化する場合であるが、一般にドリフト値
げ一旦安宇【7た級は犬Nく変化することはないので、
殆んど無伊5でへる。
第5図はN(’装置及び′1゛C装置障における制御部
内のフォロー了・ツブ1lll 11回路ブロック図で
ある。
同、第1図、第2図と同一部分にd同一符号を付してい
る。
201けNC装置i 101から1゛(゛装置へ切換ら
れるとき切換直前の誤差演算記憶部101eの内容−1
,(=H)を記憶する定常側)1.tレジスタ、202
は現在位置APを記憶する現在()γ飯しジスタ、20
3はフォローアツプ演算回路であり、定常偏差レジスタ
201の内9p 13と、耕在位置レジスタ202に記
憶ざわている旧用在(rZ歓APと、誤差演算記憶部1
01の内容Aを入力され次式%式%(21 の演算を行なって現在位置を更新する。 204け−(
A −B )−1)             (3)
の演算を行ない、演算結果りをパルス分配器101dに
入力する演算回路である。
さて、NC装置101からTC装置102に切換わると
レジスタ201には誤差レジスタ107bの内容、即ち
定常偏差Bがプリセットされる。
ついで、フォローアツプ演算回路203は(2)式の演
算を行ない、演算回路204は(3)式の演算を行なう
。]゛C装置102の制御により機械が号だ移動してい
ない場合ににA = H(D = o )であるから、
現在位置APは更新されず、又パルス分配器101dも
分配パルスPsを発生せず誤差レジスタ107bの内容
けBに等しくなっている。
一方、T(’装イ錐の制御により機械が移動しm。
個のフィードバックパルスFpが発生すれば誤差演算記
憶部101eの内容Aは−(B+mt)になる。この結
果、(2)、(3)式の演算により、現在位置レジスタ
202の内容は(AP + m+ )に更新され、又パ
ルス分配器103ににt  (A  ’H) (−m、
 )  が指令される。パルス分配器103けmlが指
令づれhは前ちにパルス分配演算を開始]、7分配パル
スPsを出力する。この分配パルスPSけ誤差演算記憶
部101eに入力これ、その内容を正方向に1づつ更新
する。そして、m1個の分配パルスが発生した時点でパ
ルス分配完了信号が出てパルス分配演算は停止12、こ
のとき誤差演算記憶部101eの内容は−Bとなってい
る。同、′]゛C装置102の制御で継続して轡械が移
動する場合には上記m、によるパルス分配器qと1行し
て誤差演算記憶部101eにフィードバックパルスII
′pが入力づれ、その内容を負方向に1づつ更新する。
従って誤差演算記憶i1[]1eからその内容=(H+
m+)が読みとられた時刻をt、、m、個の分配パルス
Psが発生する時刻をt2とし、時刻t、と12の間に
m2個のフィードバックパフ1.スFyが発生するもの
とすれば、時刻12において腸差演瀞記憶部101eの
内容は−(B十m2)となる。そして、パルス分配完了
信号が発生したとき再び(2) 、 (31式の演算を
行なえば現在位置レジスタ202の内容け(Al’+m
、 +m2)に更新され、パルス分配器101dにはm
2が指令される。以後同様な制御によりAP+Σmi に正しく更新され、誤差演算記憶部101 eの内容は
−Bとなる。従って、以後NC装置の位置制御ループを
オーブン状態からクローズド状態にしても既に誤差演算
記憶部101eには定常偏差−Bが記憶されているから
機械は動くことがない。
一方、11C装置102のフォローアツプ制御回路にお
いて、301は定常偏差レジスタであり、NC装置10
1からTC装置102へ切換えられるとき切換直前の誤
差演算記憶部102mの内容−t2゜(=B’)を記憶
する定常偏差レジスタ、302け機械現在位置APを記
憶する現在位置レジスタ、303け第1演算回路、30
4はI)A変換器である。
NC装置101からT0装置102へ切換った直後第4
図において説明し7たように機械ViTC装置102に
より形成された閉ループのドリフトにより安定位置に向
かって(’2 1211)移動する0 こノ結果、(l
ニー120)のフィードバックパル、z J’i” ?
’が発生し誤差演算記憶部102mの内容は−12にな
る。しかる後、第1演詩−回路303は(’2 Lo) を演算17、DA変換器304117i′この演算結果
をDA変換して合成回路1025に入力する。 DA変
換器304の1)人出力が合成回路1025に入力され
れば機械は(l)lzo)だけ前H己移動方向と逆方向
に移動し、誤差演算記憶部102 mの内容は□120
になる。
305はフォローアツプ演算回路、306は第2演算回
路、307はパルス分配器であり、それぞれ203.2
04i01 dと同等の機能を有し、フォロアツブ演算
制御を行なう0 さて、NCC装置101らTC装置yg 102に切換
える時、切換直前の誤差演算記憶部102mの内容12
11け定常偏差レジスタ301に記憶される。
しかる後、切換が行われると機械は前述のように(’2
 120)だけ移動するが、DA変換器304より機械
を切換直前の位置に戻すように電圧が発生するから、機
械は切換直前の位置に復帰する〇か\る動作完了後に、
TC装置102の制御で機械は移動するが、現在位置レ
ジスタ302け指令パルスPcを移動方向に可逆計数1
常に機械位置を記憶することになる。伺、NC装置の制
御により機械が移動しているときijフォローアツプ演
算回路305、第2演算回路306、パルス分配器30
7によりNC装置において説明[〜だと同様なフォロー
アツプ演算制御が行わhて現在位置レジスタ302の内
容が更新され、且つ誤差演算記憶部102mの内容が−
120に維持される。
以上、本発明によれば異なった制御装置により1つのサ
ーボモータを駆動するシステムにおいて、各々の制御装
置を接続したことにより形成される閉ループのドリフト
値が異なっていても、制御装置の切換により機械が動い
て誤差が累積することはない。又、切換により制御装置
内部の現在位置は変化することがなく、従って現在位置
表示も勤かず、正確な位1陰制御を行なうことができる
4図面のvlIiな曲、明 第1図は倣い制御装置と数値制御装僧により1台のサー
ボモータを駆動するシステムのブロック図、第2図は同
要部説明図、第3図は従来方式の説明図、fバ4図は本
発明に係る位i対制御゛方式説明図、第5図d本発明を
’4B現する回路のブロック図である。
101・・・NC装置位、102・・・TO装置、10
3・・・工作機械、101d・・・バルース分配益、1
01e・・・誤差演算記憶部、101f・・・Dへ7σ
換器、101h・・・オフセット電圧補償回路、 102m・・・誤差演算記憶部、102n・・・DA変
換器、102■・・・オフセ=、 ト電比補償回路10
5a・・・切換回路、103C・・・モータ201.3
01・・・定常偏差レジスタ、202,502・・・現
在位置レジスタ、20i305・・・フォローアツプ演
算回路、204j03,606・・・演算回路、304
・・・IJA変換器

Claims (1)

    【特許請求の範囲】
  1. 少なくとも指令パルスを発生する手段と、指令パルス数
    とモータが所定量回転する毎に発生するフィードバック
    パルス数の誤差を記憶する誤差記憶手段とを肩する第1
    及び第2の制御装置、前記各記憶手段に記憶されている
    誤差に基いてモータを駆動制御する速度制御回路、前記
    第1、第2の制御装置を速度制御回路に切換接続する切
    換回路を備なえ、該切換回路により速度制御回路から切
    離された制御装置が内部的に記憶する可拗部の現在位置
    を該制御装置の誤差記憶手段が記憶する誤差に基いてフ
    ォローアツプの手法で順次更新すると共に、更新の都度
    該誤差記憶手段の記憶内容から前記誤差だけ減じるよう
    にした位置制御方式において、第1の制御装置から第2
    制御装置への切換えに際し、切換直前における第1、第
    2制御装置の各誤差記憶手段に記憶されている誤差−1
    1゜120をそれぞれ記憶するステ・ツブ、切換により
    機械が安定にしたときの前記第2制御装償の誤差記憶手
    段に記憶されている誤差を−12を読取るステップ、前
    記誤差−’20+  12を用いて−”2120)を演
    算するステップ、該演算結果を電圧に変換して第2制御
    装置のオフセット電圧を補正するステップ、該オフセッ
    ト電圧の補正により機械を切換直前の位置に戻すステッ
    プ、以後第1制御装置が内部的に記憶する可@部の現在
    位置を、第1制御装置の記憶手段の内容から前記記憶し
    また誤差−11を差引いた値に基いてフォローアツプの
    手法で更新するステップを有することを特徴とする位置
    制御方式。
JP56188596A 1981-11-25 1981-11-25 位置制御方式 Granted JPS5890206A (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP56188596A JPS5890206A (ja) 1981-11-25 1981-11-25 位置制御方式
US06/442,424 US4485338A (en) 1981-11-25 1982-11-17 Method and apparatus for sensing current position in position control system
DE8282306250T DE3279702D1 (en) 1981-11-25 1982-11-24 Method and apparatus for sensing current position in position control system
EP82306250A EP0080375B1 (en) 1981-11-25 1982-11-24 Method and apparatus for sensing current position in position control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP56188596A JPS5890206A (ja) 1981-11-25 1981-11-25 位置制御方式

Publications (2)

Publication Number Publication Date
JPS5890206A true JPS5890206A (ja) 1983-05-28
JPH0142401B2 JPH0142401B2 (ja) 1989-09-12

Family

ID=16226419

Family Applications (1)

Application Number Title Priority Date Filing Date
JP56188596A Granted JPS5890206A (ja) 1981-11-25 1981-11-25 位置制御方式

Country Status (4)

Country Link
US (1) US4485338A (ja)
EP (1) EP0080375B1 (ja)
JP (1) JPS5890206A (ja)
DE (1) DE3279702D1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59222088A (ja) * 1983-05-31 1984-12-13 Anritsu Corp モ−タの回転角度制御回路
JPS63157211A (ja) * 1986-12-22 1988-06-30 Fuji Electric Co Ltd 位置決め装置
US8317000B2 (en) 2008-06-04 2012-11-27 Mec Co., Ltd. Wheel stop made of metal pipe and capable of transmitting power to electric car while being parked

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58207107A (ja) * 1982-05-28 1983-12-02 Fanuc Ltd サンプリング制御方式
US4608651A (en) * 1982-10-28 1986-08-26 Kabushiki Kaisha Kobe Seiko Sho Control system for direct teaching/playback type robots
JPS59224240A (ja) * 1983-05-31 1984-12-17 Fanuc Ltd ならい制御装置
JPS6018237A (ja) * 1983-07-08 1985-01-30 Komatsu Ltd トランスファプレスの制御装置
DE3339924A1 (de) * 1983-11-04 1985-05-15 Robert Bosch Gmbh, 7000 Stuttgart Verpackungsmaschine
JPS60172442A (ja) * 1984-02-20 1985-09-05 Fanuc Ltd ならい加工およびνc加工による機械加工装置
DE3410685A1 (de) * 1984-03-23 1985-10-03 Robert Bosch Gmbh, 7000 Stuttgart Formatumstellbare verpackungsmaschine
US4973215A (en) * 1986-02-18 1990-11-27 Robotics Research Corporation Industrial robot with servo
JPS6330226A (ja) * 1986-07-24 1988-02-08 Fanuc Ltd 保圧から計量への切換制御方法
JPS6330227A (ja) * 1986-07-24 1988-02-08 Fanuc Ltd 計量終了時におけるスクリュ−停止制御方式
US4845416A (en) * 1987-02-13 1989-07-04 Caterpillar Inc. Electronic valve actuator
DE4037762A1 (de) * 1989-12-20 1991-07-04 Messerschmitt Boelkow Blohm Verfahren zur korrektur des phasenganges geregelter stellantriebe
US5115180A (en) * 1990-03-22 1992-05-19 Microtek International Inc. Automatic drift compensation method and device for position-loop controller
JPH11305839A (ja) * 1998-04-21 1999-11-05 Fanuc Ltd 複数のサーボモータの制御方法
JP3487216B2 (ja) * 1999-05-11 2004-01-13 トヨタ自動車株式会社 電磁駆動弁
DE10131800A1 (de) 2001-06-30 2003-01-16 Bosch Gmbh Robert Verfahren zum Betrieb eines Navigationssystems für ein Fahrzeug, insbesondere ein Kraftfahrzeug und Navigationssystem
JP4083767B2 (ja) * 2005-12-22 2008-04-30 ファナック株式会社 サーボモータを制御する数値制御装置
TWI507067B (zh) * 2012-04-23 2015-11-01 Accton Technology Corp 可攜式電子裝置及其所處狀態之偵測方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS51149480A (en) * 1975-06-16 1976-12-22 Nasuko Kk Servo device for n umerical control
US4074177A (en) * 1975-07-17 1978-02-14 Giddings & Lewis, Inc. Methods and apparatus for automatic movement of a member to precisely indexed positions despite signal drift or offset
DE2818270C2 (de) * 1978-04-26 1984-08-02 Eckardt Ag, 7000 Stuttgart Verfahren und Regelschaltung zum stoßfreien Wiederanfahren eines Regelkreises
US4234832A (en) * 1979-07-02 1980-11-18 Aluminum Company Of America On-line switching between two control parameters

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59222088A (ja) * 1983-05-31 1984-12-13 Anritsu Corp モ−タの回転角度制御回路
JPS63157211A (ja) * 1986-12-22 1988-06-30 Fuji Electric Co Ltd 位置決め装置
US8317000B2 (en) 2008-06-04 2012-11-27 Mec Co., Ltd. Wheel stop made of metal pipe and capable of transmitting power to electric car while being parked

Also Published As

Publication number Publication date
US4485338A (en) 1984-11-27
EP0080375B1 (en) 1989-05-17
DE3279702D1 (en) 1989-06-22
EP0080375A3 (en) 1985-05-22
EP0080375A2 (en) 1983-06-01
JPH0142401B2 (ja) 1989-09-12

Similar Documents

Publication Publication Date Title
JPS5890206A (ja) 位置制御方式
JPH0147804B2 (ja)
CN100428096C (zh) 数字控制器
JPH02230303A (ja) 位置決め誤差補償方法および装置
CN102243486A (zh) 多轴加工机用数值控制装置
JPH0772911A (ja) 工作機械の制御装置および制御方法
CN114859701B (zh) 一种风洞大攻角装置和控制系统
JPH0123269B2 (ja)
JP3301494B2 (ja) 数値制御工作機械の操作方法及びその方法を実施する工作機械
JPS6346843B2 (ja)
JP5426454B2 (ja) タッピング加工動作を行うタッピング加工装置
Zhao et al. Weighted sum of vector norms based contouring control method for five-axis CNC machine tools
JPS62247405A (ja) 指令位置復元方法
JPS58140813A (ja) 位置制御方式
JP6391489B2 (ja) モータ制御装置
TW591880B (en) Synchronous control system of two parallel linear servo motors
JPS5953561B2 (ja) 誤差補正方式
JPS5839613B2 (ja) スウチセイギヨホブバンニオケル テ−ブルカイテンジクノ セイギヨホウシキ
JPS58149512A (ja) 数値制御方式
JPS58114840A (ja) 工作機械におけるピッチ誤差補正方法
JPS61260304A (ja) 数値制御装置
JPS60124706A (ja) プレ−バツクロボツト
JPH0233163B2 (ja)
JPS63237104A (ja) 熱変位補正数値制御工作機械
SU842383A1 (ru) Способ измерени сложных деталей