JP2012020347A - ロボットのツールベクトルの導出に用いる治具 - Google Patents

Abstract

【課題】簡便に短時間にしかも精度よくロボットのツールパラメータ（Ｔ_x，Ｔ_y，Ｔ_z，α，β，γ）、特にツールパラメータの中の並進成分（Ｔ_x，Ｔ_y，Ｔ_z）であるツールベクトルを導出する際に好適な治具を提供する。
【解決手段】本発明に係る治具１０は、先端部に平面接触子１４が備えられると共に平面接触子１４に対し垂直方向を向く計測軸に沿った変位を計測可能で且つ平面接触子１４でツール先端の位置ずれ量を計測して実績位置ずれ量とする３つの変位計１１と、３つの変位計の各計測軸が１点で互いに直交し且つ各計測軸の交点が空間上の所定点となるように、３つの変位計１１を配備する配備手段１５と、を有する。
【選択図】図８

Description

本発明は、溶接ロボットなどの先端に取り付けられたツールに関し、簡便且つ短時間に精度よくツールベクトルを導出、較正することのできる技術に関し、特にツールベクトルの導出の際に用いる治具（計測器）に関する。

例えば、ワークに対して自動的に溶接を行う溶接ロボットにおいては、溶接ロボットの先端部分（手首部）に、溶接トーチ等を備えた溶接ツールが取り付けられている。
この溶接ツールの先端部にはツール座標系が設定されており、このツール座標系は、ツールパラメータを用いた変換行列を用いることでフランジ座標系から座標変換可能となっている（ツールパラメータとツールベクトルの差違は後述する）。フランジ座標系は、溶接ロボットの先端部に形成されているフランジ部に設定された座標系であり、このフランジ座標系は、溶接ロボットの各軸のデータより制御装置にて計算可能となっている。

以上のことから明らかなように、制御装置においてツール先端の位置を正確に把握するためには、座標変換に不可欠なツールパラメータを予め正確に導出しておく必要がある。ツールパラメータの導出作業は溶接ロボットのツールを交換した後に行われることもあるが、ツールが作業ワーク等に衝突したときなどツールパラメータの変更が生じたとき等にも行われる。

ツールパラメータの導出、較正に関する技術としては、例えば、特許文献１に開示されたものがある。
特許文献１は、ロボットのアーム先端に取り付けられたツールの位置姿勢を決定するツールパラメータを導出する方法において、上記ツールを空間上の１点に少なくとも異なる３つの姿勢で位置決めしたときの各位置決めデータに基づいて上記ツールの取り付け部の座標系を演算し、ツールパラメータを用いて表現される上記取り付け部の座標系の任意の２つより見たツール位置候補を含む直線を少なくとも２本求め、上記直線同士の交点と取り付け部の座標系とに基づいて上記ツールパラメータを導出してなることを特徴とするロボットのツールパラメータ導出方法を開示する。

特許第２７７４９３９号公報

特許文献１に開示された技術を用いることで、ツールパラメータを導出することができるようになるものの、実際の現場から、幾つかの改良を望む声が挙がってきている。
すなわち、特許文献１に開示された技術では、溶接ロボットの先端部に針状に尖った治具（専用治具(1)）を装着し、他方、同様に先端が針状となった治具（専用治具(2)）を用意し、ロボットの姿勢をいろいろと変化させながら、専用治具(1)の針先と専用治具(2)の針先を併せる位置決め教示を行い、その結果からツールパラメータの推定を行うものとなっている。

この技術によれば、ツールパラメータの導出計算は簡単な式となるが、オペレータによる「針先合わせ」を介した位置決めを行う必要があるため、習熟度や目視による方向などにより正確な位置決めが難しい。較正後の結果の検証も目視で行うため、定量的な把握も難しいことになる。言い換えるならば、作業者の熟練度や技量などが、ツールの位置決め精度やツール最先端の導出精度に影響を及ぼすようになる。

それ故、ツールパラメータの導出精度を向上させるためには、計測点数を増やして誤差を平均化する必要があるが、計測点数の増加はオペレータの作業時間の増加へとつながる。
そこで、本願発明者らは、ロボットのアーム先端に取り付けられたツールの先端位置を決定するツールベクトルを導出する方法であって、ロボットのツール先端が空間上の所定点の近傍に位置するように、ロボットに対して３つ以上の姿勢をとらせ、各姿勢におけるツール先端の位置ずれ量を計測して実績位置ずれ量とし、計測された実績位置ずれ量を基にツールベクトルを算出することを特徴とするロボットのツールベクトルの導出方法を開発するに至った。

このツールベクトル導出方法により、簡便に短時間にしかも精度よくロボットのツールパラメータの中の並進成分（Ｔ_x，Ｔ_y，Ｔ_z）である「ツールベクトル」を導出することが可能になっている。とはいえ、係る技術を、作業者の熟練度や技量などに因らず正確に行うには、当該導出方法に最適化された治具（導出の際に用いる専用計測器）の開発が望まれている。

そこで、本発明は、上記要望点に鑑み、作業者の熟練度や技量などに因らず、より簡便に短時間にしかも精度よくロボットのツールパラメータ（Ｔ_x，Ｔ_y，Ｔ_z，α，β，γ）、特に、ツールパラメータの中の並進成分（Ｔ_x，Ｔ_y，Ｔ_z）である「ツールベクトル」を導出する方法に最適な治具、すなわちロボットのツールベクトルの導出の際に用いる治具を提供することを目的とする。

上述の目的を達成するため、本発明においては以下の技術的手段を講じた。
本発明に係るロボットのツールベクトルの導出の際に用いる治具は、ロボットのアーム先端に取り付けられたツールの先端位置を決定するツールベクトルを導出するに際し、前記ロボットのツール先端が空間上の所定点の近傍に位置するように、前記ロボットに対して３つ以上の姿勢をとらせ、各姿勢におけるツール先端の位置ずれ量を計測して実績位置ずれ量とし、計測された実績位置ずれ量を基にツールベクトルを算出するロボットのツールベクトルの導出方法で使用するものである。この治具は、先端部に平面接触子が備えられると共に、前記平面接触子に備えられた計測面に対し垂直方向を向く計測軸に沿った距離変位を計測可能な３つの変位計と、前記３つの変位計の各計測軸が１点で互いに直交すると共に各計測軸の交点が前記空間上の所定点となるように、３つの変位計を配備する配備手段と、を有することを特徴とする。

好ましくは、先端側に球体が設けられた計測用プローブを有していて、前記計測用プローブはその基端側が前記ロボットのアーム先端に取り付けられ、且つ前記球体が前記３つの変位計の各平面接触子の計測面に接するように、前記ロボットの姿勢が設定されるとよい。
以上のような構成を有する治具を用いるならば、ロボットに対して３つ以上の姿勢をとらせた場合、各姿勢におけるツール先端の位置ずれは、計測プローブの先端にある球体の位置ずれとなる。計測プローブの球体は３つの変位計の各平面接触子の計測面に接しているため、球体の位置ずれ量すなわちロボットの各姿勢におけるツール先端の位置ずれ量は、治具に備えられた３つの変位計により実績位置ずれ量として計測される。

実績位置ずれ量は、本願発明者らが開発したロボットのツールベクトルの導出方法に適用され、ロボットのアーム先端に取り付けられたツールの先端位置を決定するツールベクトルが算出されることになる。
上記したツールベクトルとは、ロボットのツール座標系とフランジ座標系とをつなぐパラメータであるツールパラメータ（Ｔ_x，Ｔ_y，Ｔ_z，α，β，γ）の中で、並進成分（Ｔ_x，Ｔ_y，Ｔ_z）のみを取り出したものである。

なお好ましくは、前記配備手段は、互いの先端部又は互いの軸芯を先端側へ延長した線が１点で直交する３つの支柱と、前記支柱の軸芯方向に前記計測軸が平行となると共に前記平面接触子の計測面が支柱の先端側を向くように、３つの支柱の各々に前記変位計を取り付けるクランプ部材と、を有するとよい。
この構成を有する治具であれば、支柱は載置面に対して斜め上方に立ち上がるようになっており、３つの支柱の交点より上方は開放空間となっている。それ故、上方から接近するような姿勢を有するロボットが３つ以上の様々な姿勢を採用したとしても、治具と接触・干渉する可能性は非常に低いものとなる。

更に好ましくは、前記３つの変位計により設定される計測座標系の原点が各変位計の原点位置に一致するように、各支柱に変位計が取り付けられているとよい。
また、前記計測用プローブの先端側に設けられた球体の直径が、前記平面接触子の計測面の代表長さと同等又は代表長さより大きいとよい。

本発明に係る治具を用いれば、作業者の熟練度や技量などに因らず、より簡便に短時間にしかも精度よくロボットのツールベクトルを導出することが可能となる。

本発明の実施形態に係るロボットシステムの全体構成図である。 ツール座標系とフランジ座標系との関係を示す概念図である。 本発明の実施形態に係る導出治具の斜視図である。 本発明の実施形態に係る導出治具の平面図である。 本発明の実施形態に係る導出治具の側面図である。 支柱保持部材の拡大側面図である。 （ａ）は、変位計の原点を調整する原点調整具の側面図であり、（ｂ）は、ロボットに取り付けられる計測用プローブの側面図である。 本発明の実施形態に係る導出治具の使用態様図である。 本発明の実施形態に係る導出治具の設置手順を示すフローチャートである。 ツールベクトルの導出手順を示すフローチャートである。

本発明に係るロボットのツールベクトルの導出に用いる治具の実施形態を、図を基に説明する。
なお、ツールベクトルの導出の際に用いる治具（以降、導出治具１０と呼ぶ）は、本願発明者らが鋭意研究の末、想到した「ロボットのツールベクトルの導出方法及び較正方法」を行う際に最も適した専用の計測器である。

そこで、まずは、本発明に係るロボットシステム１の概略を述べ、続いて、本発明に係る導出治具１０の説明を行う。その後、導出治具１０を用いたツールベクトルの導出方法及び較正方法について述べることとする。
なお、以下の説明では、同一の部品には同一の符号を付してある。それらの名称及び機能も同じである。したがって、それらについての詳細な説明は繰返さない。

まず、本実施形態に係るロボットシステム１の全体構成について説明する。
図１に示すように、ロボットシステム１は、溶接ロボット２と、教示ペンダント３を備えた制御装置４と、パソコン５（パーソナルコンピュータ）とを含む。溶接ロボット２は垂直多関節型の６軸の産業用ロボットであり、その先端に溶接トーチなどから構成される溶接ツール６（単にツール６と呼ぶこともある）が設けられている。この溶接ロボット２はそれ自体を移動させるスライダ（図示せず）に搭載されていてもよい。

制御装置４は、溶接ロボット２を、予め教示したプログラムに従って制御する。教示プログラムは、制御装置４に接続された教示ペンダント３を使用して作成する場合や、パソコン５を利用したオフライン教示システムを使用して作成する場合がある。いずれの場合であっても、教示プログラムは、実際の動作の前に予め作成される。パソコン５により作成されたプログラムは、磁気的にデータを記憶した媒体等を介して制御装置４に受渡しされたり、データ通信により制御装置４に転送されたりする。

パソコン５、すなわちオフライン教示システムは、表示装置としてグラフィック表示可能なディスプレイを備え、入力装置としてキーボード又はマウスを備える。また、ワークのＣＡＤ情報を取込むために、磁気記憶装置又は通信装置が設けられている。
ところで、本願発明は、ツール先端の位置を正確に把握するために必要なツールパラメータ（特にツールベクトル）を正しく導出するための方法に最適な治具に関するものである。

図２に示す如く、このツールパラメータとは、溶接ツール６の先端部（溶接点）の位置座標すなわちツール座標系を、溶接ロボット２の先端部に形成されているフランジ部に設定された座標系であるフランジ座標系から座標変換するものであり、このフランジ座標系は、溶接ロボット２の各軸のデータより制御装置４にて計算可能となっている。つまり、ツールパラメータを用いることで、制御装置４によりツール先端の位置座標を算出することが可能となる。

ところで、ロボットのツールパラメータには（Ｔ_x，Ｔ_y，Ｔ_z，α，β，γ）の並進３成分と回転３成分とがあるが、本発明は、ツールパラメータの中の並進成分（Ｔ_x，Ｔ_y，Ｔ_z）である「ツールベクトル」を導出する方法を開示する。この方法は、後述する導出治具１０を用いてツール先端の位置のずれ量を計測し、制御装置４やパソコン５内において、計測されたずれ量を基にツールベクトルを算出するものである。

次に、本発明で使用する導出治具１０について説明する。
図３〜図７に示す如く、導出治具１０は、距離変位計であるダイヤルゲージ１１（接触式の変位計）を３台有しており、ツール６の先端の３次元的な変化量を正確に捉えるために、各ダイヤルゲージ１１は、配備手段１５を用いてそれぞれが直交する方向に配備するされている。この導出治具１０により構成される計測座標に関しては、その原点位置を導出治具１０の原点と一致するようにしている。

一方、ロボットの先端であるフランジ面７に取り付けられている溶接ツール６に関しては、溶接ツール６の先端に計測用プローブ１２を取り付ける。図７（ｂ）に示す如く、この計測用プローブ１２は、その先端部に鋼球などから構成される球体１３を有し、この球体１３の中心が溶接ツール６の先端（計測したいツール先端）の位置となるように位置づけられる。前述したダイヤルゲージ１１の先端は、球体１３の位置の変化量を確実にセンシングできるように、円柱体などで構成され平面接触子１４となっている。溶接ロボット２が様々な姿勢をとったとしても、計測用プローブ１２の球体１３は平面接触子１４の先端にある計測面（円形の平面）に点接触するため、導出治具１０は球体１３の位置の変化量を確実に検出できる。

以下、本実施形態の導出治具１０に関し、詳細に説明する。
図３〜図５には、本発明の実施形態に係るツールベクトルの導出に用いる治具１０の全体構成が示されている。
導出治具１０は、配備手段１５を構成する部材の一つである支柱２０を３本備えている。この３本の支柱２０は、三又状に配備され、それぞれが長尺の丸棒（φ１０ｍｍ程度）からなり長さ約２０ｃｍ程度で同尺である。３本の支柱２０は、互いの先端部が１点で交わり（又は、軸芯を当該支柱２０の先端側へ延長した線が１点で交わり）、その交差角は互いが正確に９０°となるように配備されている。

３つの支柱２０間の位置関係（三又状）を固定的なものとするために、それぞれの支柱２０の先端部は、図６に示すような支柱保持部材２１に差し込まれるようになっている。この支柱保持部材２１は、配備手段１５を構成する部材の一つである。
支柱保持部材２１は立方体形状（一辺が約２０ｍｍ）を有しており、各面が正方形となっている６面を備えている。支柱保持部材２１の互いに隣接する３面（支柱挿入面３４）には、支柱２０を差し込み可能とする挿入孔２２が設けられている。挿入孔２２の軸芯は支柱挿入面３４に垂直とされ、挿入孔２２には雌ネジ部が形成されている。この挿入孔２２に支柱２０の先端部（雄ネジ部が形成）が螺合し固定される。固定後の支柱２０の張り出し長さ（支柱挿入面３４〜支柱２０の基端部の長さ）は、各支柱２０で同じとされている。

一方、挿入孔２２が穿孔された３面（支柱挿入面３４）が交わる頂点を考えた場合、その頂点とは反対側の頂点に対応する部分は、角が約１０ｍｍほど切り落とされ切断平面２３とされている。言い換えるならば、この切断平面２３は、支柱挿入面３４に対向する３つの面を考え、それら対向する面の一方辺を一部分だけ切り欠くことで形成された面となっている。

この切断平面２３は、支柱２０の基端部が載置面Ｆ（溶接ロボット２が載置された床面）の上に搭載された場合、各支柱２０は載置面Ｆとの角度４５°にて立ち上がるようになり、切断平面２３は、載置面Ｆと正確に平行（載置面Ｆからの傾き角０°）となる。それ故、切断平面２３は、後述する計測用プローブ１２の動きを妨げないものとなっている。
一方、各支柱２０の中途部には接触式の変位計１１が取り付けられている。本実施形態の場合、変位計１１は、０．０１ｍｍオーダまで計測可能なダイヤルゲージを採用している。

このダイヤルゲージ１１は、計測機器が内蔵されると共に、計測データ（測定実績値）が表示される窓を備えたゲージ本体２８と、このゲージ本体２８から伸縮自在に突出する計測針２９を有している。この計測針２９の先端部には、平面板や円柱体などで構成され平面接触子１４が備えられている。平面接触子１４の先端部に設けられた計測面１４Ａ（計測平面部）に対し垂線方向に計測針２９が伸縮し、その移動量が計測できるようになっている。

この平面接触子１４（正確には計測面１４Ａ）の移動量をゲージ本体２８で計測し、計測結果を溶接ロボット２のツール先端の実績位置ずれ量とする。
ところで、本実施形態の場合、ダイヤルゲージ１１は、クランプ部材３０を介して支柱２０に取り付けられている。このクランプ部材３０は、配備手段１５を構成する部材の一つである。

クランプ部材３０は略直方体形状であって、その長手方向一方側に支柱２０が貫通する貫通孔３２が形成され、支柱２０の任意の位置でボルト等により固定可能となっている。このクランプ部材３０の長手方向他方側にゲージ本体２８が固定されるようになっている。このクランプ部材３０により、「支柱２０の軸芯」と「ダイヤルゲージ１１の計測方向（計測針２９の伸縮方向）」とが平行で且つ平面視で一致するようにダイヤルゲージ１１が設置されている。また、平面接触子１４の計測面１４Ａは、支柱２０の先端側を向くと共に、平面接触子１４が切断平面２３のほぼ直上に位置するものとなっている。

以上の構成を備えているため、後述する計測用プローブ１２の球体１３を３つの平面接触子１４で挟み込むようにすることで、３つのダイヤルゲージ１１により、溶接ロボット２のツール先端に関し、直交する３方向（互いに独立な３方向）の距離変化を確実に計測することが可能となる。
ところで、支柱保持部材２１に形成された切断平面２３の中央部には、当該平面２３に軸芯が垂直となるように穿かれた穿孔２５が設けられ、この穿孔２５に原点調整具２４が嵌り込むようになっている。

図７（ａ）には、原点調整具２４の側面図が示されている。この図に示されるように、原点調整具２４は、棒径が４ｍｍ程度の棒体２６を備え、この棒体２６の先端部には直径１０ｍｍの球体２７が設けられている。棒体２６の基端は穿孔２５孔に嵌り込む嵌り込み部を有し、その棒径は、穿孔２５と同じ又は若干小径とされている。
切断平面２３の穿孔２５に原点調整具２４が差し込まれた場合、球体２７の中心が計測座標系の原点と一致するように、原点調整具２４の棒体２６の長さなどが決定されている。

図７（ｂ）には、計測用プローブ１２（キャリブレーションチップ）の側面図が示されている。
この図に示されるように、計測用プローブ１２は長さ４０ｍｍ程度の棒体３１を備え、この棒体３１の先端部には直径１０ｍｍの球体１３が設けられている。この計測用プローブ１２は導出治具１０を構成する一部材ではあるものの、溶接ロボット２の先端部（溶接ワイヤを取り去った後の溶接ツールの先端部）に取り付けられる。それ故、計測用プローブ１２の棒体３１の基端には、溶接ロボット２のアーム先端に取り付き可能なようにネジ部３３が形成されている。

ところで、ダイヤルゲージ１１の先端には平面接触子１４が設けられているため、溶接ロボット２が様々な姿勢をとったとしても、計測用プローブ１２の球体１３は平面接触子１４の計測面１４Ａに必ず点接触することとなり、導出治具１０は球体１３の位置の変化量を確実に検出できる。
また、計測用プローブ１２の先端側に設けられた球体１３の直径は、ダイヤルゲージ１１の平面接触子１４の計測面１４Ａの代表長さ（直径）と同等か、もしくは代表長さより大きい（例えば、約２倍）とされている。こうすることで、計測針２９が、±（計測面１４Ａの直径／２）の範囲内で移動したとしても、球体１３と計測面１４Ａとの接触状態は維持されて、ダイヤルゲージ１１での距離変位の計測が可能となる。例えば、平面接触子１４の計測面１４Ａの直径が１０ｍｍである場合、ダイヤルゲージ１１は原点を中心として±５ｍｍの変位を計測可能となる。

さらに、球体１３の直径が平面接触子１４の代表長さ（直径）より大きい、言い換えるならば、平面接触子１４が球体１３に比して小さいことにより、球体１３が例えばＸ方向に大きく移動し、それに伴い平面接触子１４が同方向に移動したとしても、当該平面接触子１４が他の平面接触子１４（Ｙ方向やＺ方向に移動する平面接触子１４）に接触、干渉するといった不都合を回避可能な構成となっている。

以上述べた導出治具１０を用いて、ツールベクトルの導出する方法について、以下述べることとする。
具体的には、導出の準備として、図９のフローチャートに従って、導出治具１１の設置を行う。
まず、図９のＳ１１に示す如く、支柱保持部材２１に３つの支柱２０をねじ込み、各支柱２０にダイヤルゲージ１１を取り付けて導出治具１０を組み立てる。組み上がった導出治具１０をツールベクトルを算出する対象である溶接ロボット２が設置されている載置面Ｆ上に配置する。

Ｓ１２で、支柱保持部材２１の切断平面２３に原点調整具２４を立設するように取り付けて、その後、この原点調整具２４の球体２７を用いてダイヤルゲージ１１の原点調整を行う。
詳しくは、この原点調整具２４の球体２７に平面接触子１４の計測面１４Ａが接するようにした上で、その時のダイヤルゲージ１１の測定値がほぼ０となるように、ダイヤルゲージ１１を支柱２０上でスライドさせ、その上で支柱２０に対するダイヤルゲージ１１の位置を固定する（クランプ部材３０のボルトを締め付ける）。

こうすることで、後のツールベクトル導出作業において、ロボット姿勢の変更に伴って、計測用プローブ１２の球体１３の位置が変動したとしても、ダイヤルゲージ１１はプラス側への距離変動も計測可能となると共に、マイナス側への距離変動も移動できるようになり、球体１３の位置変動を最大限のレンジで計測できるようになる。加えて、原点調整具２４の球体２７の中心は計測座標系の原点と一致するように設定されているため、Ｓ１２の作業を行うことで、計測座標系の原点が各ダイヤルゲージ１１の原点位置に確実に一致するようになる。

その後、Ｓ１３，Ｓ１４で、ロボット側の溶接ツールの先端に計測用プローブ１２を取り付け、溶接ロボット２のツール先端が計測座標系の原点（空間上の所定点）の近傍に位置するようにロボット姿勢を取らせる。その上で、計測用プローブ１２の球体１３を導出治具１０の３つの平面探触子１４で三方から挟み込むようにする。
なお、以上の説明では、溶接ロボット２の近傍で、導出治具１１の組み立て・設置を行うことを例示したが、事前作業のやり方はこれに限定されない。別の場所で、導出治具１１の組み立て、原点位置の調整を行っても何ら問題はない。

以上の事前準備を行った後に、溶接ロボット２のツール先端が空間上の所定点の近傍に位置するような３つ以上の姿勢を溶接ロボット２に対してとらせ、各姿勢におけるツール先端の位置ずれ量である実績位置ずれ量を計測する作業を行うようにする。
具体的には、溶接ロボット２に対して３つ以上の姿勢をとらせた場合、各姿勢におけるツール先端の位置ずれは、計測プローブ１２の先端にある球体１３の位置ずれとなる。球体１３は、３つの変位計１１の各平面接触子１４の計測面１４Ａに接しているため、球体１３の位置ずれ量は、導出治具１０に備えられた３つの変位計１１により実績位置ずれ量として計測される。

計測された実績位置ずれ量は、ツールベクトルの導出方法に適用され、ツールベクトルが算出されることになる。
ところで、導出治具１０（３台のダイヤルゲージ１１）の各計測方向を、ロボット座標系の軸方向と一致するように配置できれば、各ダイヤルゲージ１１の計測値が対応するロボット座標系での計測値となる。しかしながら、ダイヤルゲージ１１の計測方向は斜め上方４５°であって、ロボット座標系の軸方向と一致するものとはなっていない。ダイヤルゲージ１１の計測方向とロボット座標系の軸方向とは、所定の変換行列をもってして関係付けられるかもしれないが、設置時の配置誤差などの影響を完全に排除することは困難である。

係る状況を回避するために、以下の手順で計測座標系を設定する（補正する）ことは好ましい。
すなわち、
(i) 導出治具１０の原点近傍にロボット先端を位置決めし、この位置を導出治具１０で計測する。このときの計測値をＭ１（Ｍ１_x，Ｍ１_y，Ｍ１_z）とする。

(ii) ロボットを(i)の姿勢のまま治具の計測範囲を超えない範囲でロボット座標系でＸ軸方向にのみ動作させ、その時の位置を導出治具１０で計測する。このときの計測値をＭ２（Ｍ２_x，Ｍ２_y，Ｍ２_z）とする。
(iii) ロボットを(i)の位置に戻し、ロボットを(i)の姿勢のまま治具の計測範囲を超えない範囲でロボット座標系でＹ軸方向にのみ動作させ、その時の位置を導出治具１０で計測し、計測値をＭ３（Ｍ３_x，Ｍ３_y，Ｍ３_z）とする。

(iv) 以下の手順で計測値をロボット座標軸に合致した計測座標系に変換するマトリックス^roboＧ_mesを導出する。

なお、［数１］におけるＵは、導出治具１０から見たロボットのＸ軸方向、Ｖは導出治具１０から見たロボットのＹ軸方向、Ｗは導出治具１０から見たロボットのＺ軸方向であり、^mesＧ_roboは、導出治具１０からみたロボット座標系（原点は計測座標）を表しており、計測座標系をロボット座標系へ変換する変換行列である。
この^mesＧ_roboを用いることで、導出治具１０の各計測方向とロボット座標系の軸方向とが一致した配置を（仮想的に）実現することができる。本実施形態においても、この^mesＧ_roboを用いることとする。

一方、詳細は後述するが、ツールベクトルの導出では、各姿勢におけるツール先端の位置のずれ量である「実績位置ずれ量」を計測し、計測された「実績位置ずれ量」からツールベクトルを算出するため、導出治具１０での計測値の差分（変化量）が重要であって、原点のシフト量は最終的に相殺され不要である。それ故、^mesＧ_roboの逆行列で定義される^roboＧ_mesは、導出治具１０の原点位置を基準に座標軸をロボット直交座標軸で表現したもので十分であり、ロボット座標系からの計測座標原点の位置ベクトルを正確に推定する必要はない。

なお、導出治具１０の各ダイヤルゲージ１１の計測値Ｍ（Ｍ_x，Ｍ_y，Ｍ_z）を計測座標系での計測値Ａ（Ａ_x，Ａ_y，Ａ_z）に変換するには、以下の変換を行えばよい。

本実施形態での計測値は、特に断らない限りこの変換を行った（軸方向はロボット直交座標軸に一致した）計測座標系での値とする。
以上まとめれば、［数２］で示す変換を行うことで、導出治具１０の計測値はロボット直交座標軸に一致した計測座標系での値となり、導出治具１０の各計測方向がロボット座標系の軸方向と一致していない場合でも、正確な計測値を確実に得ることができるようになる。

このようにして得られた正確な計測値を基に、ツールベクトルを導出する方法を以下に述べる。
まず、図１０のＳ２１に示す如く、まず、オペレータは、教示ペンダント３により計測用プローブ１２の球体１３を導出治具１０の計測範囲の所定位置Ｐに設定する。この所定位置Ｐは、導出治具１０の原点近傍であることが好ましい。

その後、Ｓ２２のように、導出治具１０の計測値Ａ₁（Ａ_1x，Ａ_1y，Ａ_1z）を計測すると共に、ロボットの各軸値を計測する。得られたロボットの各軸値を基に、所定位置Ｐのロボット座標系での位置Ｐ₁（Ｐ_1x，Ｐ_1y，Ｐ_1z）、フランジ座標系での位置Ｆ₁（ｌ_1x，ｌ_1y，ｌ_1z,ｍ_1x，ｍ_1y，ｍ_1z,ｎ_1x，ｎ_1y，ｎ_1z,ｏ_1x，ｏ_1y，ｏ_1z）を求める。
これらＡ₁（Ａ_1x，Ａ_1y，Ａ_1z）、Ｐ₁（Ｐ_1x，Ｐ_1y，Ｐ_1z）、Ｆ₁（ｌ_1x，ｌ_1y，ｌ_1z,ｍ_1x，ｍ_1y，ｍ_1z,ｎ_1x，ｎ_1y，ｎ_1z,ｏ_1x，ｏ_1y，ｏ_1z）、の関係は、フランジ面７から見たツール先端を定義するツールベクトルをＴ（Ｔ_x，Ｔ_y，Ｔ_z）とすると，式（１）で表すことができる。

次に、Ｓ２４の如く、ツール６の姿勢を変化させ、Ｓ２１で採用した姿勢とは異なる姿勢で導出治具１０の計測範囲の所定位置Ｐに位置決めする。
このとき（ｋ番目）のロボット座標での位置をＰ_k、ロボットのフランジ座標系をＦ_kとすると、式（２）が得られる。なお、導出治具１０の座標系で計測したｋ番目の値をＡ_k（Ａ_kx，Ａ_ky，Ａ_kz）とすると、Ａ_kの計測座標系とＰ_kのロボット座標系は軸方向が一致しているため、式（３）に示すように変化量は一致する。

なお、採用する姿勢は、３姿勢以上であることが好ましいため、Ｓ２３に示すように、３姿勢に達していない場合は、更に別の姿勢を採用する。

ここで、ｎ回計測した（ｎ姿勢を採用した）とすると、式（１），式（２）をまとめて、

となる。
また、式（３）と式（４）から関係から、式(５)が成立する。

ここで、ツールベクトルの初期値をＴ₀（Ｔ_0x，Ｔ_0y，Ｔ_0z）として、収束計算ｉ番目に導出されたツールベクトルをＴ_i（Ｔ_ix，Ｔ_iy，Ｔ_iz）とすると、式（４），式（５）は以下のようになる。

式（７）のツールベクトルＴから演算された先端位置Ｐの各差分が、計測値の差分になるようなツールベクトルＴを求めるとよい。言い換えるならば、ツールベクトルを用いて算出されるツール６の先端位置の「計算上の位置ずれ量（Ｐ_in−Ｐ_i1）」と、ツール６の先端位置の計測値から得られる「実績位置ずれ量（Ａ_n−Ａ₁）」とが一致するようなツールベクトルＴを求めるとよい。

そのために、Ｓ２５に示す如く、以下の方程式をΔＡが０になるように、最小二乗法を用いた収束計算を行い解くことで、ツールベクトルＴを求めることができる。

以上の方法で、溶接ロボット２の先端を、導出治具１０の計測範囲に複数回設定するといった同一点への正確な位置決め操作が不要な簡単な操作で、ツールベクトルＴ（Ｔ_x，Ｔ_y，Ｔ_z）を導出することが可能となる。
ただし、上記したやり方であると、１番目の計測値を基準（位置ずれ量の算出の基準）としているため、誤差の存在状況によっては、得られるツールベクトルに誤差が生じる場合も否めない。そこで、基準を１番目からｎ番目まで順次使用した式（９）を解くことで、計測誤差を極力廃することが可能となる。

以上述べた、溶接ロボットのツールベクトルの導出方法を採用することで、より簡便に短時間にしかも属人性を排除しつつ精度よくロボットのツールツールベクトルを導出することができるようになり、ロボット溶接における溶接精度や溶接品質の向上に寄与できることとなる。
なお、今回開示された実施形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。

例えば、本実施形態では、溶接ロボット２のツール６を交換した後をイメージし、ツール６交換後におけるツールベクトルの導出作業を説明したが、ツール６が作業ワーク等に衝突したときなどツールベクトルの変更が生じたときの「ツールベクトルの較正作業」においても同様の手法を用いることができる。
また、本実施形態ではロボットとして溶接ロボットを例示したが、組み立てロボットなどの作業用ロボットであっても本技術は採用可能である。

導出治具１０は、３本の支柱２０を支柱保持部材２１で結束する構成を備えていたが、この構成に限定されるものではない。例えば、導出治具１０は、３本の支柱２０を一体成形したものであってもよい。

１ ロボットシステム
２ 溶接ロボット
３ 教示ペンダント
４ 制御装置
５ パソコン
６ 溶接ツール
７ フランジ面
１０ 導出治具（計測器）
１１ ダイヤルゲージ
１２ 計測用プローブ
１３ 球体（計測用プローブ）
１４ 平面接触子
１５ 配備手段
２０ 支柱
２１ 支柱保持部材
２２ 挿入孔
２３ 切断平面
２４ 原点調整具
２５ 穿孔
２６ 棒体（原点調整具）
２７ 球体（原点調整具）
２８ ゲージ本体
２９ 計測針
３０ クランプ部材
３１ 棒体（調整用プローブ）
３２ 貫通孔
３３ ネジ部
３４ 支柱挿入面
Ｆ 載置面

Claims (5)

1. ロボットのアーム先端に取り付けられたツールの先端位置を決定するツールベクトルを導出するに際し、前記ロボットのツール先端が空間上の所定点の近傍に位置するように、前記ロボットに対して３つ以上の姿勢をとらせ、各姿勢におけるツール先端の位置ずれ量を計測して実績位置ずれ量とし、計測された実績位置ずれ量を基にツールベクトルを算出するロボットのツールベクトルの導出方法で使用する治具であって、
   先端部に平面接触子が備えられると共に、前記平面接触子に備えられた計測面に対し垂直方向を向く計測軸に沿った距離変位を計測可能な３つの変位計と、
   前記３つの変位計の各計測軸が１点で互いに直交すると共に各計測軸の交点が前記空間上の所定点となるように、３つの変位計を配備する配備手段と、
   を有することを特徴とするロボットのツールベクトルの導出に用いる治具。
2. 先端側に球体が設けられた計測用プローブを有していて、
   前記計測用プローブはその基端側が前記ロボットのアーム先端に取り付けられ、且つ前記球体が前記３つの変位計の各平面接触子の計測面に接するように、前記ロボットの姿勢が設定されることを特徴とする請求項１に記載のロボットのツールベクトルの導出に用いる治具。
3. 前記配備手段は、
   互いの先端部又は互いの軸芯を先端側へ延長した線が１点で直交する３つの支柱と、
   前記支柱の軸芯方向に前記計測軸が平行となると共に前記平面接触子の計測面が支柱の先端側を向くように、３つの支柱の各々に前記変位計を取り付けるクランプ部材と、
   を有することを特徴とする請求項１又は２に記載のロボットのツールベクトルの導出に用いる治具。
4. 前記３つの変位計により設定される計測座標系の原点が各変位計の原点位置に一致するように、各支柱に変位計が取り付けられていることを特徴とする請求項３に記載のロボットのツールベクトルの導出に用いる治具。
   
5. 前記計測用プローブの先端側に設けられた球体の直径が、前記平面接触子の計測面の代表長さと同等又は代表長さより大きいことを特徴とする請求項１〜４のいずれかに記載のロボットのツールベクトルの導出に用いる治具。