JP3864237B2 - ロボットの制御方法および制御装置 - Google Patents
ロボットの制御方法および制御装置 Download PDFInfo
- Publication number
- JP3864237B2 JP3864237B2 JP2002183838A JP2002183838A JP3864237B2 JP 3864237 B2 JP3864237 B2 JP 3864237B2 JP 2002183838 A JP2002183838 A JP 2002183838A JP 2002183838 A JP2002183838 A JP 2002183838A JP 3864237 B2 JP3864237 B2 JP 3864237B2
- Authority
- JP
- Japan
- Prior art keywords
- axis
- interpolation operation
- command value
- interpolation
- 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.)
- Expired - Lifetime
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Description
【産業上の利用分野】
本発明はロボットの制御方法および制御装置に関する。さらに詳しくは、ロボットの動作を滑らかに制御するロボットの制御方法および制御装置に関する。
【0002】
【従来の技術】
従来より、アーク溶接ロボットや塗装ロボットにおいては、ロボットアームの先端を所定経路上を一定の速度で移動させる制御がなされている。この場合、教示作業の容易なことおよび経路修正が容易なことより、教示の際には主要点のみを教示しておいて、直線補間あるいは円弧補間などの方法により教示点間の位置についての指令値(補間指令値)を所定時間間隔で算出し、この補間指令値をロボットに入力してロボットを制御することがなされている。
【0003】
ところが、図7に示すような位置関係で、多関節型のロボット100のアーム先端を点P→点Q→点R→点Pと順次直線補間により移動させるような場合、特に点Qと点Rとの間でアーム先端が三角形PQRの内側にくぼむ曲線Lにより示されるような軌道で移動し、軌道精度が悪化するという現象が起こる。
【0004】
これは、図8に示すように、ロボット100の各軸が、位置比例ゲインKPの比例要素101と伝達関数GPで表される制御対象102とから構成される一次遅れ系であり、軸毎に異なる遅れが生じることによる。
【0005】
このため、図9に示すように、補間指令値の変化に応じて各軸速度の補正動作を前倒しで行うフィードフォワード制御器103をサーボ系に組み込むようにして、アーム先端が精確に補間指令値による軌道に追従するよう制御することが行われている。ところが、このように単にアーム先端の軌道を精確に制御しようとするだけではロボットが滑らかに動作せず、例えばアーム先端の停止の際に不要な振動が励起されてしまうという問題がある。
【0006】
すなわち、ロボットに与えられる動作指令は、図10(a)に示すような、ロボット可動部の速度Vを単純な台形状に変化させる加減速パターンによりなされるのが通常である。このとき、加速度Aは同図(b)のように段階的に変化し、また、加速度Aの変化率を示すジャークJは、同図(c)のように、加減速の開始および終了の各時点t1,t2,t3,t4において絶対値が無限大の値となるように変化する。したがって、アーム各軸の動作を単に補間指令値に精確に追従させるよう制御するだけではロボット可動部の加速度の変化が急峻なものとなるため、動作を滑らかなものとすることはできない。
【0007】
そこで、従来、ロボット各軸の制御系に与えられる補間指令値に対して、一次遅れ処理や平均化処理を利用したフィルタ処理を実施し(急激な姿勢変化を抑制するために平均化処理を利用する例として、特許第2747802号公報参照)、加減速パターンをなまらせるようにして、動作を滑らかなものとすることが行われている。ところが、この方法では前掲の理由によって、ロボット可動部の軌道が補間指令値による軌道からずれるのを防止できないという問題がある。
【0008】
【発明が解決しようとする課題】
本発明はかかる従来技術の課題に鑑みなされたものであって、ロボット可動部の軌道が補間指令値による軌道からずれることを防止しつつ、動作を滑らかなものとすることができるロボットの制御方法および制御装置を提供することを目的としている。
【0009】
【課題を解決するための手段】
本発明のロボットの制御方法は、直交座標系補間動作による補間動作と各軸補間動作による補間動作との切替点とされた教示点間のロボットの動作を、補間指令値により制御するロボットの制御方法であって、
補間動作切替指示に基づいてロボットを直交座標系補間動作により制御する場合、第1軌道計算処理における座標順変換処理により各教示点の教示データに対して座標順変換をなし、ついで所定の加減速パターンにしたがって同第1軌道計算処理における補間指令値生成処理により補間指令値を生成し、しかる後前記生成された補間指令値に対して所定のマトリクスフィルタ処理をなし、さらに第2軌道計算処理における座標逆変換処理により、前記マトリクスフィルタ処理がなされた補間指令値に対して座標逆変換をなして直交座標系補間動作各軸指令値を生成し、
補間動作切替指示に基づいてロボットを各軸補間動作により制御する場合、各教示点の教示データに対してロボット各軸毎の所定の加減速パターンにしたがって第2軌道計算処理における補間指令値生成処理により各軸補間動作各軸指令値を生成し、しかる後前記生成された各軸補間動作各軸指令値に対して所定の各軸フィルタ処理をなし、
ロボットの動作を前記直交座標系補間動作と前記各軸補間動作との間で切り替える場合のその切替位置周囲の所定範囲における、前記直交座標系補間動作各軸指令値と、前記各軸フィルタ処理がなされた各軸補間動作各軸指令値とを重ね合わせ、その結果をロボット各軸の指令値として出力する重ね合わせ処理とを含み、
それにより、直交座標系補間動作による補間動作と、各軸補間動作による補間動作との切り替え時にロボットを一旦停止させることなく動作させる
ことを特徴とする。
【0010】
本発明のロボットの制御方法においては、所定のマトリクスフィルタ処理が、例えば、補間指令値の現在値を含む直近の指令値の所要数を平均する処理とされる。
【0011】
また、本発明のロボットの制御方法においては、所定の各軸フィルタ処理が、各軸の指令値の現在値を含む直近の指令値の所要数を平均する処理とされる。
【0013】
さらに、本発明のロボットの制御方法においては、サーボ処理部の制御遅れを各軸の指令値によるフィードフォワード制御により補償するのが好ましい。
【0014】
一方、本発明のロボットの制御装置は、直交座標系補間動作による補間動作と各軸補間動作による補間動作との切替点とされた教示点間のロボットの動作を、補間指令値により制御するロボットの制御装置であって、
教示点における教示データを記憶する教示データ記憶部と、各教示点間をロボット可動部が所定の軌道で移動するよう制御するための演算処理を行う軌道生成部と、サーボ処理部と、直交座標系補間動作による補間動作と各軸補間動作による補間動作との切り替えを指示する補間動作切替指示部とを備え、
前記軌道生成部は、第1軌道計算部と、マトリクスフィルタ処理部と、第2軌道計算部と、各軸フィルタ処理部と、重ね合わせ処理部とを含み、
前記補間動作切替指示部からの補間動作切替指示に基づいてロボットを直交座標系補間動作により制御する場合、前記第1軌道計算部は、教示データ記憶部から入力された各教示点の教示データに対して座標順変換をなし、ついで所定の加減速パターンにしたがって補間指令値を生成し、その生成した補間指令値を前記マトリクスフィルタ処理部に出力し、前記マトリクスフィルタ処理部は、入力された補間指令値に対して所定のマトリクスフィルタ処理をし、そのマトリクスフィルタ処理がされた補間指令値を前記第2軌道計算部に出力し、前記第2軌道計算部は、入力された補間指令値に対して座標逆変換をなして直交座標系補間動作各軸指令値を生成し、その生成した直交座標系補間動作各軸指令値を前記重ね合わせ処理部に出力し、
前記補間動作切替指示部からの補間動作切替指示に基づいてロボットを各軸補間動作により制御する場合、前記第2軌道計算部は、前記第1軌道計算部を介して前記教示データ記憶部から入力された教示データに対してロボット各軸毎の所定の加減速パターンにしたがって各軸補間動作各軸指令値を生成し、その生成した各軸補間動作各軸指令値を前記各軸フィルタ処理部に出力し、前記各軸フィルタ処理部は、入力された各軸補間動作各軸指令値に対して各軸フィルタ処理をし、その各軸フィルタ処理された各軸補間動作各軸指令値を前記重ね合わせ処理部に出力し、
前記重ね合わせ処理部は、ロボットの動作を前記直交座標系補間動作と前記各軸補間動作との間で切り替える場合のその切替位置周囲の所定範囲における、入力された直交座標系補間動作各軸指令値と入力された直交座標系補間動作各軸指令値とを重ね合わせ、その結果をロボットの各軸指令値として前記サーボ処理部に出力し、
それにより、直交座標系補間動作による補間動作と、各軸補間動作による補間動作との切り替え時にロボットを一旦停止させることなく動作させる
ことを特徴とする。
【0015】
本発明のロボットの制御装置においては、所定のマトリクスフィルタ処理が、例えば、補間指令値の現在値を含む直近の指令値の所要数を平均する処理であるものとされる。
【0016】
また、本発明のロボットの制御装置においては、所定の各軸フィルタ処理が、各軸の指令値の現在値を含む直近の指令値の所要数を平均する処理とされる。
【0018】
さらに、本発明のロボットの制御装置においては、フィードフォワード制御手段を有するサーボ処理部を備え、該フィードフォワード制御手段が、ロボットの各軸の指令値によりサーボ処理部の制御遅れを補償するのが好ましい。
【0019】
【作用】
本発明は前記の如く構成されているので、ロボットを直交座標系補間動作により制御する場合、ロボットを精度よく経路に沿って移動させることができるとともに、動作を滑らかなものとすることができる。
【0020】
【発明の実施の形態】
以下、添付図面を参照しながら本発明を実施形態に基づいて説明するが、本発明はかかる実施形態のみに限定されるものではない。
【0021】
実施形態1
図1に、本発明のロボットの制御方法に用いる制御装置の構成を機能ブロック図で示し、同制御装置Aは、絶対座標系やロボットの手首座標系などで表される各教示点における教示データを記憶する教示データ記憶部10と、教示データに基づいて、各教示点間をロボット可動部が所定の軌道で移動するよう制御するための演算処理を行う軌道生成部20と、サーボ処理部30と、CP(Continuous Path)制御(直交座標系補間動作)による補間動作とPTP(Point to Point)制御(各軸補間動作)による補間動作との切り替えを指示する補間動作切替指示部40とを主要構成要素として備えてなるものである。なお、かかる構成の制御装置Aは、具体的には、CPUを中心として、後述する処理に対応させた制御プログラム等が格納されたROM、RAM、入出力インターフェース等を組み合わせることにより実現される。
【0022】
軌道生成部20は、第1軌道計算部(補間指令値(直交座標系指令値)生成部)21、マトリクスフィルタ処理部22、第2軌道計算部(各軸指令値生成部)23および各軸フィルタ処理部24から構成される。
【0023】
第1軌道計算部21は直交座標系補間動作(CP制御)による補間動作を行う場合、すなわち直線補間動作や円弧補間動作を行う場合は、教示データ記憶部10からの教示データ、つまり各教示点におけるロボット可動部の位置データおよび姿勢データに基づき所定の加減速パターン(図10参照)に従って、直線補間または円弧補間による補間指令値を生成し、マトリクスフィルタ処理部22に出力する。このとき、第1軌道計算部21においては、教示データの各成分をロボット固有の座標系(ロボット座標系)における直交成分(X,Y,Z)に変換する座標順変換処理が実施される。また、各軸補間動作(PTP制御)による補間動作を行う場合は教示データに座標順変換処理のみを実施して、第2軌道計算部23に出力する。
【0024】
マトリクスフィルタ処理部22は、第1軌道計算部21から入力される各補間指令値に対して、各補間指令値が準拠する加減速パターンをなまらせるためのマトリクスフィルタ処理を実施して、第2軌道計算部23に出力する。このマトリクスフィルタ処理については後で詳細に説明する。
【0025】
第2軌道計算部23は、マトリクスフィルタ処理部22によりフィルタ処理された補間指令値、または第1軌道計算部21から入力される教示データに基づいて、ロボット各軸の所定時間毎の位置を指示する各軸指令値を生成する。
【0026】
すなわち、第2軌道計算部23は、直交座標系補間動作による補間動作を行う場合、マトリクスフィルタ処理部22からの補間指令値、すなわち所定時間毎のロボット可動部の位置データおよび姿勢データに対して座標逆変換処理を行って、所定時間毎のロボット各軸の位置を指示する各軸指令値を生成し、サーボ処理部30に出力する。以下、直交座標系補間動作による各軸指令値を直交座標系補間動作各軸指令値という。
【0027】
また、各軸補間動作による補間動作を行う場合、第2軌道計算部23は、第1軌道計算部21からの教示データに基づきロボット各軸毎の所定の加減速パターンに従って各軸指令値を生成し、各軸フィルタ処理部24に出力する。以下、各軸補間動作による各軸指令値を各軸補間動作各軸指令値という。
【0028】
各軸フィルタ処理部24は、第2軌道計算部23からの各軸補間動作各軸指令値に加減速パターンをなまらせるための所定の各軸フィルタ処理を実施し、サーボ処理部30に出力する。なお、各軸フィルタ処理部24における各軸フィルタ処理についても後で詳細に説明する。
【0029】
次に、図2を参照して、サーボ処理部30を説明する。
【0030】
サーボ処理部30はロボットの各軸毎に設けられており、ロボット各軸が軌道生成部20からの各軸指令値に精確に追従するようフィードバック制御する制御系として構成される。すなわち、サーボ処理部30は、各軸指令値(x)からサーボモータMのエンコーダ31の位置検出値zを減算しその偏差信号eを出力する減算器32と、偏差信号eを増幅するサーボ増幅器33と、各軸指令値(x)の変化に対して一次遅れで応答するロボット各軸の速度を各軸指令値(x)に基づき前倒しで補正するよう補償値wを出力するフィードフォワード制御器34と、サーボ増幅器33の出力信号vに補償値wを加算してサーボモータMに出力する加算器35とから構成される。
【0031】
次に、前述したマトリクスフィルタ処理部22におけるマトリクスフィルタ処理を説明する。
【0032】
第1軌道計算部21により生成される補間指令値Hiは、4列4行の行列を用いて式1のように表すことができる。
【0033】
【数1】
【0034】
ここで、この行列を構成しているベクトルP(Px,Py,Pz)は、ロボット可動部、例えばロボットアーム先端の位置を表し、またこの行列を構成している式2で表される3列3行の行列Sは、ロボット可動部、ロボットアームの姿勢を表している。
【0035】
【数2】
【0036】
いま、時刻tにおける補間指令値Htは、前述したように、位置ベクトルPtと姿勢行列Stとを用いて式3のように表される。
【0037】
【数3】
【0038】
そして、補間指令値の現在値Htに対して、この現在値Htを含む直近n個の補間指令値Ht、Ht-1、…、Ht-(n-1)を平均化するようにして、ロボット可動部の加減速パターンをなまらせるためのマトリクスフィルタ処理を実施する。このとき、マトリクスフィルタ処理部22の出力信号Huを構成する位置データPiの平均値Puは、下記式(4)で算出される。
【0039】
Pu=(Pt+Pt-1+…+Pt-(n-1))/n (4)
【0040】
また、姿勢データSiの平均値Suは下記各式(5)、(6)、(7)で算出される。すなわち、Si=[ni,oi,ai]として、
【0041】
【数4】
【0042】
【数5】
【0043】
【数6】
【0044】
ただし、式(5)、(6)、(7)中のサンプル数(m)は、位置データのサンプル数(n)と一致させてもよい。
【0045】
なお、姿勢行列Sは、オイラー角O,A,Tに置き換えることもできる。そこで、演算処理の都合上、姿勢に関する補間指令値の平均化に際しては、このオイラー角O,A,Tに置き換えたものを用いることもできる。また、当然のことながら、姿勢行列SをRPYに置き換えて平均化処理を行ってもよい。
【0046】
そして、この位置ベクトルPおよびオイラー角O,A,Tを用いて平均化した後の、時刻uにおける位置の補間指令値Pu、および姿勢の補間指令値Ou,Au,Tuは、それぞれ式(8)、(9)、(10)、(11)により表される。なお、式(8)、(9)、(10)、(11)中のn,mはそれぞれサンプル数を表す。ここで、サンプル数m,nは等しくてもよく、あるいは異なっていてもよい。
【0047】
Pu=(Pt+Pt-1+…+Pt-(n-1))/n (8)
【0048】
Ou=(Ov+Ov-1+…+Ov-(m-1))/m (9)
【0049】
Au=(Av+Av-1+…+Av-(m-1))/m (10)
【0050】
Tu=(Tv+Tv-1+…+Tv-(m-1))/m (11)
【0051】
ここで、位置と姿勢の補間指令値の平均化の際に、両者のサンプル数が異なる場合は、サンプル数が少ない方のサンプリング時間帯が、サンプル数が多い方のサンプリング時間帯に包含されるようにしてサンプリングを行うことは、特許第2747802号公報と同様である。
【0052】
次に、各軸フィルタ処理部24が実施する各軸フィルタ処理につき説明する。
【0053】
各軸フィルタ処理部24は、各軸指令値の現在値Jtに対して、この現在値Jtを含む直近q個の各軸指令値Jt、Jt-1、…、Jt-(q-1)を平均化し、この平均値Juをサーボ処理部30に出力する。このとき、平均値Juは、下記式(12)で算出される。
【0054】
Ju=(Jt+Jt-1+…+Jt-(q-1))/q (12)
【0055】
このように、実施形態1の制御装置Aは、直交座標系補間動作による補間動作の実行時、第1軌道計算部21が生成する補間指令値に対して、加減速パターンをなまらせるためのマトリクスフィルタ処理を実施した後、第2軌道計算部23において、前記フィルタ処理された補間指令値に基づき各軸指令値を生成するので、ロボットの動作を滑らかなものとすることができるとともに、サーボ処理部30において例えばフィードフォワード制御を実施することによって補間指令値による直線軌道に対して精確(円弧軌道の場合は、ほぼ精確)に追従するよう制御することが可能となる。
【0056】
また、精密な軌道追従性が問題とならない各軸補間動作においては、第2軌道計算部23において生成された各軸指令値に対して簡単な演算処理の各軸フィルタ処理を実施するようにして、加減速パターンをなまらせるので、ロボットの動作を滑らかなものとしつつハードウェアにかかる負荷を軽減して、動作の高速化を図ることも可能となる。
【0057】
実施形態2
本発明の実施形態2のロボット制御装置は、図3に示す重ね合わせ処理部25を、実施形態1のロボット制御装置Aの軌道生成部20に付加して設けたものでその余の構成は同一とされる。
【0058】
すなわち、図4に示す経路L1のように、ロボット可動部を、各軸補間動作により点Dから点Eに移動し、直交座標系補間動作により点Eから点Fに移動し、各軸補間動作により点Fから点Gに移動する場合を考える。この場合、実施形態1の制御装置Aでは、点Eと点Fの2点で補間動作の切り替え、すなわちフィルタ処理の切り替えが行われる。このため、図5に示すように、点Eおよび点Fでアーム先端を一旦停止させる必要が生じる。
【0059】
実施形態2では、これを回避するために、図6に示すように、例えばアーム先端が点Eの精度範囲E´に入った時点に、点Eから点Fへの補間動作を重ね合わせて開始するようにして、ロボット可動部を停止させることなく例えば内回りの軌道L2に沿って滑らかに移動させることが可能となる。
【0060】
すなわち、実施形態2の補間動作切替指示部40は、アーム先端が精度範囲E´に入った時点に、第1軌道計算部21に対して、各教示点E、F間に対応する、直線補間による補間指令値の生成を開始するように指示する。第1軌道計算部21により生成された各補間指令値は、マトリクスフィルタ処理部22において前掲のフィルタ処理が施されて、第2軌道計算部23に出力される。
【0061】
第2軌道計算部23は、各教示点D、Eの教示データに基づき各軸補間動作による各軸指令値JAを生成し、各軸フィルタ処理部24に出力すると同時に、マトリクスフィルタ処理部22からの各教示点E、F間に対応する補間指令値に基づき各軸指令値JBを生成し、重ね合わせ処理部25に出力する。また、各軸フィルタ処理部24は、第2軌道計算部23からの各軸指令値JAに対して前掲の各軸フィルタ処理を施して、重ね合わせ処理部25に出力する。
【0062】
重ね合わせ処理部25は、各軸フィルタ処理部24からの各軸指令値JAと第2軌道計算部23からの各軸指令値JBとに対して下記の重ね合わせ処理を実施し、この処理結果である各軸指令値Jnをサーボ処理部30に出力する。
【0063】
すなわち、各各軸指令値JA、JBおよび点Eの各軸値JEを下記式(13)、(14)、(15)で定義するものとすると、
【0064】
JA=(JA-1、JA-2、JA-3、…) (13)
【0065】
JB=(JB-1、JB-2、JB-3、…) (14)
【0066】
JE=(JE-1、JE-2、JE-3、…) (15)
【0067】
重ね合わせ処理後の各軸指令値Jnは、下記式(16)で算出される。
【0068】
Jn=JB−(JE−JA) (16)
【0069】
同様に、直交座標系補間動作から各軸補間動作に切り替わる点Fにおいては、ロボット可動部が点Fの精度範囲F´に入る時点に、点E、点Fの各教示データに対応する直交座標系補間動作各軸指令値JBと、点F、点Gの各教示データに対応する各軸補間動作各軸指令値JCとに対して、下記式(17)による重ね合わせ処理が実施されて各軸指令値Jmが生成される。
【0070】
Jm=JC−(JF−JB) (17)
【0071】
ただし、JFは点Fにおける各軸値を示す。
【0072】
このように、実施形態2の制御装置においては、直交座標系補間動作による補間動作と各軸補間動作による補間動作との切り替え時に、直交座標系補間動作による補間動作と各軸補間動作による補間動作とを重ね合わせて実施するものとしているので、補間動作の切り替え点においてロボットを一旦停止させる必要がなく、滑らかに動作させることが可能となる。
【0073】
以上、本発明を各実施形態により説明したが、本発明はこれら実施形態に限定されるものではなく、種々改変が可能である。例えば、実施形態では、補間動作を切り替えるときに重ね合わせ処理を実施するものとしたが、補間動作の切り替えが行われない場合であっても、ロボット可動部の移動経路が折れ線的に変化する各教示点において重ね合わせ処理を実施して、動作を滑らかなものとすることができる。
【0074】
【発明の効果】
以上詳述したように、本発明によれば、ロボットを直交座標系補間動作により制御する場合、ロボットを精度よく経路に沿って移動させることができるとともに、動作を滑らかなものとすることができるという優れた効果が得られる。
【図面の簡単な説明】
【図1】本発明の実施形態1に係るロボットの制御方法に用いる制御装置のブロック図である。
【図2】同装置のサーボ処理部の詳細を示すブロック図である。
【図3】本発明の実施形態2に係るロボットの制御方法に用いる制御装置要部を示すブロック図である。
【図4】実施形態1の装置における問題点を説明するための模式図であり、ロボットの動作経路を示す。
【図5】実施形態1の装置における問題点を説明するための模式図であり、ロボットの動作速度の時系列変化を示す。
【図6】実施形態2の装置の特徴的動作を説明するための模式図である。
【図7】従来技術における問題点を説明するための模式図である。
【図8】従来技術における問題点を説明するためのブロック図である。
【図9】従来技術における改良例を示すブロック図である。
【図10】同改良例における問題点を説明するための模式図であり、同(a)は、ロボット可動部の加減速パターンを示し、同(b)はその加速度の時系列変化を示し、同(c)はそのジャーク値の時系列変化を示す。
【符号の説明】
A 制御装置
M サーボモータ
10 教示データ記憶部
20 補間指令値生成部
21 第1軌道計算部
22 マトリクスフィルタ処理部
23 第2軌道計算部
24 各軸フィルタ処理部
25 重ね合わせ処理部
30 サーボ処理部
34 フィードフォワード制御器
40 補間動作切替部
Claims (8)
- 直交座標系補間動作による補間動作と各軸補間動作による補間動作との切替点とされた教示点間のロボットの動作を、補間指令値により制御するロボットの制御方法であって、
補間動作切替指示に基づいてロボットを直交座標系補間動作により制御する場合、第1軌道計算処理における座標順変換処理により各教示点の教示データに対して座標順変換をなし、ついで所定の加減速パターンにしたがって同第1軌道計算処理における補間指令値生成処理により補間指令値を生成し、しかる後前記生成された補間指令値に対して所定のマトリクスフィルタ処理をなし、さらに第2軌道計算処理における座標逆変換処理により、前記マトリクスフィルタ処理がなされた補間指令値に対して座標逆変換をなして直交座標系補間動作各軸指令値を生成し、
補間動作切替指示に基づいてロボットを各軸補間動作により制御する場合、各教示点の教示データに対してロボット各軸毎の所定の加減速パターンにしたがって第2軌道計算処理における補間指令値生成処理により各軸補間動作各軸指令値を生成し、しかる後前記生成された各軸補間動作各軸指令値に対して所定の各軸フィルタ処理をなし、
ロボットの動作を前記直交座標系補間動作と前記各軸補間動作との間で切り替える場合のその切替位置周囲の所定範囲における、前記直交座標系補間動作各軸指令値と、前記各軸フィルタ処理がなされた各軸補間動作各軸指令値とを重ね合わせ、その結果をロボット各軸の指令値として出力する重ね合わせ処理とを含み、
それにより、直交座標系補間動作による補間動作と、各軸補間動作による補間動作との切り替え時にロボットを一旦停止させることなく動作させる
ことを特徴とするロボットの制御方法。 - 所定のマトリクスフィルタ処理が、補間指令値の現在値を含む直近の指令値の所要数を平均する処理であることを特徴とする請求項1記載のロボットの制御方法。
- 所定の各軸フィルタ処理が、各軸の指令値の現在値を含む直近の指令値の所要数を平均する処理であることを特徴とする請求項1記載のロボットの制御方法。
- サーボ処理部の制御遅れを各軸の指令値によるフィードフォワード制御により補償することを特徴とする請求項1、2または3記載のロボットの制御方法。
- 直交座標系補間動作による補間動作と各軸補間動作による補間動作との切替点とされた教示点間のロボットの動作を、補間指令値により制御するロボットの制御装置であって、
教示点における教示データを記憶する教示データ記憶部と、各教示点間をロボット可動部が所定の軌道で移動するよう制御するための演算処理を行う軌道生成部と、サーボ処理部と、直交座標系補間動作による補間動作と各軸補間動作による補間動作との切り替えを指示する補間動作切替指示部とを備え、
前記軌道生成部は、第1軌道計算部と、マトリクスフィルタ処理部と、第2軌道計算部と、各軸フィルタ処理部と、重ね合わせ処理部とを含み、
前記補間動作切替指示部からの補間動作切替指示に基づいてロボットを直交座標系補間動作により制御する場合、前記第1軌道計算部は、教示データ記憶部から入力された各教示点の教示データに対して座標順変換をなし、ついで所定の加減速パターンにしたがって補間指令値を生成し、その生成した補間指令値を前記マトリクスフィルタ処理部に出力し、前記マトリクスフィルタ処理部は、入力された補間指令値に対して所定のマトリクスフィルタ処理をし、そのマトリクスフィルタ処理がされた補間指令値を前記第2軌道計算部に出力し、前記第2軌道計算部は、入力された補間指令値に対して座標逆変換をなして直交座標系補間動作各軸指令値を生成し、その生成した直交座標系補間動作各軸指令値を前記重ね合わせ処理部に出力し、
前記補間動作切替指示部からの補間動作切替指示に基づいてロボットを各軸補間動作により制御する場合、前記第2軌道計算部は、前記第1軌道計算部を介して前記教示データ記憶部から入力された教示データに対してロボット各軸毎の所定の加減速パターンにしたがって各軸補間動作各軸指令値を生成し、その生成した各軸補間動作各軸指令値を前記各軸フィルタ処理部に出力し、前記各軸フィルタ処理部は、入力された各軸補間動作各軸指令値に対して各軸フィルタ処理をし、その各軸フィルタ処理された各軸補間動作各軸指令値を前記重ね合わせ処理部に出力し、
前記重ね合わせ処理部は、ロボットの動作を前記直交座標系補間動作と前記各軸補間動作との間で切り替える場合のその切替位置周囲の所定範囲における、入力された直交座標系補間動作各軸指令値と入力された直交座標系補間動作各軸指令値とを重ね合わせ、その結果をロボットの各軸指令値として前記サーボ処理部に出力し、
それにより、直交座標系補間動作による補間動作と、各軸補間動作による補間動作との切り替え時にロボットを一旦停止させることなく動作させる
ことを特徴とするロボットの制御装置。 - 所定のマトリクスフィルタ処理が、補間指令値の現在値を含む直近の指令値の所要数を平均する処理であることを特徴とする請求項5記載のロボットの制御装置。
- 所定の各軸フィルタ処理が、各軸の指令値の現在値を含む直近の指令値の所要数を平均する処理であることを特徴とする請求項5記載のロボットの制御装置。
- フィードフォワード制御手段を有するサーボ処理部を備え、
該フィードフォワード制御手段が、ロボットの各軸の指令値によりサーボ処理部の制御遅れを補償することを特徴とする請求項5、6または7記載のロボットの制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002183838A JP3864237B2 (ja) | 2002-06-25 | 2002-06-25 | ロボットの制御方法および制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002183838A JP3864237B2 (ja) | 2002-06-25 | 2002-06-25 | ロボットの制御方法および制御装置 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004372310A Division JP4189445B2 (ja) | 2004-12-22 | 2004-12-22 | ロボットの制御方法および制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004025341A JP2004025341A (ja) | 2004-01-29 |
JP3864237B2 true JP3864237B2 (ja) | 2006-12-27 |
Family
ID=31179876
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002183838A Expired - Lifetime JP3864237B2 (ja) | 2002-06-25 | 2002-06-25 | ロボットの制御方法および制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3864237B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5642214B2 (ja) | 2013-02-15 | 2014-12-17 | 株式会社神戸製鋼所 | 多関節ロボットの弾性変形補償制御装置 |
CN110315526B (zh) * | 2018-03-29 | 2023-09-08 | 日本电产三协(浙江)有限公司 | 机器人的控制方法及机器人 |
-
2002
- 2002-06-25 JP JP2002183838A patent/JP3864237B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JP2004025341A (ja) | 2004-01-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5774223B2 (ja) | ロボット制御装置およびロボット制御方法 | |
KR100765671B1 (ko) | 로봇 궤적 제어 방법 및 장치와 로봇 궤적 제어 방법의프로그램을 기록한 컴퓨터 판독 가능한 기록 매체 | |
JP7122821B2 (ja) | ロボットシステム及びロボット制御方法 | |
US10864632B2 (en) | Direct teaching method of robot | |
WO2001038048A1 (fr) | Unite de commande de robot | |
JPH0144476B2 (ja) | ||
JP5916583B2 (ja) | 多関節ロボットのウィービング制御装置 | |
JP4189445B2 (ja) | ロボットの制御方法および制御装置 | |
JP4615418B2 (ja) | 産業用ロボットの制御方法 | |
JP2014136260A (ja) | 制御装置 | |
JP4867105B2 (ja) | 数値制御装置 | |
JP2005085074A (ja) | 位置制御装置 | |
JP2619227B2 (ja) | ロボットの制御方法および装置 | |
JP3864237B2 (ja) | ロボットの制御方法および制御装置 | |
JP3871030B2 (ja) | サーボ制御方法 | |
JP3748454B2 (ja) | 産業用ロボットの制御装置 | |
JPH11231940A (ja) | ロボットの制御装置 | |
JP2019042842A (ja) | 駆動機械の学習制御装置及び学習制御方法 | |
JPH0631664A (ja) | 倣い制御ロボットの制御装置 | |
EP3598248A1 (en) | Control system | |
JP7182952B2 (ja) | 制御方法、制御プログラム、記録媒体、制御装置、ロボットシステム、および物品の製造方法 | |
JP7332432B2 (ja) | ロボットシステム、制御装置、制御方法およびプログラム | |
JPH08234824A (ja) | ロボット制御装置及び方法 | |
JPH07314363A (ja) | 多関節マニピュレータの運動制御方法及び装置 | |
JPH06138945A (ja) | マスタスレーブマニピュレータの制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20041109 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20041222 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050405 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050601 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20051213 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060111 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060112 |
|
A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20060410 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060320 |
|
A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20060424 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060613 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060614 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20060711 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060712 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060911 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 3864237 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101013 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111013 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111013 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121013 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121013 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131013 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131013 Year of fee payment: 7 |
|
EXPY | Cancellation because of completion of term |