JP2740691B2 - 制御方法 - Google Patents
制御方法Info
- Publication number
- JP2740691B2 JP2740691B2 JP2220317A JP22031790A JP2740691B2 JP 2740691 B2 JP2740691 B2 JP 2740691B2 JP 2220317 A JP2220317 A JP 2220317A JP 22031790 A JP22031790 A JP 22031790A JP 2740691 B2 JP2740691 B2 JP 2740691B2
- Authority
- JP
- Japan
- Prior art keywords
- robot
- control
- speed
- signal
- pattern
- 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.)
- Expired - Fee Related
Links
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Control Of Position Or Direction (AREA)
- Numerical Control (AREA)
Description
【発明の詳細な説明】 〔産業上の利用分野〕 本発明はロボットの複数の制御対象の動作を制御する
制御方法に関する。
制御方法に関する。
従来、ロボットの複数の制御対象の各動作を制御して
この各動作の合成によりロボットに所望の動作を実行さ
せる場合には、ロボットに所望の動作を実行させる動作
指令パターンを制御対象ごとに複数のサーボ系に入力
し、この複数のサーボ系で入力に追従して複数の制御対
象をそれぞれ制御している。また、例えば第10図に示す
ようにロボットのX/Y軸方向の水平動作aとZ軸方向の
挿入動作bとの複合動作を高速に行わせる場合は、経路
Cを通るようにロボットを動作させるために、挿入動作
bを開始させるタイミングdをロボットの水平動作aに
よる移動距離によって決定していた。この場合、ロボッ
トが部品を確実に挿入するためにはロボットの挿入時の
Z軸方向の動作ZEの直線性を確保することが必要であ
り、このZ軸方向の動作ZEの直線性を確保するために、
試行錯誤しながらタイミングdを決めていた。
この各動作の合成によりロボットに所望の動作を実行さ
せる場合には、ロボットに所望の動作を実行させる動作
指令パターンを制御対象ごとに複数のサーボ系に入力
し、この複数のサーボ系で入力に追従して複数の制御対
象をそれぞれ制御している。また、例えば第10図に示す
ようにロボットのX/Y軸方向の水平動作aとZ軸方向の
挿入動作bとの複合動作を高速に行わせる場合は、経路
Cを通るようにロボットを動作させるために、挿入動作
bを開始させるタイミングdをロボットの水平動作aに
よる移動距離によって決定していた。この場合、ロボッ
トが部品を確実に挿入するためにはロボットの挿入時の
Z軸方向の動作ZEの直線性を確保することが必要であ
り、このZ軸方向の動作ZEの直線性を確保するために、
試行錯誤しながらタイミングdを決めていた。
また、ロボットに第4図に示すようなアーミモーショ
ンを実行させる場合、そのZ軸方向の直線部分ZSを保証
することは比較的容易であり、サーボ系において、Z軸
についての速度指令パルスと,Z軸についてのフィードバ
ックパルスとを管理することで、制御対象のX/Y軸方向
の動作開始タイミングを決めることができる。つまり、
第4図に示すように制御対象からZ軸についてのフィー
ドバックパルスをサンプリングしてロボットがS点から
ZSだけ移動したタイミングS′を求め、このタイミング
S′でロボットX/Y軸方向の動作を開始させればよい。
ンを実行させる場合、そのZ軸方向の直線部分ZSを保証
することは比較的容易であり、サーボ系において、Z軸
についての速度指令パルスと,Z軸についてのフィードバ
ックパルスとを管理することで、制御対象のX/Y軸方向
の動作開始タイミングを決めることができる。つまり、
第4図に示すように制御対象からZ軸についてのフィー
ドバックパルスをサンプリングしてロボットがS点から
ZSだけ移動したタイミングS′を求め、このタイミング
S′でロボットX/Y軸方向の動作を開始させればよい。
従来は上述の如く第10図に示すロボットのX/Y軸方向
の水平動作aとZ軸方向の挿入動作bとの複合動作を高
速に行わせる場合にはZ軸方向の動作ZEの直線性を確保
するために、試行錯誤しながらタイミングdを決めてい
たので、このような複合動作が多い場合は試行錯誤する
回数が著しく増加し、ほとんど実行不可能となってい
る。また、Z軸方向の動作ZEの直線性を保証することは
ロボットの実軌道の未近予測という問題であり、Z軸方
向の動作ZEの直線性を完全に保証することは不可能であ
る。
の水平動作aとZ軸方向の挿入動作bとの複合動作を高
速に行わせる場合にはZ軸方向の動作ZEの直線性を確保
するために、試行錯誤しながらタイミングdを決めてい
たので、このような複合動作が多い場合は試行錯誤する
回数が著しく増加し、ほとんど実行不可能となってい
る。また、Z軸方向の動作ZEの直線性を保証することは
ロボットの実軌道の未近予測という問題であり、Z軸方
向の動作ZEの直線性を完全に保証することは不可能であ
る。
本発明は上記欠点を改善し、複数の制御対象の各動作
の合成でロボットに所望の動作を行わせる上で、複数の
制御対象の各動作の発生タイミングを精度良く、しかも
簡単に設定することができる制御方法を提供することを
目的とする。
の合成でロボットに所望の動作を行わせる上で、複数の
制御対象の各動作の発生タイミングを精度良く、しかも
簡単に設定することができる制御方法を提供することを
目的とする。
上記目的を達成するため、本発明は、複数の制御対象
を有するロボットに水平動作と垂直動作との複合動作を
実行させる動作指令パターンを前記制御対象ごとに複数
のサーボ系に入力し、この複数のサーボ系で入力に追従
して前記複数の制御対象をそれぞれ制御する制御方法に
おいて、 第1図に示すように前記複数のサーボ系の各伝達関数
を一次の伝達関数に近似させ、前記動作指令パターンに
対する前記制御対象の実際の各動作パターンを求めてこ
の求めた各動作パターンと前記一次の伝達関数による遅
れ時間に基づいて前記ロボットに前記複合動作を実行さ
せるための動作起動タイミングを計算し、前記制御対象
の各動作を前記サーボ系により前記動作起動タイミング
に従って実行させてこの各動作の合成により前記ロボッ
トに前記複合動作を実行させる。
を有するロボットに水平動作と垂直動作との複合動作を
実行させる動作指令パターンを前記制御対象ごとに複数
のサーボ系に入力し、この複数のサーボ系で入力に追従
して前記複数の制御対象をそれぞれ制御する制御方法に
おいて、 第1図に示すように前記複数のサーボ系の各伝達関数
を一次の伝達関数に近似させ、前記動作指令パターンに
対する前記制御対象の実際の各動作パターンを求めてこ
の求めた各動作パターンと前記一次の伝達関数による遅
れ時間に基づいて前記ロボットに前記複合動作を実行さ
せるための動作起動タイミングを計算し、前記制御対象
の各動作を前記サーボ系により前記動作起動タイミング
に従って実行させてこの各動作の合成により前記ロボッ
トに前記複合動作を実行させる。
第3図は本発明により制御される水平旋回アームロボ
ットの例を示す。
ットの例を示す。
このロボットはロボット本体1に対して水平方向に旋
回可能に設けられた第1のアーム2と、この第1のアー
ム2の先端部に取付けられた垂直軸の関節を中心として
回転自在に設けられた第2のアーム3と、第2のアーム
3の先端部分に上下動自在に設けられたZ軸4とを備
え、第1のアーム2及び第2のアーム3は垂直軸の関節
を中心として水平方向に旋回自在に支持されている。第
1のアーム2及び第2のアーム3はそれぞれ関節軸上で
モータからなる直接駆動方式の駆動源5,6により駆動さ
れて旋回し、Z軸4は第2のアーム3に水平方向旋回軸
と平行に取付けられたモータからなる駆動源7によりプ
ーリ,ベルト,送りねじなどの伝達手段8を介して駆動
されて上下方向に移動する。上記モータ5,6,7は制御装
置9により制御される。
回可能に設けられた第1のアーム2と、この第1のアー
ム2の先端部に取付けられた垂直軸の関節を中心として
回転自在に設けられた第2のアーム3と、第2のアーム
3の先端部分に上下動自在に設けられたZ軸4とを備
え、第1のアーム2及び第2のアーム3は垂直軸の関節
を中心として水平方向に旋回自在に支持されている。第
1のアーム2及び第2のアーム3はそれぞれ関節軸上で
モータからなる直接駆動方式の駆動源5,6により駆動さ
れて旋回し、Z軸4は第2のアーム3に水平方向旋回軸
と平行に取付けられたモータからなる駆動源7によりプ
ーリ,ベルト,送りねじなどの伝達手段8を介して駆動
されて上下方向に移動する。上記モータ5,6,7は制御装
置9により制御される。
第2図は上記制御装置9の構成を示す。
制御装置9はモータ5,6,7に対応したサーボ系10,11,1
2とコントローラ13とで構成され、サーボ系10,11,12は
それぞれコントローラ13からの指令信号によりモータ5,
6,7と機構部2,3,4からなる制御対象を制御する。
2とコントローラ13とで構成され、サーボ系10,11,12は
それぞれコントローラ13からの指令信号によりモータ5,
6,7と機構部2,3,4からなる制御対象を制御する。
サーボ系10は位置制御手段14,速度制御手段15,ドライ
バー16,速度変換手段17及び位置変換手段18により構成
され、サーボ系11,12は上記サーボ系10と同様に構成さ
れている。また、各モータ5,6,7の軸にはパルスジェネ
レータ19,20,21が取付けられ、このパルスジェネレータ
19,20,21はそれぞれモータ5,6,7の現在位置(回転角)
を検出する。なお、パルスジェネレータ19,20,21はモー
タ5,6,7の現在位置を検出する磁気センサなどを用いて
もよい。
バー16,速度変換手段17及び位置変換手段18により構成
され、サーボ系11,12は上記サーボ系10と同様に構成さ
れている。また、各モータ5,6,7の軸にはパルスジェネ
レータ19,20,21が取付けられ、このパルスジェネレータ
19,20,21はそれぞれモータ5,6,7の現在位置(回転角)
を検出する。なお、パルスジェネレータ19,20,21はモー
タ5,6,7の現在位置を検出する磁気センサなどを用いて
もよい。
サーボ系10において、位置変換手段14はパルスジェネ
レータ19からのパルス信号をモータ5の現在位置に比例
したパルス信号に変換して比較部22へフィードバックす
る。位置制御手段14はコントローラ13からの指令信号と
位置変換手段18からのパルス信号とを比較部22で比較し
てその差分を速度制御手段15へ出力し、最終的にモータ
5を目標位置に動かす役割を果たす。制御対象2,5が目
標位置に来ると、比較部22の比較結果が0となるが、制
御対象2,5は慣性によって目標位置を通り越してしま
い、制御対象2,5が目標位置からはずれるほど位置変換
手段18からのフィードバック量が増加して制御対象2,5
を目標位置に戻そうとする力が増加することによってバ
ネのような働きがなされる。
レータ19からのパルス信号をモータ5の現在位置に比例
したパルス信号に変換して比較部22へフィードバックす
る。位置制御手段14はコントローラ13からの指令信号と
位置変換手段18からのパルス信号とを比較部22で比較し
てその差分を速度制御手段15へ出力し、最終的にモータ
5を目標位置に動かす役割を果たす。制御対象2,5が目
標位置に来ると、比較部22の比較結果が0となるが、制
御対象2,5は慣性によって目標位置を通り越してしま
い、制御対象2,5が目標位置からはずれるほど位置変換
手段18からのフィードバック量が増加して制御対象2,5
を目標位置に戻そうとする力が増加することによってバ
ネのような働きがなされる。
速度制御手段15は位置制御手段14からのバネ力の信号
に対して制御対象2,5の速度に比例した信号を減算す
る。具体的にはパルスジェネレータ19からのパルス信号
が速度変換手段17によりF/V変換(パルス周波数/電圧
変換)されて比較部23へフィードバックされ、速度制御
手段15が位置制御手段14からのバネ力の信号に対して速
度変換手段17の出力信号を比較部22で減算してドライバ
ー16へ出力する。これは位置制御手段15,19によるバネ
力のような振動を抑えるためのものであり、モータ5を
目標位置に高速でかつ精度良く到達させる。モータ5の
軸位置が目標位置に来た時には、比較部23の比較結果が
0となるが、速度変換手段17からのフィードバックがか
かっていると、その時の制御対象2,5の速度が大きいほ
ど、モータ5を逆に回転させるような力が大きく働いて
慣性力に対して制動がかかり、ダンパの働きをする。
に対して制御対象2,5の速度に比例した信号を減算す
る。具体的にはパルスジェネレータ19からのパルス信号
が速度変換手段17によりF/V変換(パルス周波数/電圧
変換)されて比較部23へフィードバックされ、速度制御
手段15が位置制御手段14からのバネ力の信号に対して速
度変換手段17の出力信号を比較部22で減算してドライバ
ー16へ出力する。これは位置制御手段15,19によるバネ
力のような振動を抑えるためのものであり、モータ5を
目標位置に高速でかつ精度良く到達させる。モータ5の
軸位置が目標位置に来た時には、比較部23の比較結果が
0となるが、速度変換手段17からのフィードバックがか
かっていると、その時の制御対象2,5の速度が大きいほ
ど、モータ5を逆に回転させるような力が大きく働いて
慣性力に対して制動がかかり、ダンパの働きをする。
サーボ系11,12もサーボ系10と同様に動作する。
ここで、サーボ系10,11,12は高次の系(内部に積分要
素を多く持っている系)であるが、位置制御手段14,モ
ータ5,パルスジェネレータ19,位置変換手段18を含む位
置制御ループのループゲインKp比べてに速度制御手段1
5,ドライバー16,モータ5,パルスジェネレータ19,速度変
換手段17を含む速度制御ループAのループケインKがKp
≪Kである場合には、速度制御ループAは積分要素のな
いただのゲイン1(K=1)の要素に近似できる。した
がって、サーボ系10,11,12の全体はそれぞれ発振のない
1次の系とみなすことができ、伝達関数でみれば第8図
に示すような1次フィルタとなる。なお、サーボ系10,1
1,12はそれぞれ位置制御ループのループゲインKpが大き
いほど、追従性の良い高性能なサーボ系となるが、不安
定な系ともなって制御対象2,3,4が振動を起こし易くな
る。また、Kpはシステム全体(制御装置9,モータや機械
を含むシステム)の特性により制限を受ける。ここに、
サーボ系10,11,12の伝達関数は一次の伝達関数とみなす
のであり、この伝達関数は逆伝達関数ではない。
素を多く持っている系)であるが、位置制御手段14,モ
ータ5,パルスジェネレータ19,位置変換手段18を含む位
置制御ループのループゲインKp比べてに速度制御手段1
5,ドライバー16,モータ5,パルスジェネレータ19,速度変
換手段17を含む速度制御ループAのループケインKがKp
≪Kである場合には、速度制御ループAは積分要素のな
いただのゲイン1(K=1)の要素に近似できる。した
がって、サーボ系10,11,12の全体はそれぞれ発振のない
1次の系とみなすことができ、伝達関数でみれば第8図
に示すような1次フィルタとなる。なお、サーボ系10,1
1,12はそれぞれ位置制御ループのループゲインKpが大き
いほど、追従性の良い高性能なサーボ系となるが、不安
定な系ともなって制御対象2,3,4が振動を起こし易くな
る。また、Kpはシステム全体(制御装置9,モータや機械
を含むシステム)の特性により制限を受ける。ここに、
サーボ系10,11,12の伝達関数は一次の伝達関数とみなす
のであり、この伝達関数は逆伝達関数ではない。
次に、制御装置9の動作について説明する。
水平旋回アームロボットの旋回運動は第1のアーム2,
第2のアーム3,伝達手段8毎にコントローラ13からの指
令信号により制御される。コントローラ13は第11図に示
すようにキーボード等から入力された制御対象について
の移動距離,速度,加速度,直線距離等のデータにより
各サーボ系10,11,12の動作パターン及び動作タイミング
を算出し、各サーボ系10,11,12に対してその動作タイミ
ングで動作パターンを出力して制御対象を目標値に位置
決めさせる。
第2のアーム3,伝達手段8毎にコントローラ13からの指
令信号により制御される。コントローラ13は第11図に示
すようにキーボード等から入力された制御対象について
の移動距離,速度,加速度,直線距離等のデータにより
各サーボ系10,11,12の動作パターン及び動作タイミング
を算出し、各サーボ系10,11,12に対してその動作タイミ
ングで動作パターンを出力して制御対象を目標値に位置
決めさせる。
今、コントローラ13が第1のアーム2に所定の回転角
に相当する位置指令信号(パルス数信号)をサーボ系10
に与えると、この位置指令信号はサーボ系10において、
位置制御手段14により速度指令信号に変換され、さら
に、速度制御手段15によりトルク指令信号に変換され
る。ドライバー16は速度制御手段15からトルク指令信号
が入力されてこのトルク指令信号を対応する電流を発生
し、この電流でモータ5を回転させて第1のアーム2を
駆動する。また、パルスジェネレータ19はモータ5の現
在位置を検出してモータ5の現在位置に比例したパルス
数信号を出力する。このパルスジェネレータ19からのパ
ルス信号は位置変換手段18により位置信号に変換されて
比較部22に入力され、コントローラ13からの位置指令信
号と位置交換手段18からの位置信号との偏差が求められ
る。位置制御手段14はその偏差に対応した信号、即ち、
偏差量を0にするような信号を出力する。
に相当する位置指令信号(パルス数信号)をサーボ系10
に与えると、この位置指令信号はサーボ系10において、
位置制御手段14により速度指令信号に変換され、さら
に、速度制御手段15によりトルク指令信号に変換され
る。ドライバー16は速度制御手段15からトルク指令信号
が入力されてこのトルク指令信号を対応する電流を発生
し、この電流でモータ5を回転させて第1のアーム2を
駆動する。また、パルスジェネレータ19はモータ5の現
在位置を検出してモータ5の現在位置に比例したパルス
数信号を出力する。このパルスジェネレータ19からのパ
ルス信号は位置変換手段18により位置信号に変換されて
比較部22に入力され、コントローラ13からの位置指令信
号と位置交換手段18からの位置信号との偏差が求められ
る。位置制御手段14はその偏差に対応した信号、即ち、
偏差量を0にするような信号を出力する。
また、パルスジェネレータ19からのパルス数信号は速
度変換手段17により速度信号に変換されて比較部23に入
力され、位置制御手段14の出力信号と速度変換手段17か
らの速度信号との偏差が求められる。速度制御手段15は
その偏差が0となるような信号をドライバー16へ出力す
る。
度変換手段17により速度信号に変換されて比較部23に入
力され、位置制御手段14の出力信号と速度変換手段17か
らの速度信号との偏差が求められる。速度制御手段15は
その偏差が0となるような信号をドライバー16へ出力す
る。
このような動作によりサーボ系10はモータ5及び第1
のアームに対してコントローラ13からの指令信号により
応答遅れのない制御を行う。
のアームに対してコントローラ13からの指令信号により
応答遅れのない制御を行う。
サーボ系11,12もサーボ系10と同様にコントローラ13
からの指令信号によりモータ6,7及び第2のアーム,3,Z
軸4の制御を行う。
からの指令信号によりモータ6,7及び第2のアーム,3,Z
軸4の制御を行う。
上記制御装置9は例えばロボットに第4図に示すよう
なアーチモーションを実行させる場合にはサーボ系10,1
1,12をそれぞれ第8図に示すような1次フィルタに近似
してZ軸4の起動タイミングdを算出することにより、
高い精度と確率でロボットのZ軸方向の動作ZEの直線性
を保証している。
なアーチモーションを実行させる場合にはサーボ系10,1
1,12をそれぞれ第8図に示すような1次フィルタに近似
してZ軸4の起動タイミングdを算出することにより、
高い精度と確率でロボットのZ軸方向の動作ZEの直線性
を保証している。
制御装置9がロボットに第4図に示すようなアーチモ
ーションを実行させる場合には、ロボットのX/Y軸方向
動作(第1のアーム2及び第2のアーム3の動作)が始
点S′より開始されてからタイミングdでロボットのZ
軸方向動作(Z軸4の動作)が開始されるまでの時間tS
を求めるのが問題であるが、このtSは第6図に示すよう
にtc,tf,teに分解して tS=(tc+tf)−te ……(1) と表わすことができる。ここに、tcはロボットのX/Y軸
方向動作開始点S′からX/Y軸方向動作に対する指令終
了点(コントローラ13からサーボ系10,12への指令信号
が両方とも終了する点)までの時間であり、これはコン
トローラ13においてX/Y軸方向動作の開始前に知ること
ができる。tfはX/Y軸方向動作に対する指令終了点から
実際に制御対象2,3のX/Y軸方向動作が終了するまでの遅
れ時間であり、コントローラ13で予測する部分である。
このtfはコントローラ13からのサーボ系10,11への指令
信号に対する1次フィルタ10,11の出力信号から算出す
ることができる。例えば第9図に示すような台形速度パ
ターンの指令信号に対して時定数1/Kp secの1次フィル
タをかけた時には指令信号パターンの終了から、1次フ
ィルタから出力される残りのパルスがPeとなるまでの時
間tfは次の(2)式で与えられる。
ーションを実行させる場合には、ロボットのX/Y軸方向
動作(第1のアーム2及び第2のアーム3の動作)が始
点S′より開始されてからタイミングdでロボットのZ
軸方向動作(Z軸4の動作)が開始されるまでの時間tS
を求めるのが問題であるが、このtSは第6図に示すよう
にtc,tf,teに分解して tS=(tc+tf)−te ……(1) と表わすことができる。ここに、tcはロボットのX/Y軸
方向動作開始点S′からX/Y軸方向動作に対する指令終
了点(コントローラ13からサーボ系10,12への指令信号
が両方とも終了する点)までの時間であり、これはコン
トローラ13においてX/Y軸方向動作の開始前に知ること
ができる。tfはX/Y軸方向動作に対する指令終了点から
実際に制御対象2,3のX/Y軸方向動作が終了するまでの遅
れ時間であり、コントローラ13で予測する部分である。
このtfはコントローラ13からのサーボ系10,11への指令
信号に対する1次フィルタ10,11の出力信号から算出す
ることができる。例えば第9図に示すような台形速度パ
ターンの指令信号に対して時定数1/Kp secの1次フィル
タをかけた時には指令信号パターンの終了から、1次フ
ィルタから出力される残りのパルスがPeとなるまでの時
間tfは次の(2)式で与えられる。
である。また、teはZ軸4が起動されてからロボットの
動作終了点EよりZEを残した点までの時間であり、第7
図に示すようにtecとtqとに分解できる。tecは指令信号
パターンにおいてZ軸4が起動されてからロボットの動
作終了点EよりZEを残した点までの時間であり、コント
ローラ13が指令信号パターンを出力する前に計算するこ
とが可能である。tqはtecに対する制御対象の実動作の
遅れ時間であり、コントローラ13で予測する時間であ
る。このtqはコントローラ13からのサーボ系12への指令
信号に対する1次フィルタ12の出力信号から(2)式で
算出することができるが、実際上は時間を解とする逆演
算が行えないので、予め速度指令パターンとtqとの関係
を示すテーブルを作成してこのテーブルのデータを補間
することにより算出する。
動作終了点EよりZEを残した点までの時間であり、第7
図に示すようにtecとtqとに分解できる。tecは指令信号
パターンにおいてZ軸4が起動されてからロボットの動
作終了点EよりZEを残した点までの時間であり、コント
ローラ13が指令信号パターンを出力する前に計算するこ
とが可能である。tqはtecに対する制御対象の実動作の
遅れ時間であり、コントローラ13で予測する時間であ
る。このtqはコントローラ13からのサーボ系12への指令
信号に対する1次フィルタ12の出力信号から(2)式で
算出することができるが、実際上は時間を解とする逆演
算が行えないので、予め速度指令パターンとtqとの関係
を示すテーブルを作成してこのテーブルのデータを補間
することにより算出する。
そこで、制御装置9は上記(1)式のtS=(tc+tf)
−teによりtSを求める。この場合、制御装置9はtcを指
令信号パターンより算出し、tfを指令信号パターンと
(2)式により算出する。さらに、制御装置9はteを上
述のようにtecとtqとに分解してtecを指令信号パターン
より算出し、tqを上述のようにテーブルを用いて算出す
る。そして、制御装置9はtSに従ってサーボ系12への指
令信号パターンを出力して挿入動作bをタイミングdで
開始させる。
−teによりtSを求める。この場合、制御装置9はtcを指
令信号パターンより算出し、tfを指令信号パターンと
(2)式により算出する。さらに、制御装置9はteを上
述のようにtecとtqとに分解してtecを指令信号パターン
より算出し、tqを上述のようにテーブルを用いて算出す
る。そして、制御装置9はtSに従ってサーボ系12への指
令信号パターンを出力して挿入動作bをタイミングdで
開始させる。
この制御装置9ではロボットへの指令信号を発生する
段階で挿入動作bの開始タイミングdを予め決定するの
で、ロボットのプログラム上で動作記述とともに直線性
を保ちたい部分ZEの情報を書き込むことで、試行錯誤を
せずに発生タイミングdを精度良く、しかも簡単に設定
することができ、ロボットの高速で高い軌跡精度の複合
動作が可能となる。
段階で挿入動作bの開始タイミングdを予め決定するの
で、ロボットのプログラム上で動作記述とともに直線性
を保ちたい部分ZEの情報を書き込むことで、試行錯誤を
せずに発生タイミングdを精度良く、しかも簡単に設定
することができ、ロボットの高速で高い軌跡精度の複合
動作が可能となる。
なお、上記ロボットは直接駆動方式の水平関節型ロボ
ットであるが、本発明は減速駆動方式の水平多関節型ロ
ボット,円筒座標系のロボットのように水平旋回方向の
アームを有するロボットにも同様に適用することができ
る。また、上記モータ7は上下方向のZ軸4に限らず、
他の回転部分、例えばチャックなどアーム以外の回転部
分を駆動する回転駆動源であってもよい。また、上記コ
ントローラ13からの指令信号やサーボ系の応答信号はパ
ルス、即ちデジタルであるが、アナログ信号であっても
よい。
ットであるが、本発明は減速駆動方式の水平多関節型ロ
ボット,円筒座標系のロボットのように水平旋回方向の
アームを有するロボットにも同様に適用することができ
る。また、上記モータ7は上下方向のZ軸4に限らず、
他の回転部分、例えばチャックなどアーム以外の回転部
分を駆動する回転駆動源であってもよい。また、上記コ
ントローラ13からの指令信号やサーボ系の応答信号はパ
ルス、即ちデジタルであるが、アナログ信号であっても
よい。
以上のように本発明によれば、複数の制御対象を有す
るロボットに水平動作と垂直動作との複合動作を実行さ
せる動作指令パターンを前記制御対象ごとに複数のサー
ボ系に入力し、この複数のサーボ系で入力に追従して前
記複数の制御対象をそれぞれ制御する制御方法におい
て、 前記複数のサーボ系の各伝達関数を一次の伝達関数に
近似させ、前記動作指令パターンに対する前記制御対象
の実際の各動作パターンを求めてこの求めた各動作パタ
ーンと前記一次の伝達関数による遅れ時間に基づいて前
記ロボットに前記複合動作を実行させるための動作起動
タイミングを計算し、前記制御対象の各動作を前記サー
ボ系により前記動作起動タイミングに従って実行させて
この各動作の合成により前記ロボットに前記複合動作を
実行させるので、試行錯誤をせずに複数の制御対象の各
動作の発生タイミングを精度良く、しかも簡単に設定す
ることができ、ロボットの高速で高い軌跡精度の複合動
作が可能となる。
るロボットに水平動作と垂直動作との複合動作を実行さ
せる動作指令パターンを前記制御対象ごとに複数のサー
ボ系に入力し、この複数のサーボ系で入力に追従して前
記複数の制御対象をそれぞれ制御する制御方法におい
て、 前記複数のサーボ系の各伝達関数を一次の伝達関数に
近似させ、前記動作指令パターンに対する前記制御対象
の実際の各動作パターンを求めてこの求めた各動作パタ
ーンと前記一次の伝達関数による遅れ時間に基づいて前
記ロボットに前記複合動作を実行させるための動作起動
タイミングを計算し、前記制御対象の各動作を前記サー
ボ系により前記動作起動タイミングに従って実行させて
この各動作の合成により前記ロボットに前記複合動作を
実行させるので、試行錯誤をせずに複数の制御対象の各
動作の発生タイミングを精度良く、しかも簡単に設定す
ることができ、ロボットの高速で高い軌跡精度の複合動
作が可能となる。
第1図は本発明を示すフローチャート、第2図は本発明
の実施に用いた装置の一例を示すブロック図、第3図は
本発明により制御される水平旋回アームロボットの例を
示す概略図、第4図は同ロボットの動作例を示す図、第
5図乃至第7図は上記例における指令パターンと制御対
象の実際の動作とを示す図、第8図は上記例におけるサ
ーボ系の等価回路図、第9図は指令パターンとKpとを示
す図、第10図はロボットの動作例を示す図、第11図は上
記例におけるコントローラの処理フローを示すフローチ
ャートである。 10,11,12……サーボ系、13……コントローラ。
の実施に用いた装置の一例を示すブロック図、第3図は
本発明により制御される水平旋回アームロボットの例を
示す概略図、第4図は同ロボットの動作例を示す図、第
5図乃至第7図は上記例における指令パターンと制御対
象の実際の動作とを示す図、第8図は上記例におけるサ
ーボ系の等価回路図、第9図は指令パターンとKpとを示
す図、第10図はロボットの動作例を示す図、第11図は上
記例におけるコントローラの処理フローを示すフローチ
ャートである。 10,11,12……サーボ系、13……コントローラ。
Claims (1)
- 【請求項1】複数の制御対象を有するロボットに水平動
作と垂直動作との複合動作を実行させる動作指令パター
ンを前記制御対象ごとに複数のサーボ系に入力し、この
複数のサーボ系で入力に追従して前記複数の制御対象を
それぞれ制御する制御方法において、 前記複数のサーボ系の各伝達関数を一次の伝達関数に近
似させ、前記動作指令パターンに対する前記制御対象の
実際の各動作パターンを求めてこの求めた各動作パター
ンと前記一次の伝達関数による遅れ時間に基づいて前記
ロボットに前記複合動作を実行させるための動作起動タ
イミングを計算し、前記制御対象の各動作を前記サーボ
系により前記動作起動タイミングに従って実行させてこ
の各動作の合成により前記ロボットに前記複合動作を実
行させることを特徴とする制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2220317A JP2740691B2 (ja) | 1990-08-22 | 1990-08-22 | 制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2220317A JP2740691B2 (ja) | 1990-08-22 | 1990-08-22 | 制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH04102905A JPH04102905A (ja) | 1992-04-03 |
JP2740691B2 true JP2740691B2 (ja) | 1998-04-15 |
Family
ID=16749250
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2220317A Expired - Fee Related JP2740691B2 (ja) | 1990-08-22 | 1990-08-22 | 制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2740691B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118103181A (zh) * | 2021-10-07 | 2024-05-28 | 三菱电机株式会社 | 机器人控制装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61169905A (ja) * | 1985-01-23 | 1986-07-31 | Hitachi Ltd | ロボツトの軌道制御装置 |
-
1990
- 1990-08-22 JP JP2220317A patent/JP2740691B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH04102905A (ja) | 1992-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3129622B2 (ja) | フルクローズド・ループ方式における象限突起補正方法 | |
JPH05113814A (ja) | 軸の加速度および速度指令のための方法 | |
GB2226425A (en) | Method of correcting and playing back positional instruction data in a robot | |
JP2740691B2 (ja) | 制御方法 | |
CN111331577B (zh) | 机器人的控制装置及控制方法 | |
JPH0962331A (ja) | サーボ制御における移動指令の分配方法 | |
JPS6246003B2 (ja) | ||
JPH1124718A (ja) | ロボットの制御装置及び制御方法 | |
JP2528540B2 (ja) | 指令信号発生方法 | |
JPS6378206A (ja) | フルクロ−ズフイ−ドバツクncシステムにおけるデジタルサ−ボシステムを用いた追従遅れを除去する方法 | |
JPH09244725A (ja) | 軌道補間装置及びその方法並びに制御装置 | |
JP3194829B2 (ja) | ロボットの動作プログラム生成装置 | |
JPS59187484A (ja) | 産業用ロボツトのア−ム駆動装置 | |
JPS61159390A (ja) | 産業用ロボツトの制御方法 | |
JPH0623928B2 (ja) | ロボツトハンドの軌道修正方法 | |
JPS6037009A (ja) | 多関節ロボツトの制御装置 | |
JPH10301616A (ja) | ロボットの教示装置 | |
JPH06289915A (ja) | ディジタルサーボ制御装置 | |
JPS60112106A (ja) | 移動機構の駆動制御方法 | |
JP2728260B2 (ja) | サーボ制御装置 | |
JPH0625928B2 (ja) | ロボツトの円弧軌道制御装置 | |
JPH0256608A (ja) | ロボットの速度プログラム決定方法 | |
JP2884537B2 (ja) | 駆動制御装置 | |
JPH0720919A (ja) | マニプレータの制御装置 | |
JPH01177885A (ja) | モータの位置決め方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
LAPS | Cancellation because of no payment of annual fees |