JPH0430203A - ロボットの加減速時定数制御方法 - Google Patents
ロボットの加減速時定数制御方法Info
- Publication number
- JPH0430203A JPH0430203A JP2136007A JP13600790A JPH0430203A JP H0430203 A JPH0430203 A JP H0430203A JP 2136007 A JP2136007 A JP 2136007A JP 13600790 A JP13600790 A JP 13600790A JP H0430203 A JPH0430203 A JP H0430203A
- Authority
- JP
- Japan
- Prior art keywords
- acceleration
- deceleration time
- time constant
- torque
- robot
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 66
- 230000003068 static effect Effects 0.000 claims abstract description 14
- 238000000034 method Methods 0.000 claims description 15
- 230000005484 gravity Effects 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 2
- 101100112085 Arabidopsis thaliana CRT3 gene Proteins 0.000 description 1
- 101100141330 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) RNR4 gene Proteins 0.000 description 1
- 101150117093 alc2 gene Proteins 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 235000012976 tarts Nutrition 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/416—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 control of velocity, acceleration or deceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- 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/37—Measurements
- G05B2219/37391—Null, initial load, no load torque detection or other parameter at no load
-
- 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/43—Speed, acceleration, deceleration control ADC
- G05B2219/43009—Acceleration deceleration for each block of data, segment
-
- 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/43—Speed, acceleration, deceleration control ADC
- G05B2219/43023—Switch from acceleration to deceleration if mid stroke speed not reached
-
- 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/43—Speed, acceleration, deceleration control ADC
- G05B2219/43046—Determine time constant from command speed and needed max acceleration torque
-
- 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/43—Speed, acceleration, deceleration control ADC
- G05B2219/43059—Accelerate, decelerate all axis as function of max, min, average speed axis
-
- 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/43—Speed, acceleration, deceleration control ADC
- G05B2219/43099—Select acceleration deceleration time constants as function of weight, load, position
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明はサーボモータの加減速時定数を決定しながら、
ロボットの創作を制御するロボットの加減速時定数制御
方式に関し、特にブロック毎に最適な加減速時定数を決
定しながら、ロボットの動作を制御するロボットの加減
速時定数制御方式に関する。
ロボットの創作を制御するロボットの加減速時定数制御
方式に関し、特にブロック毎に最適な加減速時定数を決
定しながら、ロボットの動作を制御するロボットの加減
速時定数制御方式に関する。
ロボットの現地調整作業時に、各アームを駆動する各サ
ーボモータの加速時定数、減速時定数を設定する。ここ
で、加速時定数及び減速時定数を含めて加減速時定数と
いう。この加減速時定数はロボットの使用状況によって
大きく左右され、律に決定することは困難である。従っ
て、経験上の判断や、低運転等によって決定している。
ーボモータの加速時定数、減速時定数を設定する。ここ
で、加速時定数及び減速時定数を含めて加減速時定数と
いう。この加減速時定数はロボットの使用状況によって
大きく左右され、律に決定することは困難である。従っ
て、経験上の判断や、低運転等によって決定している。
しかし、これらの時定数を余裕をもって設定するとサイ
クルタイムが長くなり、逆に小さな値に設定すると振動
等が発生して、位置決め精度を低下させたりする。従っ
て、的確な値に設定することが要請されるが、短時間で
客観的に判断する基準を発見するのが困難であった。こ
のために、余裕度を大きくとった加減速時定数でロボッ
トを制御し、サーボモータのトルクに余裕があっても動
作速度を上げることが難しかった。
クルタイムが長くなり、逆に小さな値に設定すると振動
等が発生して、位置決め精度を低下させたりする。従っ
て、的確な値に設定することが要請されるが、短時間で
客観的に判断する基準を発見するのが困難であった。こ
のために、余裕度を大きくとった加減速時定数でロボッ
トを制御し、サーボモータのトルクに余裕があっても動
作速度を上げることが難しかった。
本発明はこのような点に鑑みてなされたものであり、サ
ーボモータの加減速時定数を移動量、負荷等による最適
な加減速時定数を決定するロボットの加減速時定数制御
方式を提供することを目的とする。
ーボモータの加減速時定数を移動量、負荷等による最適
な加減速時定数を決定するロボットの加減速時定数制御
方式を提供することを目的とする。
本発明では上記課題を解決するために、サーボモータの
加減速時定数をブロック毎に最適な値に決定しながら、
ロボットの動作を制御するロボットの加減速時定数制御
方式において、ブロックの移動量から、到達速度を求め
、前記到達速度からサーボモータの出力トルクを求杓、
前配出力トルクから静負荷トルクを減じて、加速トルク
を求肥、前記加速トルクと前記サーボモータの負荷イナ
ーシャから、加速度を求め、前記加速度から加減速時定
数を決定することを特徴とするロボットの加減速時定数
制御方式が、提供される。
加減速時定数をブロック毎に最適な値に決定しながら、
ロボットの動作を制御するロボットの加減速時定数制御
方式において、ブロックの移動量から、到達速度を求め
、前記到達速度からサーボモータの出力トルクを求杓、
前配出力トルクから静負荷トルクを減じて、加速トルク
を求肥、前記加速トルクと前記サーボモータの負荷イナ
ーシャから、加速度を求め、前記加速度から加減速時定
数を決定することを特徴とするロボットの加減速時定数
制御方式が、提供される。
次に実行すべきブロックの移動量から到達速度を求める
。例えば移動量が小さいときは、到達速度を小さく、移
動量がある値以上になると、到達速度は教示速度となる
。この到達速度から、サーボモータの速度・トルク曲線
からサーボモータの出力トルクが求められる。この速度
・トルク曲線はあらかじめ粘性損失が引かれている。こ
の圧力トルクから、摩擦トルク、重力によるトルク等か
らなる静負荷トルクを減じると、負荷を加速する加速ト
ルクが得られる。この加速トルクから加減速時定数を決
定し、ロボットの加減速を制御する。
。例えば移動量が小さいときは、到達速度を小さく、移
動量がある値以上になると、到達速度は教示速度となる
。この到達速度から、サーボモータの速度・トルク曲線
からサーボモータの出力トルクが求められる。この速度
・トルク曲線はあらかじめ粘性損失が引かれている。こ
の圧力トルクから、摩擦トルク、重力によるトルク等か
らなる静負荷トルクを減じると、負荷を加速する加速ト
ルクが得られる。この加速トルクから加減速時定数を決
定し、ロボットの加減速を制御する。
以下、本発明の一実施例を図面に基づいて説明する。
第２図はロボットの各軸の移動距離と到達速度の関係を
示すグラフである。第２図の横軸は時間、縦軸は速度を
表す。移動距離（あるいは回転角度）が充分大きいとき
は、線２で示すように、各点ｏａｂｃを通る。すなわち
、時定数τ。で８点まで加速され、教示速度Ｖｔで移動
し、減速して点Ｃで停止する。ここで、点ｏａｂｃ○を
それぞれ結ぶ線で囲まれた面積が移動距離となる。移動
距離が小さくなると、ａｂ間の速度一定の時間が小さく
なる。ａｂ間の距離がＯより大きいときを、ロングモー
ション、０以下のときをショートモーションと呼ぶ。ロ
ングモーションとショートモーションの境界では線３で
示す。ａｃ １の軌跡を描く。
示すグラフである。第２図の横軸は時間、縦軸は速度を
表す。移動距離（あるいは回転角度）が充分大きいとき
は、線２で示すように、各点ｏａｂｃを通る。すなわち
、時定数τ。で８点まで加速され、教示速度Ｖｔで移動
し、減速して点Ｃで停止する。ここで、点ｏａｂｃ○を
それぞれ結ぶ線で囲まれた面積が移動距離となる。移動
距離が小さくなると、ａｂ間の速度一定の時間が小さく
なる。ａｂ間の距離がＯより大きいときを、ロングモー
ション、０以下のときをショートモーションと呼ぶ。ロ
ングモーションとショートモーションの境界では線３で
示す。ａｃ １の軌跡を描く。
さらに、移動距離が短くなると、時定数τ。と最高速度
Ｖｍａｘで定義される直線Ｏｄまで加速度が変化し、線
４で示す。ａｌｃ２となる。さらに、移動距離が短くな
ると、線５で示す。ａ２ｃ３となる。この時の速度の最
大はＶｕとなり、この速度Ｖｕを到達速度と称する。
Ｖｍａｘで定義される直線Ｏｄまで加速度が変化し、線
４で示す。ａｌｃ２となる。さらに、移動距離が短くな
ると、線５で示す。ａ２ｃ３となる。この時の速度の最
大はＶｕとなり、この速度Ｖｕを到達速度と称する。
第３図はサーボモータの速度とトルクの関係を示すグラ
フである。第３図では横軸は速度（Ｖ）、縦軸はトルク
（Ｔ）である。すなわち、ある速度Ｖが決まると、それ
に対応する最大トルクＴｍａＸが決定される。これらの
関係はロボットの各サーボモータごとにデータとしてロ
ボット制御装置に格納されている。
フである。第３図では横軸は速度（Ｖ）、縦軸はトルク
（Ｔ）である。すなわち、ある速度Ｖが決まると、それ
に対応する最大トルクＴｍａＸが決定される。これらの
関係はロボットの各サーボモータごとにデータとしてロ
ボット制御装置に格納されている。
第４図はロボットの模式図である。ここでは、ロボット
の設置角度をθ。とじ、第１軸から第６軸目までの角度
をそれぞれθ１〜θ６とし、負荷重量をＷ、負荷重心位
置のオフセット量をＬｌ、Ｌ２とすると、各軸のイナー
シャ、静負荷トルクは以下の式で表すことができる。こ
こで、静負荷トルクは摩擦トルク、重力分トルクを含む
ものである。
の設置角度をθ。とじ、第１軸から第６軸目までの角度
をそれぞれθ１〜θ６とし、負荷重量をＷ、負荷重心位
置のオフセット量をＬｌ、Ｌ２とすると、各軸のイナー
シャ、静負荷トルクは以下の式で表すことができる。こ
こで、静負荷トルクは摩擦トルク、重力分トルクを含む
ものである。
ここで、第１軸のイナーシャを１１、第２軸のイナーシ
ャを１２、以下同様にＩ３、Ｉ２、Ｉ。
ャを１２、以下同様にＩ３、Ｉ２、Ｉ。
Ｉ６とする。また、第１軸の静負荷トルクをＴｗｌ、第
２軸の静負荷トルクをＴ Ｉ１２、以下同様に１ｗ３、
Ｔ Ｗ４、Ｔ ｗｓ、Ｔ Ｗ６とすると、これらの値は
以下の式から求められる。
２軸の静負荷トルクをＴ Ｉ１２、以下同様に１ｗ３、
Ｔ Ｗ４、Ｔ ｗｓ、Ｔ Ｗ６とすると、これらの値は
以下の式から求められる。
１、＝Ｆ、（θ２．θ３．θ４．θ５．θ６．Ｌ、、Ｌ
２．Ｗ）Ｉ２ ＝Ｆ２（θ３．θ４．θ５．θ６＋ Ｌ
ｌ＋ Ｌ ２＋ Ｗ）１、＝Ｆ、＜θ４．θ３．θ６
＋ Ｌ 、、 Ｌ ２＋ Ｗ）１、 −Ｆ４（θ５．θ
ａ、 Ｌ Ｉｔ Ｌ ２． Ｗ）■、−Ｆ５（θ６．
Ｌ Ｉｔ Ｌ２．Ｗ）１６＝ Ｆ ６ （Ｌ １． Ｌ
２＋ ｗ）Ｔｗ、＝Ｇ、（θ。、θ１．θ２．θ３．
θ１．θ６．θ６＋Ｌｌ＋Ｌ２．Ｗ） Ｔｗ２−Ｇ２（θ。、θ１．θ２．θ３．θ４．θ５．
θ６１ＬｌｌＬ２．Ｗ） １ｗ３＝Ｇ３（θ。、θ１．θ２．θ３．θ１．θ５．
θ６．ＬｌＬ、、Ｗ） Ｔ、、＝Ｇ、（θ。、θ１．θ２．θ３．θ１．θ５．
θ６＋ Ｌ ｌ＋Ｌ２．Ｗ） Ｔｗ５＝ｃ、（θ。、θ１．θ２．θ３．θ１．θ５．
θ６＋Ｌｌ＋Ｌ 、、 Ｗ） Ｔ、、＝Ｇ、（θ。、θ３．θ２．θ３．θ２．θ９．
θ６＋Ｌｌ＋Ｌ ２．Ｗ） これらの関数Ｆ１〜Ｆ、 、Ｇ、〜Ｇ６はロボットの構
造及び姿勢から計算することができる。従って、ロボッ
トがある特定の状態にあるときは、これらのイナーシャ
１１〜丁。及び静負荷トルクＴ ｗ ｌ−Ｔ ｗ ６は
ロボット制御装置内で計算によって求めることができる
。
２．Ｗ）Ｉ２ ＝Ｆ２（θ３．θ４．θ５．θ６＋ Ｌ
ｌ＋ Ｌ ２＋ Ｗ）１、＝Ｆ、＜θ４．θ３．θ６
＋ Ｌ 、、 Ｌ ２＋ Ｗ）１、 −Ｆ４（θ５．θ
ａ、 Ｌ Ｉｔ Ｌ ２． Ｗ）■、−Ｆ５（θ６．
Ｌ Ｉｔ Ｌ２．Ｗ）１６＝ Ｆ ６ （Ｌ １． Ｌ
２＋ ｗ）Ｔｗ、＝Ｇ、（θ。、θ１．θ２．θ３．
θ１．θ６．θ６＋Ｌｌ＋Ｌ２．Ｗ） Ｔｗ２−Ｇ２（θ。、θ１．θ２．θ３．θ４．θ５．
θ６１ＬｌｌＬ２．Ｗ） １ｗ３＝Ｇ３（θ。、θ１．θ２．θ３．θ１．θ５．
θ６．ＬｌＬ、、Ｗ） Ｔ、、＝Ｇ、（θ。、θ１．θ２．θ３．θ１．θ５．
θ６＋ Ｌ ｌ＋Ｌ２．Ｗ） Ｔｗ５＝ｃ、（θ。、θ１．θ２．θ３．θ１．θ５．
θ６＋Ｌｌ＋Ｌ 、、 Ｗ） Ｔ、、＝Ｇ、（θ。、θ３．θ２．θ３．θ２．θ９．
θ６＋Ｌｌ＋Ｌ ２．Ｗ） これらの関数Ｆ１〜Ｆ、 、Ｇ、〜Ｇ６はロボットの構
造及び姿勢から計算することができる。従って、ロボッ
トがある特定の状態にあるときは、これらのイナーシャ
１１〜丁。及び静負荷トルクＴ ｗ ｌ−Ｔ ｗ ６は
ロボット制御装置内で計算によって求めることができる
。
ここで、プログラム再生時に、現在位置Ｐ、、と移動目
標位置Ｐ。４１について、これらのイナーシャ及び静負
荷トルクを逐次計算する。ただし、θ。、Ｌｌ、Ｌ２、
Ｗについては、ロボットの適用動作によって異なった値
となるので、教示時に設定する。
標位置Ｐ。４１について、これらのイナーシャ及び静負
荷トルクを逐次計算する。ただし、θ。、Ｌｌ、Ｌ２、
Ｗについては、ロボットの適用動作によって異なった値
となるので、教示時に設定する。
第５図は本発明を実施するためのロボット制御装置の概
略のブロック図である。ロボット制御装置３０にはプロ
セッサボード３１があり、プロセッサボード３１にはプ
ロセッサ３１ａＸＲＯＭ３１ ｂ、ＲＡＭ３１ ｃがあ
る。プロセッサ３１ａはＲＯＭ３ ｌ ｂに格納された
システムプログラムに従って、ロボット制御装置３０全
体を制御する。
略のブロック図である。ロボット制御装置３０にはプロ
セッサボード３１があり、プロセッサボード３１にはプ
ロセッサ３１ａＸＲＯＭ３１ ｂ、ＲＡＭ３１ ｃがあ
る。プロセッサ３１ａはＲＯＭ３ ｌ ｂに格納された
システムプログラムに従って、ロボット制御装置３０全
体を制御する。
ＲＡＭ３１ Ｃには先に述べたＬｌ 、Ｌ２ 、Ｗ等の
データ、動作プログラム等が格納される。ＲＡＭ３１ｃ
の一部は不揮発性メモリとして構成されており、これ等
のデータ、動作プログラム等は不揮発性メモリ部分に格
納されている。プロセッサボード３１はバス３９に結合
されている。
データ、動作プログラム等が格納される。ＲＡＭ３１ｃ
の一部は不揮発性メモリとして構成されており、これ等
のデータ、動作プログラム等は不揮発性メモリ部分に格
納されている。プロセッサボード３１はバス３９に結合
されている。
ディジタルサーボ制御回路３２はバス３９に結合され、
プロセッサボード３１からの指令によって、サーボアン
プ３３を経由して、サーボモータ５１．５２．５３．５
４．５５及び５６を駆動する。これらのサーボモータは
ロボット１に内蔵され、ロボット１の各軸を動作させる
。
プロセッサボード３１からの指令によって、サーボアン
プ３３を経由して、サーボモータ５１．５２．５３．５
４．５５及び５６を駆動する。これらのサーボモータは
ロボット１に内蔵され、ロボット１の各軸を動作させる
。
シリアルポート３４はバス３９に結合され、表示器付き
教示操作盤５７、その他のＲ３２３２Ｃ機器５８と接続
されている。表示器付き教示操作盤は動作プログラム等
の人力に使用する。また、シリアルポートにはＣＲＴ３
６ａが接続されている。
教示操作盤５７、その他のＲ３２３２Ｃ機器５８と接続
されている。表示器付き教示操作盤は動作プログラム等
の人力に使用する。また、シリアルポートにはＣＲＴ３
６ａが接続されている。
ディジタルｌ１０３５には操作パネル３６ｂが接続され
ている。また、ディジタルｌ１０３５及びアナログ！１
０３７を経由して外部への出力信号が出力される。また
、大容量メモリ３８にはティーチングデータ、使用中以
外の動作プログラム等が格納される。
ている。また、ディジタルｌ１０３５及びアナログ！１
０３７を経由して外部への出力信号が出力される。また
、大容量メモリ３８にはティーチングデータ、使用中以
外の動作プログラム等が格納される。
上記の説明ではサーボ制御回路３２はディジタルサーボ
制御回路で説明したが、アナログサーボ制御回路でも同
様である。
制御回路で説明したが、アナログサーボ制御回路でも同
様である。
第１図は本発明のロボットの加減速時定数制御方式のフ
ローチャートである。図において、Ｓに続く数値はステ
ップ番号を示す。
ローチャートである。図において、Ｓに続く数値はステ
ップ番号を示す。
〔Ｓ１〕移動目標位置までの距離から、速度が教示速度
Ｖｔに到達するかどうか判別し、到達するときはＳ２へ
、そうでないときはＳ３へ進む。
Ｖｔに到達するかどうか判別し、到達するときはＳ２へ
、そうでないときはＳ３へ進む。
〔Ｓ２〕教示速度Ｖｔを速度Ｖとする。
〔Ｓ３〕到達速度をＶｕを以下の式から求とる。
Ｖｕ＝（ｘ−ｖｍａＸ／τ。）ｌ／２
〔Ｓ４〕到達速度Ｖｕを速度Ｖとする。
〔Ｓ５〕第３図に示すトルクカーブから、速度Ｖに対応
する最大トルクＴｍａｘを求める。
する最大トルクＴｍａｘを求める。
〔Ｓ６〕この最大トルクＴｍａｘから静負荷トルクＴ、
を減じ、加速トルクＴａを求める。現在位置の静負荷ト
ルクをＴ ｗｎ、目標位置の静負荷トルクをＴ ｗｎ＋
１とし、それぞれについて加速トルクＴａ 、、、Ｔ
ａ ｈ＋１を求める。
を減じ、加速トルクＴａを求める。現在位置の静負荷ト
ルクをＴ ｗｎ、目標位置の静負荷トルクをＴ ｗｎ＋
１とし、それぞれについて加速トルクＴａ 、、、Ｔ
ａ ｈ＋１を求める。
Ｔａｒｔ ＝Ｔｍａ ｘ −Ｔｗｎ
Ｔ ａ ｎ＋ ＋ ＝ Ｔ Ｉｎ ａ Ｘ Ｔ ｗ
ｎ＋〔Ｓ７〕加速トルクＴ ａ Ｉｔ Ｎ Ｔ ａ ｈ
＋ ＋と、現在位置のイナーシャを１．、、目標位置の
イナーシャをＩ ｎｉｌとし、それぞれについて加速度
ａ、、、ａｎ＋を求める。
ｎ＋〔Ｓ７〕加速トルクＴ ａ Ｉｔ Ｎ Ｔ ａ ｈ
＋ ＋と、現在位置のイナーシャを１．、、目標位置の
イナーシャをＩ ｎｉｌとし、それぞれについて加速度
ａ、、、ａｎ＋を求める。
ａ、 −（Ｔａ、／Ｉｎ ）
ａ ＩＩ＋Ｊ１−（Ｔ ａ ！１＋ｌ ／ Ｉ ｎｉｌ
＞ここで加速度ａとしてのａ、とａｎａ＋の小さい方
をとる。
＞ここで加速度ａとしてのａ、とａｎａ＋の小さい方
をとる。
〔Ｓ８〕加速度ａと速度Ｖから、加減速時定数τを以下
の式から計算する。
の式から計算する。
τ＝ ａ ／ Ｖ
ただし、ここでプログラムの各教示点による微調整用定
数Ａをかけて、加減速時定数等を調整することができる
。
数Ａをかけて、加減速時定数等を調整することができる
。
また、８１〜Ｓ８のステップは各軸ごとに求める。
［Ｓ９〕６軸中の最も大きいτを各軸の加減速時定数と
する。これは加減速時定数を同じ値として、ロボットの
アーム先端の軌跡が教示した軌跡からはずれないように
するためである。
する。これは加減速時定数を同じ値として、ロボットの
アーム先端の軌跡が教示した軌跡からはずれないように
するためである。
ただし、途中の軌跡を問題にしないときは、全軸の加減
速時定数を一致させる必要がなく、それぞれ各軸の最適
な加減速時定数を決定することができる。
速時定数を一致させる必要がなく、それぞれ各軸の最適
な加減速時定数を決定することができる。
上記の説明では、関節形の６軸のロボットを例に説明し
たが、その他の形式のロボットでも同様に加減速時定数
を最適な値にして、動作時間を短縮することができる。
たが、その他の形式のロボットでも同様に加減速時定数
を最適な値にして、動作時間を短縮することができる。
以上説明したように本発明では、各軸の加減速時定数を
、到達速度とイナーシャ等から決定するようにしたので
、最適な加減速時定数を決定でき、動作時間を短縮する
ことができる。
、到達速度とイナーシャ等から決定するようにしたので
、最適な加減速時定数を決定でき、動作時間を短縮する
ことができる。
第１図は本発明のロボットの加減速時定数制御方式のフ
ローチャート、 第２図はロボットの各軸の移動距離と到達速度の関係を
示すグラフ、 第３図はサーボモータの速度とトルクの関係を示すグラ
フ、 第４図はロボットの模式図、 第５図は本発明を実施するためのロボット制御装置の概
略のブロック図である。 】 ５１〜５６ ０ボツト ロボット制御装置 プロセッサボード ディジタルサーボ制御回路 サーボアンプ シリアルポート サーボモータ 教示操作盤
ローチャート、 第２図はロボットの各軸の移動距離と到達速度の関係を
示すグラフ、 第３図はサーボモータの速度とトルクの関係を示すグラ
フ、 第４図はロボットの模式図、 第５図は本発明を実施するためのロボット制御装置の概
略のブロック図である。 】 ５１〜５６ ０ボツト ロボット制御装置 プロセッサボード ディジタルサーボ制御回路 サーボアンプ シリアルポート サーボモータ 教示操作盤
Claims (5)
- （１）サーボモータの加減速時定数をブロック毎に最適
な値に決定しながら、ロボットの動作を制御するロボッ
トの加減速時定数制御方式において、ブロックの移動量
から、到達速度を求め、 前記到達速度からサーボモータの出力トルクを求め、 前記出力トルクから静負荷トルクを減じて、加速トルク
を求め、 前記加速トルクと前記サーボモータの負荷イナーシャか
ら、加速度を求め、 前記加速度から加減速時定数を決定することを特徴とす
るロボットの加減速時定数制御方式。 - （２）前記静負荷トルクを教示時に書き換え可能なパラ
メータとして、ロボットの負荷に応じて加減速時定数を
変化できるようにしたことを特徴とする請求項１記載の
ロボットの加減速時定数制御方式。 - （３）動作プログラムの各教示点で、前記加速度あるい
は前記加減速時定数を所定の定数で調整できるようにし
たことを特徴とする請求項１記載のロボットの加減速時
定数制御方式。 - （４）各サーボモータの前記加減速時定数のうちの最大
な値を選択して、全サーボモータを制御することを特徴
とする請求項１記載のロボットの加減速時定数制御方式
。 - （５）各サーボモータの前記加減速時定数を個別に決定
することを特徴とする請求項１記載のロボットの加減速
時定数制御方式。
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2136007A JPH0430203A (ja) | 1990-05-25 | 1990-05-25 | ロボットの加減速時定数制御方法 |
| EP91909370A EP0484551B1 (en) | 1990-05-25 | 1991-05-15 | Acceleration/deceleration time constant control system of robot |
| PCT/JP1991/000645 WO1991018717A1 (en) | 1990-05-25 | 1991-05-15 | Acceleration/deceleration time constant control system of robot |
| DE69114444T DE69114444T2 (de) | 1990-05-25 | 1991-05-15 | Steuersystem für Roboter mit Beschleunigungs- und Verzögerungszeitkonstanten. |
| US07/820,881 US5325467A (en) | 1990-05-25 | 1991-05-15 | Robot control method based on an acceleration/deceleration time constant |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2136007A JPH0430203A (ja) | 1990-05-25 | 1990-05-25 | ロボットの加減速時定数制御方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH0430203A true JPH0430203A (ja) | 1992-02-03 |
Family
ID=15165010
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2136007A Pending JPH0430203A (ja) | 1990-05-25 | 1990-05-25 | ロボットの加減速時定数制御方法 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US5325467A (ja) |
| EP (1) | EP0484551B1 (ja) |
| JP (1) | JPH0430203A (ja) |
| DE (1) | DE69114444T2 (ja) |
| WO (1) | WO1991018717A1 (ja) |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04335410A (ja) * | 1991-05-10 | 1992-11-24 | Fanuc Ltd | 数値制御装置 |
| WO1994028473A1 (fr) * | 1993-05-27 | 1994-12-08 | Ryo Nihei | Procede de regulation des constantes de temps d'acceleration et de deceleration d'un robot |
| WO1997001801A1 (fr) * | 1995-06-29 | 1997-01-16 | Fanuc Ltd | Procede de regulation des operations d'acceleration et de deceleration d'un robot |
| US5708342A (en) * | 1993-05-27 | 1998-01-13 | Fanuc Ltd. | Method of controlling acceleration/deceleration time constants for robot |
| JPH11102215A (ja) * | 1997-09-26 | 1999-04-13 | Matsushita Electric Ind Co Ltd | 制御装置と制御方法およびフィルタ装置とフィルタ方法 |
| JP2014504560A (ja) * | 2011-02-07 | 2014-02-24 | デュール システムズ ゲゼルシャフト ミット ベシュレンクテル ハフツング | 少なくとも一つのロボットの動力学の適合 |
| CN104234757A (zh) * | 2013-06-17 | 2014-12-24 | 阿尔斯通技术有限公司 | 蒸汽涡轮中的低体积流不稳定性的控制 |
| JP2018008326A (ja) * | 2016-07-12 | 2018-01-18 | ファナック株式会社 | ロボットの重心表示装置、ロボット制御装置およびロボットシミュレーション装置 |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH08137524A (ja) * | 1994-11-09 | 1996-05-31 | Fanuc Ltd | ロボットの軌道計画時における時定数の設定方法 |
| US5740327A (en) * | 1994-12-27 | 1998-04-14 | Nec Corporation | Method of and apparatus for robot tip trajectory control |
| EP0788042B1 (en) * | 1995-08-23 | 1999-12-15 | Fanuc Ltd | Cnc acceleration/deceleration controller and method |
| SE505981C2 (sv) * | 1996-02-14 | 1997-10-27 | Asea Brown Boveri | Förfarande för styrning av en industrirobot med hänsyn till moment och belastning |
| US6900608B2 (en) * | 2003-04-17 | 2005-05-31 | Automated Assemblies Corporation | Apparatus for controlling a motor |
| JP2017052016A (ja) * | 2015-09-07 | 2017-03-16 | セイコーエプソン株式会社 | ロボット、制御装置およびロボットシステム |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6231406A (ja) * | 1985-08-02 | 1987-02-10 | Matsushita Electric Ind Co Ltd | 多関節ロボツトの位置決め制御装置 |
| JPH0212407A (ja) * | 1988-06-30 | 1990-01-17 | Okuma Mach Works Ltd | 数値制御装置 |
Family Cites Families (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS54123673A (en) * | 1978-03-16 | 1979-09-26 | Fanuc Ltd | Positioning control system |
| JPS57189789A (en) * | 1981-05-16 | 1982-11-22 | Toyama Machine Works | Controller for speed of industrial robot |
| JPS58149188A (ja) * | 1982-02-26 | 1983-09-05 | 神鋼電機株式会社 | 搬送ロボツト |
| JPS5962909A (ja) * | 1982-10-01 | 1984-04-10 | Fanuc Ltd | 加減速装置 |
| JPS59168513A (ja) * | 1983-03-16 | 1984-09-22 | Fanuc Ltd | 加減速制御方式 |
| JPH0632914B2 (ja) * | 1983-06-29 | 1994-05-02 | 新明和工業株式会社 | 産業用ロボツト |
| JPS6261104A (ja) * | 1985-09-11 | 1987-03-17 | Fanuc Ltd | 水平関節型ロボツトの加減速制御方式 |
| EP0262600B1 (en) * | 1986-09-29 | 1992-11-25 | Asea Ab | Method and device for optimum parameter control of controllers for rotational and/or linear movements in one or more degrees of freedom in an industrial robot |
| US4908556A (en) * | 1986-11-20 | 1990-03-13 | Unimation Inc. | Modular robot control system |
| JPS63273108A (ja) * | 1987-04-30 | 1988-11-10 | Fanuc Ltd | 速度制御装置 |
| JP2707087B2 (ja) * | 1987-09-09 | 1998-01-28 | ファナック株式会社 | ロボット制御装置 |
| US5166872A (en) * | 1989-07-17 | 1992-11-24 | Ability Technologies Corporation | System and method for controlling devices through communication processors and pluralities of address-associated device controllers sharing each communication processor |
-
1990
- 1990-05-25 JP JP2136007A patent/JPH0430203A/ja active Pending
-
1991
- 1991-05-15 DE DE69114444T patent/DE69114444T2/de not_active Expired - Fee Related
- 1991-05-15 EP EP91909370A patent/EP0484551B1/en not_active Expired - Lifetime
- 1991-05-15 WO PCT/JP1991/000645 patent/WO1991018717A1/ja active IP Right Grant
- 1991-05-15 US US07/820,881 patent/US5325467A/en not_active Expired - Lifetime
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6231406A (ja) * | 1985-08-02 | 1987-02-10 | Matsushita Electric Ind Co Ltd | 多関節ロボツトの位置決め制御装置 |
| JPH0212407A (ja) * | 1988-06-30 | 1990-01-17 | Okuma Mach Works Ltd | 数値制御装置 |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04335410A (ja) * | 1991-05-10 | 1992-11-24 | Fanuc Ltd | 数値制御装置 |
| WO1994028473A1 (fr) * | 1993-05-27 | 1994-12-08 | Ryo Nihei | Procede de regulation des constantes de temps d'acceleration et de deceleration d'un robot |
| US5708342A (en) * | 1993-05-27 | 1998-01-13 | Fanuc Ltd. | Method of controlling acceleration/deceleration time constants for robot |
| WO1997001801A1 (fr) * | 1995-06-29 | 1997-01-16 | Fanuc Ltd | Procede de regulation des operations d'acceleration et de deceleration d'un robot |
| US5811952A (en) * | 1995-06-29 | 1998-09-22 | Fanuc Ltd. | Method of setting accelerating/decelerating motion of robot |
| JPH11102215A (ja) * | 1997-09-26 | 1999-04-13 | Matsushita Electric Ind Co Ltd | 制御装置と制御方法およびフィルタ装置とフィルタ方法 |
| JP2014504560A (ja) * | 2011-02-07 | 2014-02-24 | デュール システムズ ゲゼルシャフト ミット ベシュレンクテル ハフツング | 少なくとも一つのロボットの動力学の適合 |
| CN104234757A (zh) * | 2013-06-17 | 2014-12-24 | 阿尔斯通技术有限公司 | 蒸汽涡轮中的低体积流不稳定性的控制 |
| JP2018008326A (ja) * | 2016-07-12 | 2018-01-18 | ファナック株式会社 | ロボットの重心表示装置、ロボット制御装置およびロボットシミュレーション装置 |
| US10302519B2 (en) | 2016-07-12 | 2019-05-28 | Fanuc Corporation | Robot center-of-gravity display device, robot control device, and robot simulation device |
Also Published As
| Publication number | Publication date |
|---|---|
| EP0484551A1 (en) | 1992-05-13 |
| EP0484551A4 (en) | 1993-03-17 |
| WO1991018717A1 (en) | 1991-12-12 |
| EP0484551B1 (en) | 1995-11-08 |
| DE69114444D1 (de) | 1995-12-14 |
| DE69114444T2 (de) | 1996-03-21 |
| US5325467A (en) | 1994-06-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPH0430203A (ja) | ロボットの加減速時定数制御方法 | |
| KR910009266B1 (ko) | 산업용 로보트의 속도 제어방법 및 장치 | |
| JP3083870B2 (ja) | 数値制御装置 | |
| US5708342A (en) | Method of controlling acceleration/deceleration time constants for robot | |
| EP0240570B1 (en) | Acceleration and deceleration control system for horizontal-joint robots | |
| JPH04306711A (ja) | 加減速パターン生成装置及びパターン生成方法 | |
| JPH0991004A (ja) | 負荷重量の推定方法 | |
| JPH06337708A (ja) | ロボットの加減速時定数制御方式 | |
| JP2000094371A (ja) | ロボットの最短時間制御装置 | |
| JP2507891B2 (ja) | マニピュレ―タのインピ―ダンス制御方式 | |
| JP3339642B2 (ja) | ロボットの加減速時定数決定方法 | |
| JPH07244520A (ja) | 干渉トルクを考慮した自動機械の加減速制御方法 | |
| JPH08190433A (ja) | 負荷重量推定方法 | |
| JPH0639066B2 (ja) | 産業用ロボツトの制御方法 | |
| JPH08137524A (ja) | ロボットの軌道計画時における時定数の設定方法 | |
| JPS61159391A (ja) | 産業用ロボツトの制御方法 | |
| JPH07223185A (ja) | 産業用ロボット制御方法およびその装置 | |
| JPH08263128A (ja) | ロボットの位置決め制御時の加減速制御方法 | |
| JPH07261822A (ja) | ロボットの加減速時間決定方法および加減速制御方法 | |
| JPS60220408A (ja) | 関節形ロボツト用制御装置 | |
| JPH06214656A (ja) | 制振要素を持つスライディングモード制御方法 | |
| JPS6272007A (ja) | ロボツトの緩衝制御方法 | |
| JP2000084878A (ja) | ロボットの制御装置 | |
| JPH01263803A (ja) | ロボットの教示方法 | |
| JPH03234490A (ja) | ロボットの制御方法 |