(57)【要約】【課題】簡便に短時間にしかも精度よくロボットのツールパラメータ（Ｔx，Ｔy，Ｔz，α，β，γ）、特にツールパラメータの中の並進成分（Ｔx，Ｔy，Ｔz）であるツールベクトルを導出する方法を提供する。【解決手段】本発明に係るロボットのツールベクトルの導出方法は、ロボット２のアーム先端に取り付けられたツール６の先端位置を決定するツールベクトルを導出する方法であって、ロボット２のツール６の先端が空間上の所定点の近傍に位置するように、ロボット２に対して３つ以上の姿勢をとらせ、各姿勢におけるツール６の先端の位置ずれ量である実績位置ずれ量を計測し、計測された実績位置ずれ量を基にツールベクトルＴを算出する。【選択図】図３
2011224672.tif 000002
【特許請求の範囲】
【請求項１】
ロボットのアーム先端に取り付けられたツールの先端位置を決定するツールベクトルを導出する方法であって、
前記ロボットのツール先端が空間上の所定点の近傍に位置するように、前記ロボットに対して３つ以上の姿勢をとらせ、各姿勢におけるツール先端の位置ずれ量を計測して実績位置ずれ量とし、計測された実績位置ずれ量を基にツールベクトルを算出することを特徴とするロボットのツールベクトルの導出方法。
【請求項２】
前記ツールベクトルを算出するに際しては、計算で得られるツール先端の位置ずれ量と、計測で得られるツール先端の実績位置ずれ量とが一致するように、前記ツールベクトルを算出することを特徴とする請求項１に記載のロボットのツールベクトルの導出方法。
【請求項３】
前記ツール先端の実績位置ずれ量を計測可能な計測器を設けておき、
前記計測器により設定される計測座標系に関して、当該計測座標系の原点を前記計測器の原点位置に一致させると共に、計測座標系の座標軸をロボットに設定されたロボット座標系の軸方向に一致させた上で、
各姿勢におけるツール先端の実績位置ずれ量を計測することを特徴とする請求項１又は２に記載のロボットのツールベクトルの導出方法。
【請求項４】
請求項１〜３のいずれかに記載されたツールベクトルの導出方法を用いて、ツールベクトルを求め、求められたツールベクトルを基にして、前記ロボットに既に設定されているツールベクトルを修正することを特徴とするロボットのツールベクトルの較正方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、溶接ロボットなどの先端に取り付けられたツールに関し、簡便且つ短時間に精度よくツールベクトルを導出、較正することのできる技術に関する。
【背景技術】
【０００２】
例えば、ワークに対して自動的に溶接を行う溶接ロボットにおいては、溶接ロボットの先端部分（手首部）に、溶接トーチ等を備えた溶接ツールが取り付けられている。
この溶接ツールの先端部にはツール座標系が設定されており、このツール座標系は、ツールパラメータを用いた変換行列を用いることでフランジ座標系から座標変換可能となっている（ツールパラメータとツールベクトルの差違は後述する）。フランジ座標系は、溶接ロボットの先端部に形成されているフランジ部に設定された座標系であり、このフランジ座標系は、溶接ロボットの各軸のデータより制御装置にて計算可能となっている。
【０００３】
以上のことから明らかなように、制御装置においてツール先端の位置を正確に把握するためには、座標変換に不可欠なツールパラメータを予め正確に導出しておく必要がある。ツールパラメータの導出作業は溶接ロボットのツールを交換した後に行われることもあるが、ツールが作業ワーク等に衝突したときなどツールパラメータの変更が生じたとき等にも行われる。
【０００４】
ツールパラメータの導出、較正に関する技術としては、例えば、特許文献１に開示されたものがある。
特許文献１は、ロボットのアーム先端に取り付けられたツールの位置姿勢を決定するツールパラメータを導出する方法において，上記ツールを空間上の１点に少なくとも異なる３つの姿勢で位置決めしたときの各位置決めデータに基づいて上記ツールの取り付け部の座標系を演算し、ツールパラメータを用いて表現される上記取り付け部の座標系の任意の２つよりみたツール位置候補を含む直線を少なくとも２本求め、上記直線同士の交点と取り付け部の座標系とに基づいて上記ツールパラメータを導出してなることを特徴とするロボットのツールパラメータ導出方法を開示する。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特許第２７７４９３９号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
特許文献１に開示された技術を用いることで、ツールパラメータをほぼ正確に導出することができるようになるものの、実際の現場から、幾つかの改良を望む声が挙がってきている。
すなわち、特許文献１に開示された技術では、溶接ロボットの先端部に針状に尖った治具（専用治具(1)）を装着し、他方、同様に先端が針状となった治具（専用治具(2)）を用意し、ロボットの姿勢をいろいろと変化させながら、専用治具(1)の針先と専用治具(2)の針先を併せる位置決め教示を行い、その結果からツールパラメータの推定を行うものとなっている。
【０００７】
この技術によれば、ツールパラメータの導出計算は簡単な式となるが、オペレータによる「針先合わせ」を介した位置決めを行う必要があるため、習熟度や目視による方向などにより正確な位置決めが難しい。較正後の結果の検証も目視で行うため、定量的な把握も難しいことになる。言い換えるならば、作業者の熟練度や技量などが、ツールの位置決め精度やツール最先端の導出精度に影響を及ぼすようになる。
【０００８】
それ故、ツールパラメータの導出精度を向上させるためには、計測点数を増やして誤差を平均化する必要があるが、計測点数の増加はオペレータの作業時間の増加へとつながる。
そこで、本発明は、上記問題点に鑑み、作業者の熟練度や技量などに因らず、より簡便に短時間にしかも精度よくロボットのツールパラメータ（Ｔx，Ｔy，Ｔz，α，β，γ）、特に、ツールパラメータの中の並進成分（Ｔx，Ｔy，Ｔz）である「ツールベクトル」を導出する方法を提供することを目的とする。
【課題を解決するための手段】
【０００９】
上述の目的を達成するため、本発明においては以下の技術的手段を講じた。
本発明に係るロボットのツールパラメータの導出方法は、ロボットのアーム先端に取り付けられたツールの先端位置を決定するツールベクトルを導出する方法であって、前記ロボットのツール先端が空間上の所定点の近傍に位置するように、前記ロボットに対して３つ以上の姿勢をとらせ、各姿勢におけるツール先端の位置ずれ量を計測して実績位置ずれ量とし、計測された実績位置ずれ量を基にツールベクトルを算出することを特徴とする。      
【００１０】
なお、ツールベクトルとは、ロボットのツール座標系とフランジ座標系とをつなぐパラメータであるツールパラメータ（Ｔx，Ｔy，Ｔz，α，β，γ）の中で、並進成分（Ｔx，Ｔy，Ｔz）のみを取り出したものである。
好ましくは、前記ツールベクトルを算出するに際しては、計算で得られるツール先端の位置ずれ量と、計測で得られるツール先端の実績位置ずれ量とが一致するように、前記ツールベクトルを算出するとよい。
【００１１】
具体的には、後述する式（７）において表現されるように、ツールベクトルを用いて算出されるツールの先端位置の「計算上の位置ずれ量（Ｐin−Ｐi1）」と、ツールの先端位置の計測値から得られる「実績位置ずれ量（Ａn−Ａ1）」とが一致するようなツールベクトルを求めるとよい。
ツールベクトルの導出にあたっては、前記ツール先端の実績位置ずれ量を計測可能な計測器を設けておき、前記計測器により設定される計測座標系に関して、当該計測座標系の原点を前記計測器の原点位置に一致させると共に、計測座標系の座標軸をロボットに設定されたロボット座標系の軸方向に一致させた上で、各姿勢におけるツール先端の実績位置ずれ量を計測するとよい。
【００１２】
また、本発明に係るロボットのツールパラメータの較正方法は、上述したツールベクトルの導出方法を用いて、ツールベクトルを求め、求められたツールベクトルを基にして、前記ロボットに既に設定されているツールベクトルを修正することを特徴とする。
【発明の効果】
【００１３】
本発明に係る技術を用いれば、作業者の熟練度や技量などに因らず、より簡便に短時間にしかも精度よくロボットのツールベクトルを導出することが可能となる。
【図面の簡単な説明】
【００１４】
【図１】本発明の実施形態に係るロボットシステムの全体構成図である。
【図２】ツール座標系とフランジ座標系との関係を示す概念図である。
【図３】実績位置ずれ量を計測する方法を示した概念図である。
【図４】ツールベクトルの導出手順を示すフローチャートである。
【図５】本発明に係る他の実施形態を示す図である。
【発明を実施するための形態】
【００１５】
本発明の実施形態を、図を基に説明する。なお、以下の説明では、同一の部品には同一の符号を付してある。それらの名称及び機能も同じである。したがって、それらについての詳細な説明は繰返さない。
まず、本実施形態に係るロボットシステム１の全体構成について説明する。
図１に示すように、ロボットシステム１は、溶接ロボット２と、教示ペンダント３を備えた制御装置４と、パソコン５（パーソナルコンピュータ）とを含む。溶接ロボット２は垂直多関節型の６軸の産業用ロボットであり、その先端に溶接トーチなどから構成される溶接ツール６（単にツール６と呼ぶこともある）が設けられている。この溶接ロボット２はそれ自体を移動させるスライダ（図示せず）に搭載されていてもよい。
【００１６】
制御装置４は、溶接ロボット２を、予め教示したプログラムに従って制御する。教示プログラムは、制御装置４に接続された教示ペンダント３を使用して作成する場合や、パソコン５を利用したオフライン教示システムを使用して作成する場合がある。いずれの場合であっても、教示プログラムは、実際の動作の前に予め作成される。パソコン５により作成されたプログラムは、磁気的にデータを記憶した媒体等を介して制御装置４に受渡しされたり、データ通信により制御装置４に転送されたりする。
【００１７】
パソコン５、すなわちオフライフ教示システムは、表示装置としてグラフィック表示可能なディスプレイを備え、入力装置としてキーボード又はマウスを備える。また、ワークのＣＡＤ情報を取込むために、磁気記憶装置又は通信装置が設けられている。
ところで、本願発明は、ツール先端の位置を正確に把握するために必要なツールパラメータ（特にツールベクトル）を正しく導出するための方法に関するものである。
【００１８】
図２に示す如く、このツールパラメータとは、溶接ツール６の先端部（溶接点）の位置座標すなわちツール座標系を、溶接ロボット２の先端部に形成されているフランジ部に設定された座標系であるフランジ座標系から座標変換するものであり、このフランジ座標系は、溶接ロボット２の各軸のデータより制御装置４にて計算可能となっている。つまり、ツールパラメータを用いることで、制御装置４によりツール先端の位置座標を算出することが可能となる。
【００１９】
ところで、ロボットのツールパラメータには（Ｔx，Ｔy，Ｔz，α，β，γ）の並進３成分と回転３成分とがあるが、本発明は、ツールパラメータの中の並進成分（Ｔx，Ｔy，Ｔz）である「ツールベクトル」を導出する方法を開示する。この方法は、後述する計測器１０を用いてツール先端の位置のずれ量を計測し、制御装置４やパソコン５内において、計測されたずれ量を基にツールベクトルを算出するものである。
【００２０】
以下、本発明に係るロボットのツールベクトルの導出方法について詳しく説明する。
まず、本発明で使用する計測器１０について説明する。
図１，図３に示す如く、計測器１０は、距離変位計であるダイヤルゲージ１１を３台有しており、ツール先端の３次元的な変化量を正確に捉えるために、各ダイヤルゲージ１１はそれぞれが直交する方向に配備されている。この計測器１０により構成される計測座標に関しては、その原点位置を計測器１０の原点とすると共に、計測座標の座標軸の軸方向をロボットに設定されたロボット座標系の軸方向に一致させるようにしている。
【００２１】
一方、ロボットの先端であるフランジ面７に取り付けられている溶接ツール６に関しては、溶接ツール６の先端に計測用プローブ１２を取り付ける。この計測用プローブ１２は、その先端部に鋼球などから構成される球体部１３を有し、この球体部１３の中心が溶接ツール６の先端（計測したいツール先端）の位置となるように位置づけられる。前述したダイヤルゲージ１１の先端は、球体部１３の位置の変化量を確実にセンシングできるように、平面上の板などで構成され平面接触子１４となっている。溶接ロボット２が様々な姿勢をとったとしても、計測用プローブ１２の球体部１３は平面接触子１４に点接触するため、計測器１０は球体部１３の位置の変化量を確実に検出できる。
【００２２】
ところで、前述の如く、計測器１０（３台のダイヤルゲージ１１）の各計測方向がロボット座標系の軸方向と一致するように配置できれば、各ダイヤルゲージ１１の計測値が、対応するロボット座標系での計測値となるが、このような配置を常に実現することが難しい場合もある。その際には、以下の手順で計測座標系を設定する（補正する）ことは好ましい。
【００２３】
すなわち、
(i)  計測器１０の原点近傍にロボット先端を位置決めし、この位置を計測器１０で計測する。このときの計測値をＭ１（Ｍ１x，Ｍ１y，Ｍ１z）とする。
(ii)  ロボットを(i)の姿勢のままロボット座標系でＸ軸方向にのみ動作させ、その時の位置を計測器１０で計測する。このときの計測値をＭ２（Ｍ２x，Ｍ２y，Ｍ２z）とする。
【００２４】
(iii)  ロボットを(i)の位置に戻し、ロボットを(i)の姿勢のままロボット座標系でＹ軸方向にのみ動作させ、その時の位置を計測器１０で計測し、計測値をＭ３（Ｍ３x，Ｍ３y，Ｍ３z）とする。
(iv)  以下の手順で計測値をロボット座標軸に合致した計測座標系に変換するマトリックスroboＧmesを導出する。
【００２５】
【数１】
2011224672.tif 000003
【００２６】
なお、［数１］におけるＵは、計測器１０から見たロボットのＸ軸方向、Ｖは計測器１０から見たロボットのＹ軸方向、Ｗは計測器１０から見たロボットのＺ軸方向であり、mesＧroboは、計測器１０からみたロボット座標系（原点は計測座標）を表しており、計測座標系をロボット座標系へ変換する変換行列である。
このmesＧroboを用いることで、計測器１０の各計測方向とロボット座標系の軸方向とが一致した配置を（仮想的に）実現することができる。本実施形態においても、このmesＧroboを用いることとする。
【００２７】
一方、詳細は後述するが、ツールベクトルの導出では、各姿勢におけるツール先端の位置のずれ量である「実績位置ずれ量」を計測し、計測された「実績位置ずれ量」からツールベクトルを算出するため、計測器１０での計測値の差分（変化量）が重要であって、原点のシフト量は最終的に相殺され不要である。それ故、mesＧroboの逆行列で定義されるroboＧmesは、計測器１０の原点位置を基準に座標軸をロボット直交座標軸で表現したもので十分であり、ロボット座標系からの計測座標原点の位置ベクトルを正確に推定する必要はない。
【００２８】
なお、計測器１０の各ダイヤルゲージ１１の計測値Ｍ（Ｍx，Ｍy，Ｍz）を計測座標系での計測値Ａ（Ａx，Ａy，Ａz）に変換するには、以下の変換を行えばよい。
【００２９】
【数２】
2011224672.tif 000004
【００３０】
本実施形態での計測値は、特に断らない限りこの変換を行った（軸方向はロボット直交座標軸に一致した）計測座標系での値とする。
以上まとめれば、［数２］で示す変換を行うことで、計測器１０の計測値はロボット直交座標軸に一致した計測座標系での値となり、計測器１０の各計測方向がロボット座標系の軸方向と一致していない場合でも、正確な計測値を確実に得ることができるようになる。
【００３１】
このようにして得られた正確な計測値を基に、ツールベクトルを導出する方法を以下に述べる。
計測器１０を用いたツールベクトルの導出方法は、溶接ロボット６のツール先端が空間上の所定点の近傍に位置するような３つ以上の姿勢を溶接ロボット６に対してとらせ、各姿勢におけるツール先端の位置ずれ量である実績位置ずれ量を計測し、計測された実績位置ずれ量を基にツールベクトルを算出するものである。
【００３２】
言い換えるならば、ツール６を空間上の１点近傍に少なくとも異なる３の姿勢で位置決めし、その際の位置ずれ量（計測器１０の変化量）を計測し、計測された位置ずれ量（実績位置ずれ量）に基づいてツール６の先端位置を演算し、ツール６の計算上の位置ずれ量が実績位置ずれ量と一致するようにツールベクトルを導出する。
具体的には、図４のＳ１に示す如く、まず、オペレータは、教示ペンダント３により計測用プローブ１２の球体部１３を計測器１０の計測範囲の所定位置Ｐに設定する。この所定位置Ｐは、計測器１０の原点近傍であることが好ましい。
【００３３】
その後、Ｓ２のように、計測器１０の計測値Ａ1（Ａ1x，Ａ1y，Ａ1z）を計測すると共に、ロボットの各軸値を計測する。得られたロボットの各軸値を基に、所定位置Ｐのロボット座標系での位置Ｐ1（Ｐ1x，Ｐ1y，Ｐ1z）、フランジ座標系での位置Ｆ1（ｌ1x，ｌ1y，ｌ1z,ｍ1x，ｍ1y，ｍ1z,ｎ1x，ｎ1y，ｎ1z,ｏ1x，ｏ1y，ｏ1z）を求める。
これらＡ1（Ａ1x，Ａ1y，Ａ1z）、Ｐ1（Ｐ1x，Ｐ1y，Ｐ1z）、Ｆ1（ｌ1x，ｌ1y，ｌ1z,ｍ1x，ｍ1y，ｍ1z,ｎ1x，ｎ1y，ｎ1z,ｏ1x，ｏ1y，ｏ1z）、の関係は、フランジ面７から見たツール先端を定義するツールベクトルをＴ（Ｔx，Ｔy，Ｔz）とすると，式（１）で表すことができる。
【００３４】
【数３】
2011224672.tif 000005
【００３５】
次に、Ｓ４の如く、ツール６の姿勢を変化させ、Ｓ１で採用した姿勢とは異なる姿勢で計測器１０の計測範囲の所定位置Ｐに位置決めする。
このとき（ｋ番目）のロボット座標での位置をＰk、ロボットのフランジ座標系をＦkとすると、式（２）が得られる。なお、計測器１０の座標系で計測したｋ番目の値をＡk（Ａkx，Ａky，Ａkz）とすると、Ａkの計測座標系とＰkのロボット座標系は軸方向が一致しているため、式（３）に示すように変化量は一致する。
【００３６】
なお、採用する姿勢は、３姿勢以上であることが好ましいため、Ｓ３に示すように、３姿勢に達していない場合は、更に別の姿勢を採用する。
【００３７】
【数４】
2011224672.tif 000006
【００３８】
ここで、ｎ回計測した（ｎ姿勢を採用した）とすると、式（１），式（２）をまとめて、
【００３９】
【数５】
2011224672.tif 000007
【００４０】
となる。
また、式（３）と式（４）から関係から、式(５)が成立する。
【００４１】
【数６】
2011224672.tif 000008
【００４２】
ここで、ツールベクトルの初期値をＴ0（Ｔ0x，Ｔ0y，Ｔ0z）として、収束計算ｉ番目に導出されたツールベクトルをＴi（Ｔix，Ｔiy，Ｔiz）とすると、式（４），式（５）は以下のようになる。
【００４３】
【数７】
2011224672.tif 000009
【００４４】
式（７）のツールベクトルＴから演算された先端位置Ｐの各差分が、計測値の差分になるようなツールベクトルＴを求めるとよい。言い換えるならば、ツールベクトルを用いて算出されるツール６の先端位置の「計算上の位置ずれ量（Ｐin−Ｐi1）」と、ツール６の先端位置の計測値から得られる「実績位置ずれ量（Ａn−Ａ1）」とが一致するようなツールベクトルＴを求めるとよい。
【００４５】
そのために、Ｓ５に示す如く、以下の方程式をΔＡが０になるように、最小二乗法を用いた収束計算を行い解くことで、ツールベクトルＴを求めることができる。
【００４６】
【数８】
2011224672.tif 000010
【００４７】
以上の方法で、溶接ロボット２の先端を、計測器１０の計測範囲に複数回設定するといった位置決め不要な簡単な操作で、ツールベクトルＴ（Ｔx，Ｔy，Ｔz）を導出することが可能となる。
ただし、上記したやり方であると、１番目の計測値を基準（位置ずれ量の算出の基準）としているため、誤差の存在状況によっては、得られるツールベクトルに誤差が生じる場合も否めない。そこで、基準を１番目からｎ番目まで順次使用した式（９）を解くことで、計測誤差を極力廃することが可能となる。
【００４８】
【数９】
2011224672.tif 000011
【００４９】
以上述べた、溶接ロボットのツールベクトルの導出方法を採用することで、より簡便に短時間にしかも精度よくロボットのツールツールベクトルを導出することができるようになり、ロボット溶接における溶接精度や溶接品質の向上に寄与できることとなる。
なお、今回開示された実施形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。
【００５０】
例えば、本実施形態では、溶接ロボット２のツール６を交換した後をイメージし、ツール６交換後におけるツールベクトルの導出作業を説明したが、ツール６が作業ワーク等に衝突したときなどツールベクトルの変更が生じたときの「ツールベクトルの較正作業」においても同様の手法を用いることができる。
また、本実施形態では、計測器１０にロボットの直交座標軸方向に配置した３台のダイヤルゲージ１１を使用した例を示したが、これに限定されるものではない。計測器１０としては、ツール先端に取り付けられた計測用プローブ１２の先端位置を高精度に計測できるものであればよい。例えば、図５に示すようなカメラ１５を用いた３次元画像計測装置を計測器１０として採用可能である。レーザ変位計、静電容量形の距離計なども採用可能である。
【００５１】
また、本実施形態ではロボットとして溶接ロボットを例示したが、組み立てロボットなどの作業用ロボットであっても本技術は採用可能である。
【符号の説明】
【００５２】
１    ロボットシステム
２    溶接ロボット
３    教示ペンダント
４    制御装置
５    パソコン
６    溶接ツール
７    フランジ面
１０  計測器
１１  ダイヤルゲージ
１２  計測用プローブ
１３  球体部
１４  平面接触子
１５  カメラ
【図４】
2011224672.tif 000012
【図５】
2011224672.tif 000013
【図１】
2011224672.tif 000014
【図２】
2011224672.tif 000015
【図３】
2011224672.tif 000016