JPS61193204A - 工業用ロボツト - Google Patents

工業用ロボツト

Info

Publication number
JPS61193204A
JPS61193204A JP3251085A JP3251085A JPS61193204A JP S61193204 A JPS61193204 A JP S61193204A JP 3251085 A JP3251085 A JP 3251085A JP 3251085 A JP3251085 A JP 3251085A JP S61193204 A JPS61193204 A JP S61193204A
Authority
JP
Japan
Prior art keywords
speed
speed data
amount
data
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
Application number
JP3251085A
Other languages
English (en)
Inventor
Hiroshi Godai
浩志 五代
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.)
Hitachi Ltd
Original Assignee
Tokico 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 Tokico Ltd filed Critical Tokico Ltd
Priority to JP3251085A priority Critical patent/JPS61193204A/ja
Publication of JPS61193204A publication Critical patent/JPS61193204A/ja
Pending 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/00Program-control systems
    • G05B19/02Program-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 program 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 program 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 program 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 program 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 program 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
    • 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/43Speed, acceleration, deceleration control ADC
    • G05B2219/43006Acceleration, deceleration control

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)
  • Manipulator (AREA)

Abstract

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

Description

【発明の詳細な説明】 [産業上の利用分野] この発明は工業用ロボットの位置決めに係り、特に正確
な位置決めを行えるようにした工業用ロボットに関する
[従来の技術] 従来の工業用ロボットにおいて位置決めを行う場合は、
一般に、予め定められた標準的な速度パターンに、移動
量に応じた所定の演算を施して実際の速度パターンを求
めるのが普通である(この方法についての詳細は、例え
ば特願昭59−269381号に記載されている)。
[発明が解決しようとする問題点] ところで、上記の方法で求めた速度パターンによって工
業用ロボットを駆動制御して位置決めを行う場合、モー
タなどの駆動装置や電源などが限界近くで動作している
とき、あるいは外乱など予測できない事態が発生したと
きなど、速度パターンによって決まる位置と、実際の位
置とがずれてしまい、正確な位置決めができなくなって
しまうという問題があった。
この発明は上述した事情に鑑みてなされたもので、正確
な位置決めをすることができる工業用口ポットを提供す
ることを目的としている。
[問題点を解決するための手段] 上記問題点を解決するためにこの発明は、予め定められ
たデータと、移動距離とに基づいて速度データを発生し
、この速度データに基づいて駆動装置を駆動して位置決
めを行うようにした工業用ロボットにおいて、所定の周
期毎に、目標位置から現在位置を引いて実際の残り移動
量を求めるとともに前記速度データを積分して計算上の
残り移動量を求め、減速時に前記実際の残り移動量が前
記計算上の残り移動量より大きいときには、前回周期の
速度データをそのまま今回周期の速度データとし、この
速度データに基づいて前記駆動装置を駆動制御すること
を特徴とする。
[作用コ 上記手段によれば、減速時に、実際の残り移動量が計算
上の残り移動量より大きいときには、駆動装置を減速さ
せることなく、前回周期の速度で運転するため、より速
い速度で運転されることとなり、実際の残り移動量と計
算上の残り移動量との差が広がるのを防ぐことができる
。これによって、所定の目標位置に正確に停止させるこ
とができる。
[実施例] 以下1図面を参照してこの発明の実施例について説明す
る。
第1図は、この発明の一実施例による工業用ロボットの
電気的構成を示すブロック図である。この図において、
1は関数発生器であり、目標位置R1現在位置Ra、最
高速度V max、加速時間Ta、減速時間Tdの各信
号に基づいて、一定周期のサンプリング時間Δを毎に、
次のようなデータPsを演算して出力するものである。
なお、以下の式において、iは、サンプリングの順番を
示すもので、零または正の整数値をとる。
(1)加速期間(ixΔt≦加速時間Ta)のときP 
9(i)= a(i) ただし;a(i)は時刻i×Δtにおける加速度(2)
定速期間(T a< iXΔt<Ta十定速時間Tc)
のとき P 5(L)= V max ただし;VmaXは最高速度(一定) (3)減速期間(iXΔL≧T a+ T c)のとき
P 5(i)= d(D ただし;d(i)は時刻i×Δtにおける減速度なお、
上記各信号の内、現在位置Raは後述するカウンタ7か
ら供給され、他の信号は図示せぬ制御部から供給される
ようになっている。
上記データPsは、バッファメモリ2へ逐次供給されて
ここに記憶され、速度データ発生器3によってサンプリ
ング時間Δt(例えば2 ms)毎に読み出され、次の
演算によって、速度データV(i)に変換されて速度ア
ンプ4へ供給される(第2図参照)。
(1)加速期間(iXΔt≦加速時間Ta)のときV(
O)=O v(i)=V(i−1)+a(i)×k・・・・(1)
ただし;には定数 (2)定速期間(T a< iXΔt<Ta十定速時間
Tc)のとき V (i)= V maに・ ・ ・ ・ ・ ・ ・
 ・ ・ ・(2)(3)減速期間(ixΔt≧Ta’
+Tc)のときV (i)= V (i −1) −d
(i)x k・ ・ ・ ・(3)または、 V(i)=v(i−1)・・・・・・・・(4)ここで
、式(3)と(4)のいずれを使用するかは、目標位置
Rから現在位置Raを引いて求めた実際の残り移動量S
aと、上記速度データV (i)を積分して得た計算上
の移動量Sとの偏差5−Saによって定まるものであり
、これについては後述する。
速度アンプ4は速度データ発生器3から送られてきた速
度データV(i)をモータ駆動電圧に変換してモータ5
へ供給し、速度データV (i)に対応した速度でモー
タ5を回転制御するようになっている。
モータ5の速度はロータリエンコーダ6によって検出さ
れる。すなわち、ロータリエンコーダ6は、モータ5の
速度に比例する数のパルスを出力し、このパルスがカウ
ンタ7で積算されて現在位置Raとして関数発生器1と
速度データ発生器3にフィードバックされる。
次に、第3図のフローチャートを参照してこの実施例の
動作を説明する。
まず、加速期間Taおよび定速期間Tcの間は、式(1
)、(2)によって速度データV(i)が決定される。
すなわち、加速期間Taにあっては、前回サンプリング
時の速度データV(i−1)に加速度a(i)の定数倍
(k倍)を加えて今回の速度データV (f)を得、こ
れによってモータ5の速度制御を行う。
一方、時間Taが経過して定速期間Tcに入ったならば
、式(2)によって、速度データV (+)は最高速度
V maxに保たれる。なお、これらの制御方法は従来
と同様であり、この間の実際の移動距離すなわち初期位
置から計った現在位置Raは、カウンタ7の値から求め
られる。また計算上の移動距離は、速度データV (i
)を積分することによって求められる。
次に、減速期間Tcにあっては、第3図に示すように、
目標位置Rから現在位置Raを減じて求めた実際の残り
移動量Saが、目標位置Rから計算上の移動距離を減じ
て求めた計算上の残り移動Isより大きいか否かによっ
て決められる。すなわち、第3図のフローチャートのス
テップSPIにおいて上記の比較がなされ、実際の残り
移動量Saが計算上の残り移動量Sより小さいときには
、モータ5の減速が十分に行なわれていることになるか
ら、ステップSP2において式(3)の演算がなされ、
前回速度データV(i−1)から今回の減速度d(i)
の定数倍(k倍)を減じて、減速後の今回速度データV
 (i)が決定され、これによってモータ5の速度が減
速される。
一方、実際の残り移動量Saが計算上の残り移動量S以
上のときには、減速が不十分であることから、ステップ
SP3において式(4)の演算が行なわれ、前回の速度
データV(i−1)がそのまま今回の速度データV(i
)として出力される。こうして、モータ5は前回の速度
のまま運転される。
そして、実際の残り移動量Saが予め定められた停止範
囲に入るまで、上記の制御が続けられ、停止範囲に入っ
たときに目標位置Rに到達したものとして制御が終了す
る(ステップ5P4)。
こうして、本実施例によれば、移動中、減速中の負荷変
動によるモータ5の速度変化にかかわらず、目標位置と
現在位置との差によって減速制御が行なわれるので、目
標位置に確実に停止させることができる。
[発明の効果] 以上説明したように、この発明は、所定の周期毎に、目
標位置から現在位置を引いて実際の残り移動量を求める
とともに速度データを積分して計算上の残り移動量を求
め、減速時に前記実際の残り移動量が前記計算上の残り
移動量より大きいときには、曲回周期の速度データをそ
のまま今回周期の速度データとし、この速度データに基
づいて前記駆動装置を駆動制御するようにしたので、工
業用ロボットのハンド等を目標位置に正確に停止させる
ことができる。
【図面の簡単な説明】
第1図は、この発明の一実施例の電気的構成を示すブロ
ック図、第2図は、同実施例における速度パターンの一
例を示すグラフ、第3図は、同実施例の減速時の動作を
説明するためのフローチャートである。 l・・・関数発生器、3・・・速度データ発生器、4・
・・速度アンプ、5・・・モータ(駆動装置)、6・・
・ロータリエンコーダ、7・・・カウンタ。

Claims (1)

    【特許請求の範囲】
  1. 予め定められたデータと、移動距離とに基づいて速度デ
    ータを発生し、この速度データに基づいて駆動装置を駆
    動して位置決めを行うようにした工業用ロボットにおい
    て、所定の周期毎に、目標位置から現在位置を引いて実
    際の残り移動量を求めるとともに前記速度データを積分
    して計算上の残り移動量を求め、減速時に前記実際の残
    り移動量が前記計算上の残り移動量より大きいときには
    、前回周期の速度データをそのまま今回周期の速度デー
    タとし、この速度データに基づいて前記駆動装置を駆動
    制御することを特徴とする工業用ロボット。
JP3251085A 1985-02-20 1985-02-20 工業用ロボツト Pending JPS61193204A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP3251085A JPS61193204A (ja) 1985-02-20 1985-02-20 工業用ロボツト

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3251085A JPS61193204A (ja) 1985-02-20 1985-02-20 工業用ロボツト

Publications (1)

Publication Number Publication Date
JPS61193204A true JPS61193204A (ja) 1986-08-27

Family

ID=12360978

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3251085A Pending JPS61193204A (ja) 1985-02-20 1985-02-20 工業用ロボツト

Country Status (1)

Country Link
JP (1) JPS61193204A (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1988005935A1 (fr) * 1987-02-04 1988-07-11 Fanuc Ltd Procede de commande numerique comprenant une fonction de compensation du retard dans le temps de reaction
JPH01140206A (ja) * 1987-11-26 1989-06-01 Komatsu Ltd ロボットのcp制御の加減速装置
JP2007086904A (ja) * 2005-09-20 2007-04-05 Brother Ind Ltd 加速度軌跡生成装置
US7963208B2 (en) 2007-07-25 2011-06-21 Smc Kabushiki Kaisha Mounting mechanism for a position-detecting sensor
KR101105720B1 (ko) * 2006-10-18 2012-01-17 에스엠씨 가부시키 가이샤 트러니언 지지금구가 장착된 유체압 실린더

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS55124809A (en) * 1979-03-22 1980-09-26 Tadao Totsuka Speed control unit
JPS5858689A (ja) * 1981-09-30 1983-04-07 オムロン株式会社 駐車場所割当方法
JPS58172709A (ja) * 1982-04-02 1983-10-11 Toko Inc 自動加減速制御回路
JPS5913046A (ja) * 1982-07-13 1984-01-23 Daihatsu Motor Co Ltd ロツカ−ア−ムのパツド部材
JPS59174918A (ja) * 1983-03-24 1984-10-03 Kiyouhou Seisakusho:Kk 位置決め装置の駆動速度制御装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS55124809A (en) * 1979-03-22 1980-09-26 Tadao Totsuka Speed control unit
JPS5858689A (ja) * 1981-09-30 1983-04-07 オムロン株式会社 駐車場所割当方法
JPS58172709A (ja) * 1982-04-02 1983-10-11 Toko Inc 自動加減速制御回路
JPS5913046A (ja) * 1982-07-13 1984-01-23 Daihatsu Motor Co Ltd ロツカ−ア−ムのパツド部材
JPS59174918A (ja) * 1983-03-24 1984-10-03 Kiyouhou Seisakusho:Kk 位置決め装置の駆動速度制御装置

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1988005935A1 (fr) * 1987-02-04 1988-07-11 Fanuc Ltd Procede de commande numerique comprenant une fonction de compensation du retard dans le temps de reaction
JPH01140206A (ja) * 1987-11-26 1989-06-01 Komatsu Ltd ロボットのcp制御の加減速装置
JP2007086904A (ja) * 2005-09-20 2007-04-05 Brother Ind Ltd 加速度軌跡生成装置
KR101105720B1 (ko) * 2006-10-18 2012-01-17 에스엠씨 가부시키 가이샤 트러니언 지지금구가 장착된 유체압 실린더
US8387515B2 (en) 2006-10-18 2013-03-05 Smc Kabushiki Kaisha Fluid pressure cylinder with trunnion support fitting
US7963208B2 (en) 2007-07-25 2011-06-21 Smc Kabushiki Kaisha Mounting mechanism for a position-detecting sensor

Similar Documents

Publication Publication Date Title
US4888536A (en) Device for controlling positioning of an object
KR960012701B1 (ko) 주축 위치 결정 방법
EP0051453A1 (en) Spindle orientation control apparatus
JPS61193204A (ja) 工業用ロボツト
JP2542538B2 (ja) ロボットの位置制御方法
JPH06339292A (ja) 外乱負荷推定による力制御方法
JPH08211943A (ja) 外乱オブザーバを使用したバックラッシュ補正方法
JPH08140386A (ja) サーボモータのイナーシャ推定方法
JPS6337597B2 (ja)
JPH06131050A (ja) サーボモータで駆動される可動部の衝突検出方法
JPH06225565A (ja) 電動機駆動系の慣性負荷測定方式
JPH05346359A (ja) 負荷イナーシャ測定装置
JP2004054838A (ja) ワーク質量推定装置
GB2273177A (en) Actuator position control.
JP2816045B2 (ja) 位置決め制御装置
JP3388426B2 (ja) 任意補間を可能としたモータのパルス列制御方式
GB2242038A (en) Movement control.
JPH07110715A (ja) ロボットシステムの位置制御装置及びその制御方法
JPH048485A (ja) コンベア付きロボットシステムの教示方法
JP3207723B2 (ja) サーボ制御装置
JP3308805B2 (ja) コークス炉作業用移動機械の走行速度制御方法及び装置
JP2002049407A (ja) モータ制御装置
HU191959B (hu) Pozicionáló eljárás
JPH0633397Y2 (ja) シャシダイナモにおける自動運転装置
JPH0379457B2 (ja)