JPS5896307A - 産業用ロボツトの位置決め方法 - Google Patents
産業用ロボツトの位置決め方法Info
- Publication number
- JPS5896307A JPS5896307A JP19504481A JP19504481A JPS5896307A JP S5896307 A JPS5896307 A JP S5896307A JP 19504481 A JP19504481 A JP 19504481A JP 19504481 A JP19504481 A JP 19504481A JP S5896307 A JPS5896307 A JP S5896307A
- Authority
- JP
- Japan
- Prior art keywords
- stop signal
- position data
- data
- stop
- deceleration
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 14
- 230000005540 biological transmission Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 6
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 3
- 230000015654 memory Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 2
- 230000008054 signal transmission Effects 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011179 visual inspection Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical 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/19—Numerical 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42213—Position overshoot, axis still moves after stop
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45083—Manipulators, robot
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)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
本発明は産業用ロボットの自動位置決め方法に関する。
これまでの自動位置決め方法には古くからリミ・ノドス
イッチや光電スイッチ等を並べてシーヶ/すと併用して
位置決めを行なうオープンループの位置決め装置が用い
られて来た。最近では産業用ロボットとして位置検出器
及び目標位置の記憶を磁気メモリーやICメモリを使用
した複雑な位置決め動作を行なうローコストのオープン
ループ式のロボットもある。
イッチや光電スイッチ等を並べてシーヶ/すと併用して
位置決めを行なうオープンループの位置決め装置が用い
られて来た。最近では産業用ロボットとして位置検出器
及び目標位置の記憶を磁気メモリーやICメモリを使用
した複雑な位置決め動作を行なうローコストのオープン
ループ式のロボットもある。
これらのオープンループの位置決め方式では、駆動軸の
機械的慣性と負荷抵抗の変動によって位置誤差か生ずる
ので高い位置精度を要求される装置では使用できないこ
とも多い。とくにオープンループ式の産業用ロボットの
場合はNG式あるいはティーチングプレーバック式いず
れの場合でも停止すべき位置を記憶装置に指示するのは
容易であるか、停止信号の発信位置を軸の移動量の長、
短に応じた慣性まで計算して記憶させるのはむつかしい
。その便法として、目標停止位置データに対し、停止信
号を可変式とした一律何一手前で発信するという方法が
実用されている。
機械的慣性と負荷抵抗の変動によって位置誤差か生ずる
ので高い位置精度を要求される装置では使用できないこ
とも多い。とくにオープンループ式の産業用ロボットの
場合はNG式あるいはティーチングプレーバック式いず
れの場合でも停止すべき位置を記憶装置に指示するのは
容易であるか、停止信号の発信位置を軸の移動量の長、
短に応じた慣性まで計算して記憶させるのはむつかしい
。その便法として、目標停止位置データに対し、停止信
号を可変式とした一律何一手前で発信するという方法が
実用されている。
ある位置決め点で誤差が最小になる停止信号の発信位置
を目視によって手動調整するのであるが、ずしも同一で
ないので、この−律設定では不都合がでてくる。しかも
摩擦抵抗等は温度、及びメンテナンスの状況如何により
変化するので高精度の停止精度を要求されるとこれらの
方法では対処できな(なる。
を目視によって手動調整するのであるが、ずしも同一で
ないので、この−律設定では不都合がでてくる。しかも
摩擦抵抗等は温度、及びメンテナンスの状況如何により
変化するので高精度の停止精度を要求されるとこれらの
方法では対処できな(なる。
本発明は、これらの問題を解決し、停止指令発信位置の
自動補正機能をもつローコストでしがも高い位置決め精
度の得られるオープンループの位置深めの方法を提供す
るものである。
自動補正機能をもつローコストでしがも高い位置決め精
度の得られるオープンループの位置深めの方法を提供す
るものである。
次に本発明の実施例を図面により説明する。
第1図は、オープンループの産業用ロボットの軸停止修
正動作回路及び状況説明図である。
正動作回路及び状況説明図である。
まず停止信号について説明する。
軸数は一般に複数であるが、本今明を理解の便のため一
軸で説明することにする。
軸で説明することにする。
今、軸はXlにあってXlに移動開始する状態からする
と、次の目標点のX2データが記憶装置がらとり込まれ
、続いて前もって仮の値として記憶されていた次の停止
信号位置データ原2がとり込まれ、停止信号発生位置X
2>Xl−△x2を計算し、この値Aと現在値X11と
の差を監視し両者が一致した時点で停止信号が発信され
る。
と、次の目標点のX2データが記憶装置がらとり込まれ
、続いて前もって仮の値として記憶されていた次の停止
信号位置データ原2がとり込まれ、停止信号発生位置X
2>Xl−△x2を計算し、この値Aと現在値X11と
の差を監視し両者が一致した時点で停止信号が発信され
る。
この結果わずかな遅れ時間後軸は停止する。このときあ
らかじめ決めた位置決め誤差の許容値内にあるかを判断
し、許容値外であればIEI標値と現在値との差から次
回の繰返し動作の時に目標値に正しく停止するためにX
1時点のときとり込んだ△冶のデータを修正しておく。
らかじめ決めた位置決め誤差の許容値内にあるかを判断
し、許容値外であればIEI標値と現在値との差から次
回の繰返し動作の時に目標値に正しく停止するためにX
1時点のときとり込んだ△冶のデータを修正しておく。
ここで、更らに目標値にまで近ずける必要かあるなら自
動インチングなどにより目標点まで送り込むこともでき
る。
動インチングなどにより目標点まで送り込むこともでき
る。
但し、このインチング動作時の停止信号の曹き変えは行
なわない。
なわない。
それは次回の繰返し動作のとき、このインチングで決定
された最終停止信号位置データを記憶してしまうとこの
インチングで停止した場合の慣性と実際のXxXz間と
の作動距離による慣性とが太き(異なるので行き過ぎに
なるためである。
された最終停止信号位置データを記憶してしまうとこの
インチングで停止した場合の慣性と実際のXxXz間と
の作動距離による慣性とが太き(異なるので行き過ぎに
なるためである。
このように、目標位置に向って第1回目に停止した位置
と目標点との差から停止信号位置データを修正するので
あり、許容値に入るようにこれをロボットの一巡動作ご
とに自動修正するので位置決めに対する変動要因(外乱
)に対し十分な位置決めの保証ができる。
と目標点との差から停止信号位置データを修正するので
あり、許容値に入るようにこれをロボットの一巡動作ご
とに自動修正するので位置決めに対する変動要因(外乱
)に対し十分な位置決めの保証ができる。
次に、減速位置信号について説明する。
これは柏原動機に減速機能を持つ駆動軸に対して行なう
もので、停止目標位置X2と減速開始信号の発信位置′
xDNnとの差をたとえば(10〜20)→A〜、(2
1〜30)→B%、(31以上)−・0%、のように段
階を設けて記憶しておく。
もので、停止目標位置X2と減速開始信号の発信位置′
xDNnとの差をたとえば(10〜20)→A〜、(2
1〜30)→B%、(31以上)−・0%、のように段
階を設けて記憶しておく。
自動運転のとき現在位置と次の目標位置との差を計算し
、その差がたとえば25であればあらかじめ決めたB%
の減速位置データを選び、軸起動後は軸位置検出器から
の現在値と、(Xl−B>との差が0になるとき減速信
号を発信する。
、その差がたとえば25であればあらかじめ決めたB%
の減速位置データを選び、軸起動後は軸位置検出器から
の現在値と、(Xl−B>との差が0になるとき減速信
号を発信する。
このようにすると次の目標位置との距離の長短による慣
性の違いによる停止誤差を減少することかできる。この
減速制御を前述した停止信号位置データの自動修正制御
と組み合せて用いると更に効果的になる。
性の違いによる停止誤差を減少することかできる。この
減速制御を前述した停止信号位置データの自動修正制御
と組み合せて用いると更に効果的になる。
すなわち、減速は移動距離の長・短に合わせた減速開始
位置の選定によって、すべての位置決め点でほり等しい
速度まで減速ができ、かつ停止信号は停止信号発信位置
の自動修正制御によって行なわれるのでサーボ制御に近
い高い位置決めの再現精度を得ることができる。
位置の選定によって、すべての位置決め点でほり等しい
速度まで減速ができ、かつ停止信号は停止信号発信位置
の自動修正制御によって行なわれるのでサーボ制御に近
い高い位置決めの再現精度を得ることができる。
次に第2図について説明する。
第2図は停止信号位置データの修正制御のブロック図で
ある。○印の番号は動作順序を示す。
ある。○印の番号は動作順序を示す。
軸移動を行なうとき位置データメモリーの中から指定さ
れた位置データx2をとり出す(7)。
れた位置データx2をとり出す(7)。
次に停止位も位置データ原2をとり(1)、この2者の
差を求めた値、すなわち停止信号を発生すべきX座標値
をラッチする(2)。起動指令によって駆動機、本実施
例ではモータか起動しく13)移動中の軸位置を位置検
出器によって検出し、これを次段で軸位置データに変換
しく3)停止信号位置データ(2)と比較しく4)、一
致したとき(5)、停止回路を介して、モータの停止動
作を与える(6)。
差を求めた値、すなわち停止信号を発生すべきX座標値
をラッチする(2)。起動指令によって駆動機、本実施
例ではモータか起動しく13)移動中の軸位置を位置検
出器によって検出し、これを次段で軸位置データに変換
しく3)停止信号位置データ(2)と比較しく4)、一
致したとき(5)、停止回路を介して、モータの停止動
作を与える(6)。
このあとモータが停止したことを確認しく9)、こ差を
計算し、この差から必要な修正蓋を計算し、1■のとき
にとり込んだΔすの内容を書きかえる(12)。以上を
くり返えし、自動運転によって位置決めの実行と誤差修
正が常に行なわれるので負荷変動、温度変動などによる
抵抗の変化に対して安定な位置決めが得られる。
計算し、この差から必要な修正蓋を計算し、1■のとき
にとり込んだΔすの内容を書きかえる(12)。以上を
くり返えし、自動運転によって位置決めの実行と誤差修
正が常に行なわれるので負荷変動、温度変動などによる
抵抗の変化に対して安定な位置決めが得られる。
次に第3図について説明する。
第3図は減速制御の動作ブロック図である。
次の位置への移動するために目標位置データX2をメモ
リ″−から読み出しくl)、他方、停止している現在位
置を、軸現在位置データ(3)との差を演算器3で演算
し、この結果とあらかじめ決めた減速量区分とを比較し
、前記演算結果の該当する減速区分を選択する。
リ″−から読み出しくl)、他方、停止している現在位
置を、軸現在位置データ(3)との差を演算器3で演算
し、この結果とあらかじめ決めた減速量区分とを比較し
、前記演算結果の該当する減速区分を選択する。
その選択した減速量と目標位置データX2 との差を演
算2によって行ない、この結果の値を軸現在位置データ
とを比較し、軸の移動によってこの比較値を越えたとき
にモータの減速を行なう。
算2によって行ない、この結果の値を軸現在位置データ
とを比較し、軸の移動によってこの比較値を越えたとき
にモータの減速を行なう。
このような、減速制御によって移動距離の長短による慣
性の差を減少させて停止誤差を減少させることかできる
。
性の差を減少させて停止誤差を減少させることかできる
。
上記実施例は、ハードによる回路構成によって示めした
か、制御回路の一部をマイクロコンピュータによるソフ
トで実現できることは云うまでもない。
か、制御回路の一部をマイクロコンピュータによるソフ
トで実現できることは云うまでもない。
以上、詳細に説明したように、本発明によれば安価なセ
ミクローズトループのロボットであっても減速信号の発
信を目標位置との距離の長短に応じた減速開始位置で減
速を開始することによって、距離の長短による慣性の違
いによる停止位置ズレを減少させることができ、さらに
停止信号の発生位置の自動補正制御を用いて停止信号発
生位置をロボットの一巡動作毎に修正させれば、外乱要
因に刻し自動補正を行なうことができ高価なりローズド
ループ制御に四速する高い位置決め精度を保証すること
かできる。
ミクローズトループのロボットであっても減速信号の発
信を目標位置との距離の長短に応じた減速開始位置で減
速を開始することによって、距離の長短による慣性の違
いによる停止位置ズレを減少させることができ、さらに
停止信号の発生位置の自動補正制御を用いて停止信号発
生位置をロボットの一巡動作毎に修正させれば、外乱要
因に刻し自動補正を行なうことができ高価なりローズド
ループ制御に四速する高い位置決め精度を保証すること
かできる。
第1図H,オープンルーグC)産鍵用ロボットの軸停止
修正他作回路及び状況説明図。 第2図は停止16号11i1Zltデータの修IE哨−
のブロック図、第3図げ、減速量−の@作ブロック図。 発明者吉村勝夫
修正他作回路及び状況説明図。 第2図は停止16号11i1Zltデータの修IE哨−
のブロック図、第3図げ、減速量−の@作ブロック図。 発明者吉村勝夫
Claims (1)
- 【特許請求の範囲】 1、ティーチングプレーバックによる産業用ロボットの
オーブンループ方式による自動位置決め方法において、
ティーチングによって移動軸の停止すべき位置データ(
目標値)と停止信号の発信すべき位置データ(停止信号
位置データ)とを電子的記憶手段によって記憶させ、自
動運転のとき軸位置検出器の刻々の位置データを監視し
、停止信号位置データと一致した時点で停止信号を発信
し、停止した位置と前記目標値との差を検出し、許容値
内でない場合は、前記記憶した停止信号位置データを許
容値内に停止できるように、修正再記憶し、なお、目標
位置との誤差が許容値内に入らないときは、前記停止信
号位置データを再び修正することによって停止信号位置
データを自動修正するようにしたことを特徴とする産業
用ロボットの位置決め方法。 2、軸駆動に減速機能をもつティーチングプレーバック
による工業用ロボットのオーブンループ方式による自動
位置決め方法において、ティーチングによって与えられ
た停止すべき位置データと設定手段によって与えた移動
距離で区分した減速位置区分データとを電気的記憶手段
によって記憶させ、自動運転のとき現在停止している軸
位置検出器からの現在位置データと次に移動して停止さ
せる前記停止すべき位置との差を演算し、この演算値の
該当する前記減速位置区分データを選択し、軸位置検出
器からの刻々の現在位置データとlij記選択した減速
位置区分データとを比較し、両者が一致したときに減速
信号を発することによって軸移動距離の長短による慣性
の違いによる位置決め誤差を減少させることを特徴とす
る産業用ロボットの位置決め方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP19504481A JPS5896307A (ja) | 1981-12-03 | 1981-12-03 | 産業用ロボツトの位置決め方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP19504481A JPS5896307A (ja) | 1981-12-03 | 1981-12-03 | 産業用ロボツトの位置決め方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS5896307A true JPS5896307A (ja) | 1983-06-08 |
Family
ID=16334604
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP19504481A Pending JPS5896307A (ja) | 1981-12-03 | 1981-12-03 | 産業用ロボツトの位置決め方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS5896307A (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59107880A (ja) * | 1982-12-08 | 1984-06-22 | 株式会社日立製作所 | ロボツトの制御方法及び装置 |
FR2655584A1 (fr) * | 1989-12-11 | 1991-06-14 | Mitsubishi Electric Corp | Appareil a commande numerique. |
JPWO2015029218A1 (ja) * | 2013-08-30 | 2017-03-02 | 富士機械製造株式会社 | エアカット調整装置 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5458179A (en) * | 1977-10-18 | 1979-05-10 | Yaskawa Electric Mfg Co Ltd | Self-correcting type control apparatus |
-
1981
- 1981-12-03 JP JP19504481A patent/JPS5896307A/ja active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5458179A (en) * | 1977-10-18 | 1979-05-10 | Yaskawa Electric Mfg Co Ltd | Self-correcting type control apparatus |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59107880A (ja) * | 1982-12-08 | 1984-06-22 | 株式会社日立製作所 | ロボツトの制御方法及び装置 |
FR2655584A1 (fr) * | 1989-12-11 | 1991-06-14 | Mitsubishi Electric Corp | Appareil a commande numerique. |
US5221884A (en) * | 1989-12-11 | 1993-06-22 | Mitsubishi Denki K.K. | Numerical control apparatus |
JPWO2015029218A1 (ja) * | 2013-08-30 | 2017-03-02 | 富士機械製造株式会社 | エアカット調整装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5404308A (en) | Numerical control (NC) device to control feed speed of tool based on speed of spindle and amount of change of spindle speed | |
US4815007A (en) | Apparatus for controlling a robot | |
EP0172486A2 (en) | Tracking robot apparatus | |
EP0014065B1 (en) | System for creating a servo control signal | |
JPH03201106A (ja) | 数値制御装置のバックラッシュ補正方式 | |
US4112291A (en) | Positioning system in a numerically controlled apparatus | |
KR910006499B1 (ko) | 수치 제어장치 | |
US4888536A (en) | Device for controlling positioning of an object | |
GB2281639A (en) | Machine tool position synchronization | |
KR900005549B1 (ko) | 원점 복귀 방법 | |
JPS5896307A (ja) | 産業用ロボツトの位置決め方法 | |
US5473542A (en) | Method for a time-optimal, true-to-path braking of axle drives of numerically controlled machines | |
CN117155175A (zh) | 一种蜗杆伺服控制方法、系统、装置及存储介质 | |
US5327352A (en) | Method and device for controlling one or mor axes in a machine tool | |
US5670857A (en) | Method of returning to an absolute zero point for use by an industrial controller | |
US4914366A (en) | Positioning control system | |
JPH10161747A (ja) | 接触位置検出方法および接触位置検出装置 | |
US5115180A (en) | Automatic drift compensation method and device for position-loop controller | |
JPS62277290A (ja) | マニプレ−タの制御装置 | |
JP2807491B2 (ja) | 数値制御装置 | |
CN111699078A (zh) | 机器人的运行 | |
JPS6232508A (ja) | 数値制御装置のサ−ボ系の位置決め制御方法 | |
JPH0639066B2 (ja) | 産業用ロボツトの制御方法 | |
JPH04362702A (ja) | 繰り返し制御における速度制御方法 | |
JP2703099B2 (ja) | 産業用ロボットのコンベア追従方法 |