JPS59209741A - 任意方向倣い制御方式 - Google Patents

任意方向倣い制御方式

Info

Publication number
JPS59209741A
JPS59209741A JP8643083A JP8643083A JPS59209741A JP S59209741 A JPS59209741 A JP S59209741A JP 8643083 A JP8643083 A JP 8643083A JP 8643083 A JP8643083 A JP 8643083A JP S59209741 A JPS59209741 A JP S59209741A
Authority
JP
Japan
Prior art keywords
axis
displacement
circuit
calculated
signal
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
JP8643083A
Other languages
English (en)
Other versions
JPH04777B2 (ja
Inventor
Hitoshi Matsuura
仁 松浦
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 JP8643083A priority Critical patent/JPS59209741A/ja
Publication of JPS59209741A publication Critical patent/JPS59209741A/ja
Publication of JPH04777B2 publication Critical patent/JPH04777B2/ja
Granted legal-status Critical Current

Links

Classifications

    • 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/14Means for transforming movement of the feeler or the like into feed movement of tool or work involving electrical means controlling one or more electromotors

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Machine Tool Copy Controls (AREA)
  • Numerical Control (AREA)

Abstract

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

Description

【発明の詳細な説明】 発明の技術分野 本発明は任意方向倣い制御方式の改良に関し、更に詳細
には倣い送少方向を精度良く制御することができる任意
方向倣い制御方式に門するものでろる。
従来技術と問題点 X、Y平面内の倣い送少方向を第1図に示すように、A
軸に対してαの角度の方向(A軸)とする任意方向倣い
に於いては、トレーサヘッドからの変位信号に基づいて
、A軸とA軸の送9速度’G’(1+Vz k演算し、
VaからVX−Vcl Hc−os α+ Vy =I
l、1・8$ηαの演算を行なってA軸、Y軸方向の過
多速度    □vX、 vY’6求め、X、 Y、 
Jl軸のモーフを送p速W Vx rv7. y7.に
対応した速度で駆動させるXうにしている。
このような、任意方向倣いに於いては、例えは送多系に
ドリフトが発生すると、設定された角度αの方向に対し
て誤差をもって倣い送りが行なわれることになる。
発明の目的 不発ツJ汀前述の如き欠点全改谷したものであり、その
目的は設定された方向に倣い過少が精度良く行なわれる
ようにすることにある。以下実施例について詳細に説明
する。
発明の実施例 第2図は本発明の実施例のブロック線図で6J、1はト
レーサヘッド、2はスタイラス、6は変位合成回路、4
.11.17は加算器、5.6は速度成分演算回路、7
は分配回路、8,9は座標変換回路、10は変位方向割
出回路、12X〜12には駆動回路、13、Y〜13Z
はモータ、14X、 14Yは位置検出器、15X、 
15Yはカラ/り、16は演算回路、18は乗算器、1
9はDA変換器である。
以下に、X軸と成す角がαである第6図に示すA軸全設
定倣い送p軸とし、原点Oから倣いを開始した場合の動
作を説明する。
倣い加工を開始すると、トレーサヘッド1からスタイラ
ス2の変位に対応した変位信号εX、εY。
ε2が出力され、変位信号εX、εYは変位合成回路。
6及び座標変換回路9に加えられ、変位信号ε2は変位
合成回路6及び変位方向割出回路10に加えられる。変
位合成回路6は変位信号εX、εY、ε2から合成変位
18号ε−ゾ4 + 58−1−4−を求めて加算器4
に加え、加算器4は合成変位信号εと基準変位信°号ε
。との差Δεを求めて速度成分演算回路5,6にカ11
える。速度成分演算回路5,6はそれぞれ前記差Δεに
基づいて法線方向速度(i号VN及び接線方向速度VT
を求め、分配回路7に加える。
また、座標変換器9は変位信号εX、εYと、倣い送Q
軸(A軸)とX軸との成す角の余弦、正弦を示す信号c
ogα、8hαとに基づいて、次式0)に示す演算を行
ない、A軸方向の変位成分を示す変位成分信号εaを作
成し、変位方向割出回路1oに加える。
εα2εX’60sc1+εy 1sin a  −−
−−−−−(1)また、変位方向割出回路1oは座標変
換回路9がらの変位成分信号ε。と変位信号ε2とに基
づいて、変位方向の余弦信号cosβと正弦信号8hβ
とを求め、分配回路7に加える。分配回路7は余弦信号
co8β、正弦信号8hβ及び速度成分回路5,6がら
の法線方向速度信号VN、接線方向速度信号VTに  
  基づいてA軸方向の速度信号Va及びz si+方
向の速度信号T’z ft作成する。そして、Z@力方
向速度信号Vzは駆動回路12Kに加えられ、その出力
によジモーク1ろZが駆動される。ま7と、A軸方向の
ノ?11度信号VAは座標変換回路8に加えられ、座標
変体た回路8は次式(21、(3)に示す猷算金行なっ
てX軸及び)′軸方向の速度信号T’X r I’yを
作成する。
VX=Va・cosα  ・・・・・・・・・・・・・
・・・(2)I’y = VB−s信α  ・・・・・
・・・・・・・・・・・・・(3)そして、X軸方向の
速度信号Vxは駆動回路12Xに加えられ、その出力に
Jニジモータ1ろXが駆動される。また、Y軸方向の速
度信号VYは加算器11を介して駆動回路12Yに加え
られ、その出力によりモータ15 Yが駆!fi!Iで
れる。
カウンタ15.¥、 151’はそれぞれX、Y軸の位
置検−出器i+x、147からの検出ノくルスをカウ、
ントし、>〆時間ΔT40にその時のカウント値を一定
時間Δ7゛出力し続けるものである。ここで、加工開始
時に於けるカウンタ15.Y、 15Yのカウント値は
共に苓に設定されているもので必シ、位置検出器14X
、 14Yはモータ13X、13Yが一定角度回転する
旬に検出パルスを出力するものであるから、一定時間Δ
T毎に出力されるカウンタ15X、 15Y、のカウン
ト値は一定時間ΔT毎の加工開始点(原点0)からのX
、Y@方向の移動距離LχN + LYN (Nは整数
)に対応することになる。演算回路16はX軸方向の移
動距離LXNと角度αの正接tαnαとの乗算を行なっ
て演算結果LXN ’ tαルαを加算器17に加え、
加算器17は次式(4)に示す演算を行なってY軸方向
の移動距離LYNと演算回路16の演算結果LXN・t
anαとの差SN’(Nは1f数〕を求めるものである
ISN = LYN  ZIIXN 1tafLα ′
°°゛°曲°゛°°°聞°°゛°°(4)乗算器18は
前記差SNと補正ゲインとの乗算を行ない、乗算結果′
fr:DA変換器19を介して加算器11に加え、Y軸
方向の速度信号vYを補正するものである。
従って、例えばオフセソ)”’W圧等の影響にょシ、倣
い過多が第3図に示す経路OB、に沿って行なわれたと
すると、加工を開始してから時間Δτ後にカウンタ15
I 15Fはそれぞれ加工開始点0がらのX、Y軸方向
の移動路1’t LXj + Z’YIに対応したカラ
ント値を出力し、加算器17は次式(5)に示す演算を
行ない、Y軸方向の移動距離LY+と演算回路16の演
箕結呆Lxビtαnαとの差S、を求める。
S+ ”” LYI°Lx+ etana  −=°−
−゛−(5)ここで前記差S1は第6図から判るように
、A軸と経路OB+とのずれに対応したものでるシ、乗
算器18で眼差S1と補正ゲインとを乗算し、乗算結果
をDA変換器19を介して加算器11に加え、Y軸方向
の速度侶号VYを補正するものであるから、これ以後は
経路E、 B2に沿って倣い、送少が行なわれる。そし
て、更に時間ΔTが経過すると、前述したと同様の処理
が行なわれ、経路B2B5に沿って倣い送pが行なわれ
る。以下、一定時間ΔT毎に前述したと同様の処理が行
なわれ、Y軸方向の速度信号vYの補正が行なわれるも
のであるから、実際の倣い送り方向と設定倣い過多方向
(A軸)との誤差を少ないものとし、設定された方向に
倣い送りを精度良く行なうことができる。
発明の効果 以上説す」したように、不発0!lJはX軸の位置検出
器の検出結果と、A軸と設定倣い過少軸との成す角の正
接との乗算を行なう演算回路、該演算回路の演算結果と
yiの位置検出器の検出結果との差を求める加算器を備
え、加算器の加賀、結果に基づいてY軸方向の送り速度
全補正するものでるるから1、精就良く設定倣い送少方
向に過少を行なうととができる利点がある。
【図面の簡単な説明】
第1図は任意方向倣い送少の説明図、第2図は本発明の
実施例のブロック線図、第6図は第2図の動作説明図で
ある。 1はトレーザヘノド、2はスタイシス、3(俵変位合成
回路、4.IL17は加算器、5,6は速度成分演算回
路、7は分配回路、8.9は座標変換回路、10は変位
方向割出回路、12X〜12には駆動回路、13X〜1
3Zはモータ、14X、 14)’は位置検出器。

Claims (1)

    【特許請求の範囲】
  1. モデル表面を追跡するトレーサヘッドからの変位信号に
    よシ、変位の大きさと方向とを演算し、変位の大きさが
    一定となるよりに送少速度を演算して設定倣い送り方向
    に倣い送9を行なう任意方向倣い制御方式に於いて、X
    、Y軸それぞれの位置検出器、前記A軸の位置検出器の
    検出結果とX$lIiと設定倣い送少方向との成す角の
    正接との釆算を行1gう演算回路、及び該演算回路の演
    算舶来とfill記Y軸の位置検出器の検出結果との差
    を求める刀1]算器を備え、該加算器の加算結果に基づ
    いてY;111i力向の送少速度を補正することを特徴
    とする任意方向倣い制御方式。
JP8643083A 1983-05-16 1983-05-16 任意方向倣い制御方式 Granted JPS59209741A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP8643083A JPS59209741A (ja) 1983-05-16 1983-05-16 任意方向倣い制御方式

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP8643083A JPS59209741A (ja) 1983-05-16 1983-05-16 任意方向倣い制御方式

Publications (2)

Publication Number Publication Date
JPS59209741A true JPS59209741A (ja) 1984-11-28
JPH04777B2 JPH04777B2 (ja) 1992-01-08

Family

ID=13886684

Family Applications (1)

Application Number Title Priority Date Filing Date
JP8643083A Granted JPS59209741A (ja) 1983-05-16 1983-05-16 任意方向倣い制御方式

Country Status (1)

Country Link
JP (1) JPS59209741A (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63109960A (ja) * 1986-10-27 1988-05-14 Okuma Mach Works Ltd 倣い制御における任意角度倣い方法
JPH02181205A (ja) * 1989-01-06 1990-07-16 Fanuc Ltd 3次元曲線生成方式
JPH0421104A (ja) * 1990-05-16 1992-01-24 Mitsubishi Electric Corp 複数軸駆動装置

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS578056A (en) * 1980-06-18 1982-01-16 Fanuc Ltd Profiling control method

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS578056A (en) * 1980-06-18 1982-01-16 Fanuc Ltd Profiling control method

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63109960A (ja) * 1986-10-27 1988-05-14 Okuma Mach Works Ltd 倣い制御における任意角度倣い方法
JPH02181205A (ja) * 1989-01-06 1990-07-16 Fanuc Ltd 3次元曲線生成方式
JPH0421104A (ja) * 1990-05-16 1992-01-24 Mitsubishi Electric Corp 複数軸駆動装置

Also Published As

Publication number Publication date
JPH04777B2 (ja) 1992-01-08

Similar Documents

Publication Publication Date Title
JP2902205B2 (ja) 空間誤差補正装置
CN106802141B (zh) 形状测量设备的控制方法
CN103322984A (zh) 基于视频图像的测距、测速方法及装置
JPS6028624B2 (ja) 倣い制御装置
JPS59209741A (ja) 任意方向倣い制御方式
EP0076330B1 (en) Copy controlling system
CN109765569B (zh) 一种基于激光雷达实现虚拟航迹推算传感器的方法
JPS58208612A (ja) 測定方法および測定装置
JPS58189706A (ja) 速度指令系の速度補正方式
US4962460A (en) Digitizing apparatus for digitizing a model surface using a contactless probe
JPH0570162B2 (ja)
TW200921316A (en) Multi-degree-of-freedom stage control apparatus
KR890001353B1 (ko) 수치 제어장치
JPS6133845A (ja) 任意方向倣い制御装置
WO1986004852A1 (en) Profile controller in any direction
JPH0230460A (ja) 倣い制御方法
EP2112464B1 (en) Tracking type laser interferometer
JP2515518B2 (ja) 倣い制御における任意角度倣い方法
JP2003345402A (ja) 位置制御装置
JPS6195857A (ja) 倣い機械の倣い方向補正方法
JP2012088064A (ja) 速度制御装置
JP3238358B2 (ja) 構造物移動装置
JPS5816984B2 (ja) ナライセイギヨホウシキ
JPS62803A (ja) 3次元測定方法
SU470793A1 (ru) Двухкоординатна система позиционировани