JPS61100350A - 倣い制御装置 - Google Patents

倣い制御装置

Info

Publication number
JPS61100350A
JPS61100350A JP21744584A JP21744584A JPS61100350A JP S61100350 A JPS61100350 A JP S61100350A JP 21744584 A JP21744584 A JP 21744584A JP 21744584 A JP21744584 A JP 21744584A JP S61100350 A JPS61100350 A JP S61100350A
Authority
JP
Japan
Prior art keywords
speed
tracing
profile
stylus
current position
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
JP21744584A
Other languages
English (en)
Other versions
JPH0355263B2 (ja
Inventor
Hiroshige Okitomo
沖友 啓成
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.)
Mitsubishi Heavy Industries Ltd
Original Assignee
Mitsubishi Heavy Industries 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 Mitsubishi Heavy Industries Ltd filed Critical Mitsubishi Heavy Industries Ltd
Priority to JP21744584A priority Critical patent/JPS61100350A/ja
Publication of JPS61100350A publication Critical patent/JPS61100350A/ja
Publication of JPH0355263B2 publication Critical patent/JPH0355263B2/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/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

Landscapes

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

Abstract

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

Description

【発明の詳細な説明】 〈産業上の利用分野〉 本発明は、倣い制御装置の倣い速度制御に関する。
〈従来の技術〉 第4図は従来の倣い制御装置の一例を示すブロック図で
ある。同図において、1はスタイラス、2はスタイラス
1の変位信号εX、εy、ε2を検出するトレーサヘッ
ド、3はスタイラス1の変位信号εX、εy+’Zと設
定された倣い速度vTとにより第5図に示すベクトル演
算をして倣い速度ベクトルv1発生するベクトル演算器
、4はベクトルVの成分■x、Vy、vzを増幅して各
軸の駆動モータ5を駆動する増幅器である。
第5図、第6図にて第4図の働きにつき述べる。8g5
図に示すモデルla上をなぞるスタイラス1の変位信号
εX、εy、ε2は、トレーサヘッド2からベクトル演
算器3に入力され、このベクトル演算器3では’X、ε
ア、ε2の合成変位2及び1ε1=fζ” + e y
” + 8 z”を算出し、与えられた基準変位;0と
の差の信号ご−20を求め、ついで設定された倣い速度
※Tを、モデルlaに垂直なベクトル二の方向と直角な
モデル1aの面に平行な方向に発生させ、信号ニー札と
速度VTとをベクトル合成して実際の倣いベクトル※を
求めている。そして、ベクトル演算器3からはベクトル
Vの各成分Vx、vy、Vzが発生され、増幅器4にて
増幅され、駆動モータ5の各軸が制御される。
このような倣い制御装置では、モデル1aの形状が急変
する部分において、倣い制御が追従できなくなるので、
その急変部分で信号ε−ε0が大きくなることを利用し
て第6図に示すように信号ε−60に逆比例したベクト
ル演算器3の倣い設定速度※Tを発生させ、形状の急変
部における倣い速度を下げていた。
〈発明が解決しようとする問題点〉 モデルの形状の急変があると倣い速度を下げていたので
あるが、変位の急変時をきっかけとして速度を下げてい
るので急変部において倣い速度を下げたのでは、振動の
影響やサーボ応答の遅れにより遅過ぎてしまう。このた
め、ベクトル演算器の設定速度vTの最大値(第6図の
頂点)を大きく設定することができなくなシ、結局倣い
速度が全体として低速度に抑えられてしまうという欠点
を有する。すなわち・倣い時間が長くなる。
そこで、本発明は、倣い速度を早くして倣い時間を短縮
した倣い制御装置の提供を目的とする。
く問題点を解決するための手段〉 上述の目的を達成する本発明は、トレーサヘッドからの
スタイラス変位をベクトル演算器により速度に代えて駆
動モータに送る倣い制御装置において、上記トレーサヘ
ッドの現在位置とスタイラス変位とによりスタイラスの
現在位置を算出する現在位置算出器と、この現在位置算
出器の出力を記憶すると共にスタイラスの現在位置より
先行する前回のパスの記憶位置を出力する現在位置記憶
器と、この現在位置記憶器か1′ らの前回のパスの先行する記憶位置の形状を算出して急
激な形状変化に基づく速度を算出すると共にこの速度に
て上記ベクトル演算器の設定速度を制御する速度算出器
とを有することを特徴とする。
く作用〉 前回のパスに対し現在のパスの形状の急変がさほどでな
いことを前提として、現在のパスの倣いに前回のパスの
形状を有効に利用することにより、形状急変位置での倣
い速度を落としそれ以外の位置での倣い速度を高速にし
ている。
〈実飽例〉 ここで、第1図ないしgg3図を参照して本発明の実J
l fUを説明する。なお、第4図と同一部分には同符
号を付しその説明は省略する。第1図に2いて、6はト
レーサヘッド2につなげられてX軸、Yittil、Z
軸のトレーサヘッド2の現在位11Xd 、 Yd 、
 Zdを検出する位置検出器、7は現在位置算出器で、
トレーサヘッド2の現在位a xa 、 yd、 zc
iとモデルに接触してスタイラスの変位を恢出するトレ
ーサヘッド2からの変位信号εX、εア、ε2とを受け
、これらを合成してスタイラスの現在位置X、Y、Zを
算出するもの、8は現在位置算出器7からのスタイラス
の現在位置x、y、zを受けて記憶すると共に、この入
力されるスタイラスの現在位tx 、 y 。
2(今回のパス)より先行する前回のパスの形状に基づ
く先行記憶位置Xn 、 yn 、 znを出力する現
在位置記憶器、9は速度算出器で、現在位置記憶器8か
らの前回のパスの先行記憶位t Xn 。
Yn 、 Znを受けてこの前回のパスでの形状の急変
部分(後述する例えば1taoθ1〉1の部分)を検出
するものである。そしてこの速度算出器9は、前回のパ
スでの形状の急変部分を検出しない場合には設定された
最高速度Vmaxをベクトル演算器3に与え、前回のパ
スでの急変部分を検出した場合には、その急変の程度に
応じた距離だけ遡った前回のパスの点に対応する今回の
パスの点まで後続のスタイラスが到達したときを現在位
置算出器7からの位置X、Y、Zにて判定して、その到
達点から形状急変程度に応じた減速をかけるべく速度を
ベクトル演算器3に指令するものであるっ ここで、第1図の動作を第2図、第3図と共に説明する
。スタイラスlの変位εX、εy、ε2はトレーサヘッ
ド2から現在位置算出器7とベクトル演算部3とに導か
れる。ベクトル演算部3では、第5図に示す演算をして
速度成分vx。
’V + Vy、 ’!i7出力する。この場合、ベク
トル演算部3における従来設定されていた倣い速度VT
を変化させるために現在位置算出器7、現在位置記憶器
8、速度算出器9が設けられる。現在位置算出器7では
X軸、Y¥*、2軸各軸のトレーサヘッドの現在位置X
d 、 Yd 、 Zdとスタイラスの変位εX、εy
、ε2とからスタイラスの中心位置X、Y、Zを式X=
Xd+ ez 、 Y=Yd + tyrZ = Zd
+εZにより算出する。このX、Y、Zは現在位置記憶
器8に記憶されると共に速度算出器9に入力される。こ
の位置x、y、zに基づき現在位置記憶器8から出力さ
れる前回のパスの先行記憶位置Xn 、 Yn 、 Z
nは、速度算出器9にてまず形状急変部分を検出する。
この検出は、第2図に示すように隣接した2直線り、 
、 L、のなす角度θを評価して行なう。評価は直線り
、 、 L。
の傾きm、 m、により−θを求める。
そして、このl tanθ1を〉1と1tanθ1≦1
とに判別し、1−01≦1の場合には形状の急変はない
とじで第3図に示す最大速度Vmaxの特性に従い出力
する。1taI101〉1の場合には前回のパスにおけ
る一〇を評価した点(第2図のXn+ 1 、Yn+x
 )から−θに比例する距離だけ遡って減速をかける。
その減速の速度vTがVT =−口=7]・Vmaxと
なるように行なう。ここで、kは定数である。
すなわち、第3図において、1tanθ1≦1の場合は
(イ)の特性、1帥θ1〉1で例えばtanθが1付近
の場合は仲)の特性、1tanθ1〉1で1よジも大幅
に一〇が大きい場合には(ハ)の特性にて速度VTを設
定するのである。
1tanθl>1の検出は前回のパスにて行なわれ、距
離を遡ることも前回のパスにて行なわれるために、後続
のスタイラスがその遡った点に対応する今回のパス上に
到ると初めて実際の減速が行なわれる。この到達を検出
するため即ち減速開始の条件としてスタイラスの現在位
置X 、 Y。
Zが速度算出器9に入力される。
こうして、前回のパスの形状を勘案しながら形状変化が
少ない場合には特性(イ)により高速でスタイラスを移
動させ、形状が急激に変化している場合にはその変化点
から遡った距離からスタイラスを減速させたものである
。この場合、遡る距離は形状変化に応じて設定してもよ
いが、一定距離としてもよい。また、減速の程度は形状
変化に応じて演算している。
〈発明の効果〉 モデル形状の急峻に変化する倣いにおいても、形状に応
じた適切な倣い速度が自動的に得られるため、倣いパス
全体にわた9可能なかぎりの最大倣い速度で倣える。よ
って、倣い時間を大幅に蝮縮できる。
【図面の簡単な説明】
第1図ないし第3図は本発明の実施例で、第1図は一例
の制御ブロック図、第2図は前回のパスの角度を評価す
る場合の説明図、第3図はベクトル演算器に与えられる
倣い速度の三種類の特性を示す特性線図、第4図は従来
の制御ブロック図、第5図は倣い速度演算のための説明
図、第6図は従来の倣い速度の特性線図である。 図中、 1はスタイラス、 2はトレーサヘッド、 3はベクトル演算器、 4は増幅器、 5は駆動モータ、 6は位置検出器、 7は現在位置算出器、 8は現在位置記憶器、 9は速度算出器である。 特許 出 願人 三菱重工業株式会社 復代理人  升埋十  元 石 士 部(他1名)第1
図 り 第2図 第4図 第5図 第6図 V丁

Claims (1)

    【特許請求の範囲】
  1. トレーサヘッドからのスタイラス変位をベクトル演算器
    により速度に代えて駆動モータに送る倣い制御装置にお
    いて、上記トレーサヘッドの現在位置とスタイラス変位
    とによりスタイラスの現在位置を算出する現在位置算出
    器と、この現在位置算出器の出力を記憶すると共にスタ
    イラスの現在位置より先行する前回のパスの記憶位置を
    出力する現在位置記憶器と、この現在位置記憶器からの
    前回のパスの先行する記憶位置の形状を算出して急激な
    形状変化に基づく速度を算出すると共にこの速度にて上
    記ベクトル演算器の設定速度を制御する速度算出器とを
    有することを特徴とする倣い制御装置。
JP21744584A 1984-10-18 1984-10-18 倣い制御装置 Granted JPS61100350A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP21744584A JPS61100350A (ja) 1984-10-18 1984-10-18 倣い制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP21744584A JPS61100350A (ja) 1984-10-18 1984-10-18 倣い制御装置

Publications (2)

Publication Number Publication Date
JPS61100350A true JPS61100350A (ja) 1986-05-19
JPH0355263B2 JPH0355263B2 (ja) 1991-08-22

Family

ID=16704345

Family Applications (1)

Application Number Title Priority Date Filing Date
JP21744584A Granted JPS61100350A (ja) 1984-10-18 1984-10-18 倣い制御装置

Country Status (1)

Country Link
JP (1) JPS61100350A (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63133251U (ja) * 1987-02-25 1988-08-31
JPH01271152A (ja) * 1988-04-22 1989-10-30 Fanuc Ltd ならい制御方式
JPH0248160A (ja) * 1988-08-04 1990-02-16 Jgc Corp マスターカムを用いない内面プロファイル研削の制御法
WO1991002625A1 (en) * 1989-08-25 1991-03-07 Fanuc Ltd Profile control apparatus
WO1991002624A1 (en) * 1989-08-25 1991-03-07 Fanuc Ltd Profile control apparatus
WO1991004832A1 (en) * 1989-10-04 1991-04-18 Fanuc Ltd Profile control method

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5652159A (en) * 1979-09-28 1981-05-11 Fanuc Ltd Contour control system
JPS59161252A (ja) * 1983-03-04 1984-09-12 Fanuc Ltd 倣い制御装置

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5652159A (en) * 1979-09-28 1981-05-11 Fanuc Ltd Contour control system
JPS59161252A (ja) * 1983-03-04 1984-09-12 Fanuc Ltd 倣い制御装置

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63133251U (ja) * 1987-02-25 1988-08-31
JPH01271152A (ja) * 1988-04-22 1989-10-30 Fanuc Ltd ならい制御方式
JPH0248160A (ja) * 1988-08-04 1990-02-16 Jgc Corp マスターカムを用いない内面プロファイル研削の制御法
WO1991002625A1 (en) * 1989-08-25 1991-03-07 Fanuc Ltd Profile control apparatus
WO1991002624A1 (en) * 1989-08-25 1991-03-07 Fanuc Ltd Profile control apparatus
WO1991004832A1 (en) * 1989-10-04 1991-04-18 Fanuc Ltd Profile control method

Also Published As

Publication number Publication date
JPH0355263B2 (ja) 1991-08-22

Similar Documents

Publication Publication Date Title
KR910015989A (ko) 변환기의 위치 결정 제어 방식
KR910015186A (ko) 음향신호 재생장치
JPH03190652A (ja) 非接触ならい制御装置
JPS61100350A (ja) 倣い制御装置
JPS59161252A (ja) 倣い制御装置
GB2026203A (en) Profile control system
KR940022220A (ko) 위치제어시스템 및 그 위치제어방법
KR920010312A (ko) 제품의 3차원 위치계측방법
GB1302120A (ja)
KR970025840A (ko) 공작 기계의 위치 제어 장치
Hattori et al. Estimating pose of human face based on symmetry plane using range and intensity images
KR830005968A (ko) 3차원 모방 제어 방식
KR100544445B1 (ko) 광류 추정을 이용한 이동하는 로봇에서의 정적, 동적장애물 탐지 및 회피 방법
JPS61124816A (ja) 非接触式三次元計測装置
JPH0138622B2 (ja)
JPH09267281A (ja) 多軸ロボットの倣い制御装置および倣い制御方法
JPH03261816A (ja) 座標測定機のスタイラスの倣い制御方法
CA2497916A1 (en) Acoustic method and device for distance measurement
Zhang et al. Speaker tracking method based on audio-visual bimodal fusion and its application to mobile robot
KR890001356B1 (ko) 모방제어 방식
JPS63265309A (ja) 追従制御方式
JP3323963B2 (ja) 計測装置
KR960002260A (ko) 방방제어기를 이용한 위치제어장치
JP7343735B1 (ja) 加工シミュレーション装置及び加工シミュレーション方法
Van Zee et al. Gradient computation in prediction error identification of linear discrete-time systems