JPS62134707A - 駆動装置の速度制御装置 - Google Patents

駆動装置の速度制御装置

Info

Publication number
JPS62134707A
JPS62134707A JP60274424A JP27442485A JPS62134707A JP S62134707 A JPS62134707 A JP S62134707A JP 60274424 A JP60274424 A JP 60274424A JP 27442485 A JP27442485 A JP 27442485A JP S62134707 A JPS62134707 A JP S62134707A
Authority
JP
Japan
Prior art keywords
speed
axis
moving
area
probe
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
JP60274424A
Other languages
English (en)
Other versions
JP2569436B2 (ja
Inventor
Osamu Arai
荒井 治
Masahito Yoshida
雅人 吉田
Mieko Murayama
村山 実枝子
Hiroko Tsuchida
土田 裕子
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.)
Nikon Corp
Original Assignee
Nippon Kogaku KK
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 Nippon Kogaku KK filed Critical Nippon Kogaku KK
Priority to JP60274424A priority Critical patent/JP2569436B2/ja
Publication of JPS62134707A publication Critical patent/JPS62134707A/ja
Application granted granted Critical
Publication of JP2569436B2 publication Critical patent/JP2569436B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

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

Description

【発明の詳細な説明】 (発明の技術分野) 本発明はテーブルやプローブ等の被駆動部材を駆動する
駆動装置に関する。
(発明の背景) 被駆動部材を所定方向に定めた所定範囲内で移動せしめ
る駆動装置が知られており、例えば2次元的に移動する
ものでは測定機等のテーブル(載物台)が、また3次元
的に移動するものでは3次元座標測定機のプローブ等が
ある。
これらのものでは被駆動部材が所定範囲の境界位置で停
止するために、境界位置を検出する検出器がもうけられ
たりしているが、高速で境界位置に向かうとオーバーラ
ンしてしまう可能性があるので、境界位置近傍で減速す
ることが行なわれている。すなわち、所定範囲を安全移
動領域と減速領域とに別け、被駆動部材が減速領域に入
ると強制的に移動速度を減速するようになし”ζいる。
ところが減速領域において減速する構成では減速領域か
ら安全移動領域への復帰に時間がかかる、という欠点が
ある。
(発明の目的) 本発明は、これらの欠点を解決し、減速領域から安全移
動領域への復帰をすみやかに行なえる駆動装置の速度制
御装置を提供することを目的とする。
(発明の(既要) 本発明は、被駆動部材の所定方向への移動速度を設定す
る速度設定装置(1)を有し、前記被駆動部材を前記所
定方向に定めた所定範囲内で移動せしめる駆動装置の速
度制御装置において、前記所定範囲内を安全移動領域と
減速領域とに別け、前記被駆動部材が前記減速領域にあ
ると検出信号を出力する検出装置(4)と、 前記検出信号が出力されているときであって、前記所定
方向への移動速度が所定速度以上でありかつ前記被駆動
部材が前記安全移動領域から遠ざかる方向−1移動して
いるときにのみ、前記被駆動部材の移動速度を強制的に
前記所定速度以下となす速度補正装置(5)と、 を有することを特徴とする速度制jll装置。
(実 施 例) 以下、図面に示した実施例に基づいて本発明を説明する
第1図は本発明の一実施例のブロック図であり、第2図
はその動作を説明するための図、第3図は第1図のマイ
クロコンピュータのフローチャー1・、である。
第1図は本発明を三次元測定機に用いた場合であって、
不図示の固定部材にX方向移動自在に設けた不図示のX
方向移動部材と、X方向移動部材にY方向移動自在に設
けた不図示のY方向移動部材と、Y方向移動部材にZ方
向移動自在に設けた不図示のZ方向移動部材とを駆動す
るために、Xモータ12、Yモータ13、Zモータ14
が設けられている。X軸速度設定装置1、Y軸速度設定
装置2、X軸速度設定装置3は上述のX、 Y、  Z
方向の各移動部材の移動速度を設定するもので、例えば
常時は中立点にある操作レバーの傾は方向及び傾は角に
よって、X、7面内の移動方向及び移動速度を設定し、
つまみの回転によってZ方向の移動速度を設定するよう
になしたいわゆるジョイスティックが最適なものとして
用いられる。このように、X 1i+h速度設定装置1
、Y軸速度設定装置2、X軸速度設定装置3による各軸
の速度設定により、マイクロコンピュータ4はX軸速度
指令Yモータ13、Zモータ14はX軸ドライバ9、Y
軸ドライバ10.Z輔ドライバ11によって駆動される
。その結果、不図示のZ方向移動部材に取付けられたプ
ローブは三次元空間を各軸の合成スピードで合成された
方向へ移動する。
X−7面内でのプローブの動きを考えた場合、第2図に
示したようにプローブがX軸方向に動く範囲X、−X、
ばあらかしめ定まっており、範囲X r  X z内に
定めた範囲XL  Xllを安全移動領域としている。
ずなわら、プローブがX座標Xt。
Xllにくると、リミットスイッチ等の位置検出スイッ
チがオンになり、プローブがX軸方向で安全移動領域と
その外側に定めた減速領域(斜線部分)の境界にあるこ
とを知ることができる。そして、位置検出スイッチは、
プローブが減速領域にある限りオンしており、それによ
ってプローブがX軸方向の減速領域にいることがわかる
。Y軸方向の場合も同様であり、さらに第2図には示し
ていないがX軸方向の場合も同様である。
XPIE標XLはX軸方向安全移動領域の下限、X座標
X1はX軸方向安全作動領域の上限、Y座標YLはX軸
方向安全移動領域の下限、Y座標YllはY方向安全移
動領域の上限、Z座標ZLはX軸方向安全移動領域の下
限、Z座標ZllはX軸方向安全移動領域の上限を各々
示しているものとする。
第1図に示したように、マイクロコンピュータ4には、
X座標XL 、Xn 、Y座標XL 、  Xll、Z
座標ZL、Z、lにプローブがくると信号を出力する減
速領域検出回路5が接続されている。
マイクロコンピュータ4は、減速?+U域検比検出回路
らスイッチオン信号を受けると(ステップ30)、まず
X軸方向の移動速度vXを求め(ステップ31)、X軸
方向の移動速度VXの絶対値IVXIがあらかじめ定め
た所定値Nよりも太きいと(ステップ32)、X座標X
11でかつ速度VXが正か又はX座標×1.でかつ速度
■8が負かを判断しくステップ33)、そうであればプ
ローブは安全移動領域から遠ざかる方向へ所定値Nより
も大きい絶対値の速度で移動しているので、プローブの
移動方向を変化させずにX軸方向の速度が所める(ステ
ップ34)。ステップ32で速度VX絶対値1’VXl
が所定4fiNより小さい場合又は、プ1コープが安全
移動領域へ向かっている場合(ステップ33)は、合成
速度■に変化を与えない。
次に、Y軸方向の移動速度■7を求め(ステップ35)
、Y軸方向の移動速度■7の絶対値IVYIがあらかじ
め定めた所定値Nよりも大きいと(ステップ36)、’
/座標YH以上でかつ速度■7が正か又はY座標YL以
下でかつ速度V7が負かを判断しくステップ37)、そ
うであればプローブは安全移動領域から遠ざかる方向へ
所定値Nよりも大きい絶対値の速度で移動しているので
、プローブの移動方向を変化させずにY軸方向速度■を
求める(ステップ38)。ステップ36で速度■7の絶
対値IVYIが所定値Nより小さい場合又は、プローブ
が安全移動領域へ向かっている場合(ステップ37)は
、合成速度■に変化を与えない。
さらに、Z軸方向の移動速度■2を求め(ステップ39
)、Z軸方向の移動速度V2の絶対値1v21があらか
じめ定めた所定値Nよりも大きいと(ステップ40)、
Z座標Z11以上でかつ速の 度■、が正又はZ座標Z7、以下でかつ速度■2が負か
を判断しくステップ41)、そうであればプローブは安
全移動領域から遠ざかる方向へ所定値Nよりも大きい絶
対値の速度で移動しているので、プローブの移動方向を
変化させずにZ軸方向の速■を定める(ステップ42)
。ステップ40で速度v2の絶対値1■21が所定値N
より小さい場合又は、プローブが安全移動領域へ向かっ
ている場合(ステップ41)は、合成速度Vに変化を与
えない。
このように、マイクロコンピュータ4は、’RW領域検
出回路5からの信号によってプローブが減速領域にいる
ことを判断すると、第2図に示したように、X軸方向の
減速領域20の位置P、にいるプローブが安全移動領域
21から遠ざかる方向でかつ所定速度以上であるときは
、所定速度方向を変えずに変化せしめる。そして、プロ
ーブが移動範囲の限界X2にくると、マイクロコンピュ
ータ4は不図示の検出スイッチからの信号によってX軸
方向の速度■8を零となす。X軸方向の減速領域20の
位置P2にいるプlコープが安全移動領域21に近づく
方向の速度■8を有している場合にはマイクロコンピュ
ータ4は何ら速度に変化を与えない。
このような構造であるから、X軸速度設定装置1、Y軸
速度設定装置2、Z軸速度設定装置3によってプローブ
の移動速度、移動方向を設定し、プローブが安全移動領
域にあるときにはプローブは指定した方向へ指定した速
度で移動するが、プローブがいずれかの軸方向の減速領
域に入ると、プローブの方向が安全移動領域から遠ざか
る方向でかつ移動速度が所定速度以上であるときに限っ
て、減速領域にある軸方向の速度が所定速度になるよう
に合成速度の大きさが減少する。従って、減速領域から
安全移動領域への復帰は、各速度設定装置1.2.3で
設定された速度に何ら変化を与えないから、減速領域か
ら安全移動領域への復り 帰がすみやかに行なわれるばからでなく、プローブが指
示通りの速度で移動するので、操作性の良い速度制御装
置を得ることができる。
なお、以上の説明では、プローブの位置を検出する検出
スイッチを設けたが、減速領域と安全移動領域とが区別
できれば良いのであるから、X方向移動部材、Y方向移
動部材、Z方向移動部材の位置を固定部材に対する絶対
位置で知ることができるような座標読取装置を有するも
のでは、マイクロコンピュータ4があらかじめ安全移動
領域と減速領域との境界座標値を記憶装置に有しており
、座標読取装置から出力される座標値と、記憶装置の座
標値との比較による演算によって、プローブの位置が減
速領域にあるか否かを知るようになしても構わない。
さらに、マイクロコンピュータ4の動作は、第3図のフ
ローチャートに限定されるものではなく、まず各軸方向
の速度成分のうち絶対値が所定値辺間を指向しているも
のが所定速度になるように、合成速度を変化するように
なしてもよい。
また、以上の実施例は3次元測定機を例に上げて3軸の
もので説明したが、X−Yテーブルの如き2軸のものや
一軸のみのものでも同様に行ないうろことは勿論である
(発明の効果) 以上述べたように本発明によれば、所定方向に移動して
いるときにのみ、速度設定装置の設定移動速度にかかわ
らず、前記被駆動部材の前記所定方向への移動速度を所
定速度以下になしているので、被駆動部材が所定方向に
おいて安全移動領域に指向しているときは何ら制限がか
からないので、すみやかに安全移動領域に復帰させるこ
とができる。
【図面の簡単な説明】
第1図は本発明の第1実施例のブロック図、第2図はX
−Y平面での安全移動領域と減速領域を示し、被駆動部
材の動作を説明するための図、第3図は第1図で用いる
マイクロコンピュータの速度補正に係るフローチャート
、である。 〔主要部分の符号の説明〕 4−一一一マイクロコンピュータ、 ↓−−−−減速領域検出回路。

Claims (1)

  1. 【特許請求の範囲】 被駆動部材の所定方向への移動速度を設定する速度設定
    装置を有し、前記被駆動部材を前記所定方向に定めた所
    定範囲内で移動せしめる駆動装置の速度制御装置におい
    て、 前記所定範囲内を安全移動領域と減速領域とに別け、前
    記被駆動部材が前記減速領域にあると検出信号を出力す
    る検出装置と、 前記検出信号が出力されているときであつて、前記所定
    方向への移動速度が所定速度以上でありかつ前記被駆動
    部材が前記安全移動領域から遠ざかる方向へ移動してい
    るときにのみ、前記被駆動部材の前記所定方向への移動
    速度を強制的に前記所定速度以下となす速度補正装置と
    、 を有することを特徴とする速度制御装置。
JP60274424A 1985-12-06 1985-12-06 駆動装置の速度制御装置 Expired - Fee Related JP2569436B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP60274424A JP2569436B2 (ja) 1985-12-06 1985-12-06 駆動装置の速度制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP60274424A JP2569436B2 (ja) 1985-12-06 1985-12-06 駆動装置の速度制御装置

Publications (2)

Publication Number Publication Date
JPS62134707A true JPS62134707A (ja) 1987-06-17
JP2569436B2 JP2569436B2 (ja) 1997-01-08

Family

ID=17541477

Family Applications (1)

Application Number Title Priority Date Filing Date
JP60274424A Expired - Fee Related JP2569436B2 (ja) 1985-12-06 1985-12-06 駆動装置の速度制御装置

Country Status (1)

Country Link
JP (1) JP2569436B2 (ja)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS647206A (en) * 1987-06-30 1989-01-11 Komatsu Mfg Co Ltd Robot controller
JPH01121909A (ja) * 1987-11-06 1989-05-15 Oki Electric Ind Co Ltd 直交座標型ロボットにおける動作速度制御方法
JPH01238407A (ja) * 1988-03-17 1989-09-22 Toshiba Corp 消火電車の速度制限装置
JPH02309403A (ja) * 1989-05-24 1990-12-25 Okuma Mach Works Ltd 数値制御方法及びその装置
JPH06200420A (ja) * 1991-06-18 1994-07-19 Montenero Omtp Officina Meccanica Di Finocchi Paolo & Co Snc 梳綿機ウェブコーム駆動システム
JP2009178842A (ja) * 2009-05-21 2009-08-13 Fanuc Ltd ロボット動作範囲設定装置
JP2011245614A (ja) * 2010-05-26 2011-12-08 GM Global Technology Operations LLC 速度制御ロボット機構におけるワークスペース制限の応用

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5810483A (ja) * 1981-07-08 1983-01-21 日産自動車株式会社 2腕ロボツトにおける両腕の高速衝突防止方法及びその装置
JPS5837701A (ja) * 1981-08-31 1983-03-05 Nissan Motor Co Ltd ロボツトの安全装置
JPS58120495A (ja) * 1982-01-14 1983-07-18 株式会社明電舎 マニピユレ−タの衝突防止装置
JPS6022201A (ja) * 1983-07-18 1985-02-04 Toshiba Corp 衝突防止装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5810483A (ja) * 1981-07-08 1983-01-21 日産自動車株式会社 2腕ロボツトにおける両腕の高速衝突防止方法及びその装置
JPS5837701A (ja) * 1981-08-31 1983-03-05 Nissan Motor Co Ltd ロボツトの安全装置
JPS58120495A (ja) * 1982-01-14 1983-07-18 株式会社明電舎 マニピユレ−タの衝突防止装置
JPS6022201A (ja) * 1983-07-18 1985-02-04 Toshiba Corp 衝突防止装置

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS647206A (en) * 1987-06-30 1989-01-11 Komatsu Mfg Co Ltd Robot controller
JPH01121909A (ja) * 1987-11-06 1989-05-15 Oki Electric Ind Co Ltd 直交座標型ロボットにおける動作速度制御方法
JPH01238407A (ja) * 1988-03-17 1989-09-22 Toshiba Corp 消火電車の速度制限装置
JPH02309403A (ja) * 1989-05-24 1990-12-25 Okuma Mach Works Ltd 数値制御方法及びその装置
JPH06200420A (ja) * 1991-06-18 1994-07-19 Montenero Omtp Officina Meccanica Di Finocchi Paolo & Co Snc 梳綿機ウェブコーム駆動システム
JP2009178842A (ja) * 2009-05-21 2009-08-13 Fanuc Ltd ロボット動作範囲設定装置
JP2011245614A (ja) * 2010-05-26 2011-12-08 GM Global Technology Operations LLC 速度制御ロボット機構におけるワークスペース制限の応用
US8676382B2 (en) 2010-05-26 2014-03-18 GM Global Technology Operations LLC Applying workspace limitations in a velocity-controlled robotic mechanism
JP2014054722A (ja) * 2010-05-26 2014-03-27 Gm Grobal Technology Operations Llc 速度制御ロボット機構におけるワークスペース制限の応用

Also Published As

Publication number Publication date
JP2569436B2 (ja) 1997-01-08

Similar Documents

Publication Publication Date Title
JP3341933B2 (ja) 加工物表面の走査方法および走査装置
US9519279B2 (en) Waveform display device provided with search function according to set condition
EP1378315B1 (en) Machine for machining large parts
JPS62134707A (ja) 駆動装置の速度制御装置
CN106814691A (zh) 数控装置和控制方法
JPH10239042A (ja) 三次元測定機
US5111125A (en) Automatic mirror repositioning
CN111857042B (zh) 一种基于pmac的五轴高精度定位控制系统及工作方法
JPS6025284A (ja) 位置決め装置
CN102354153B (zh) 机床点动控制系统、机床点动控制方法及数控机床
JPS6018706A (ja) 測定機の駆動装置
JPH03204009A (ja) 2軸同期駆動装置
CN112894801B (zh) 一种双轴同导轨设备回零方法和装置
US5119004A (en) Reference-point return method
JP2583740Y2 (ja) 駆動装置
JPS61136105A (ja) 産業用ロボツトの移動制御装置
JPH07136954A (ja) ロボットおよびそのアームの駆動制御方法
JPS60138611A (ja) ア−ムロボツトの制御装置
JP2806775B2 (ja) 精測進入レーダにおける表示方法及び表示装置
JP2572660B2 (ja) 自動駆動型比較計測機
SU798716A2 (ru) Система двухкоординатного программногоупРАВлЕНи C КОРРЕКциЕй пРОгРАММы
JPS5837562B2 (ja) 位置制御装置
JPS60191308A (ja) 産業機械の制御装置
JPS62156513A (ja) 三次元測定機
JPS59102557A (ja) 移動物体の位置決め装置

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees