(57)【特許請求の範囲】
【請求項１】
動作点を三次元的に移動するためのロボットの座標系であるロボット座標系と、光切断法を実行可能であり前記動作点に対する位置及び姿勢が不変である三次元計測器の座標系である計測器座標系をアライメントする方法であって、
前記動作点の動作空間の座標系である動作空間座標系における原点に位置する第１基準点、該第１基準点で直交する2つの直線上にそれぞれ位置する第２基準点及び第３基準点に前記動作点を移動させて各基準点の位置をティーチングすることにより、前記動作空間座標系と前記ロボット座標系の関係を決定し、
前記動作空間座標系を規定する直交三軸のうちの二軸が載る平面に対して平行に配置された板状部材の表面に、該直交三軸のそれぞれに対して各辺が平行になるように固定された直方体状の参照物体に対し、前記三次元計測器からシート状のスリット光を照射して、該スリット光による前記参照物体への投映線を取得し、
前記投映線のプロファイルに基づいて、前記参照物体に対する前記三次元計測器の姿勢を求め、
前記三次元計測器の姿勢が所定の基準姿勢範囲内に入るように前記三次元計測器を移動させる
工程を有することを特徴とするロボット用の座標系アライメント方法。
【請求項２】
前記三次元計測器の姿勢が所定の基準姿勢範囲内に入るように前記三次元計測器を移動させたあと、さらに、
前記参照物体の所定位置の、前記動作空間座標系における座標と、前記計測器座標系における座標を比較して差分を求め、
前記計測器座標系を前記差分だけシフトさせる
工程を有することを特徴とする請求項１に記載のロボット用の座標系アライメント方法。
【請求項３】
前記動作空間座標系において、前記第１基準点が原点であり、前記第２基準点及び前記第３基準点が該座標系の軸上の点であることを特徴とする請求項１又は２に記載のロボット用の座標系アライメント方法。
【請求項４】
前記参照物体の三辺が前記動作空間座標系の三軸に平行になるように該参照物体が配置されていることを特徴とする請求項１から３のいずれかに記載のロボット用の座標系アライメント方法。
【請求項５】
前記スリット光が、前記計測器座標系の一軸方向に幅を有し、該計測器座標系の別の一軸方向に発せられる光であることを特徴とする請求項１から４のいずれかに記載のロボット用の座標系アライメント方法。
【請求項６】
動作点を三次元的に移動するためのロボットの座標系であるロボット座標系と、光切断法を実行可能であり前記動作点に対する位置及び姿勢が不変である三次元計測器の座標系である計測器座標系をアライメントするシステムであって、
前記動作点の動作空間の座標系である動作空間座標系における原点に位置する第１基準点、該第１基準点を通り直交する2つの直線上にそれぞれ位置する第２基準点、及び第３基準点に前記動作点を移動させて各基準点の位置をティーチングすることにより、前記動作空間座標系と前記ロボット座標系の関係を決定する動作空間座標系設定部と、
前記動作空間座標系を規定する直交三軸のうちの二軸が載る平面に対して平行に配置された板状部材の表面に、該直交三軸のそれぞれに対して各辺が平行になるように固定された直方体状の参照物体に対し、前記三次元計測器からシート状のスリット光を照射して、該スリット光による前記参照物体への投映線を取得する投映線取得部と、
前記投映線のプロファイルに基づいて、前記参照物体に対する前記三次元計測器の姿勢を求める計測器姿勢算出部と、
前記三次元計測器を移動させる計測器移動部と
を備えることを特徴とするロボット用の座標系アライメントシステム。
【請求項７】
動作点を三次元的に移動するためのロボットの座標系であるロボット座標系に予め対応付けられた前記動作点の動作空間の座標系である動作空間座標系と、光切断法を実行可能であり前記動作点に対する位置及び姿勢が不変である三次元計測器の座標系である計測器座標系をアライメントするために用いられる装置であって、
前記動作空間座標系を規定する直交三軸のうちの二軸が載る平面に対して平行に配置された板状部材の表面に、該直交三軸のそれぞれに対して各辺が平行になるように固定された直方体状の参照物体に対し、前記三次元計測器からシート状のスリット光を照射して、該スリット光による前記参照物体への投映線を取得する投映線取得部と、
前記投映線のプロファイルに基づいて、前記参照物体に対する前記三次元計測器の姿勢を求める計測器姿勢算出部と、
を備えることを特徴とするロボット用の座標系アライメント装置。
【請求項８】
さらに、
前記参照物体の所定位置の、前記動作空間座標系における座標と、前記計測器座標系における座標を比較して差分を求め、前記計測器座標系を前記差分だけシフトさせる座標系シフト部
を備えることを特徴とする請求項７に記載のロボット用の座標系アライメント装置。
【請求項９】
さらに、
前記計測器姿勢算出部によって前記三次元計測器の姿勢が求められる毎に、前記参照物体に対する前記三次元計測器の姿勢を表示する表示部
を備えることを特徴とする請求項７又は８に記載のロボット用の座標系アライメント装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、対象物に対して所定の動作を実行するロボットの動作を制御する基準となる座標系と、該ロボットに取り付けて用いられる三次元計測器の座標系をアライメントする技術に関する。
【背景技術】
【０００２】
工場の製造ラインでは、製品の組み立てや加工の効率を高めるために産業用ロボットが用いられている。産業用ロボットは、先端部を三次元的に移動可能なアームと、該先端部に取り付けられ被処理物に所定の処理を施す治具とを備えている。また、アームの先端部には三次元計測器が取り付けられており、例えば光切断法により被処理物を三次元的に計測してその位置及び向きを特定する。
【０００３】
産業用ロボットには、製造時等に予めメーカによって座標系が設定されており、アームの動作はその座標系に基づいて制御される。一方、前記三次元計測器は、該三次元計測器自身が有する座標系に基づく計測結果を出力する。従って、三次元計測器により位置及び向きが特定された被処理物の処理対象の位置に治具を移動するには、ロボットの座標系と三次元計測器の座標系を整合させる（アライメントする、又はキャリブレーションするとも言う）必要がある。
【０００４】
従来、両座標系のアライメントには行列演算によるアフィン変換が用いられている（例えば特許文献１）。特許文献１に記載のアライメント方法では、アームの先端に取り付けた三次元計測器を、同一直線上にない3つの位置に移動させ、それぞれの位置で対象物の同一箇所を計測して、三次元計測器の座標系での座標値を取得する。そして、前記3つの位置のロボットの座標系での座標値と、各位置で取得した三次元計測器の座標系での座標値を用いて行列式を作成し、それらの行列式から得られる方程式を解くことにより三次元計測器の座標系をロボットの座標系に変換する変換行列を得る。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開平8-132373号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
特許文献１に記載のアライメント方法では、変換行列を得るために、3つの位置のそれぞれに対応する行列式を展開して複雑な方程式を解く必要がある。また、ロボットの動作を制御するプログラムの開発環境（開発言語）はメーカによって異なる。そのため、種々のプログラム言語を理解して行列演算を行うことが可能な熟練者でなければアライメントを行うことが難しいという問題があった。
【０００７】
本発明が解決しようとする課題は、熟練者でなくても容易にロボット座標系のアライメントを行うことができる技術を提供することである。
【課題を解決するための手段】
【０００８】
上記課題を解決するために成された本発明の一態様は、動作点を三次元的に移動するためのロボットの座標系であるロボット座標系と、光切断法を実行可能であり前記動作点に対する位置及び姿勢が不変である三次元計測器の座標系である計測器座標系をアライメントする方法であって、
前記動作点の動作空間の座標系である動作空間座標系における原点に位置する第１基準点、該第１基準点で直交する2つの直線上にそれぞれ位置する第２基準点、及び第３基準点に前記動作点を移動させて各基準点の位置をティーチングすることにより、前記動作空間座標系と前記ロボット座標系の関係を決定し、
前記動作空間座標系を規定する直交三軸のうちの二軸が載る平面に対して平行に配置された板状部材の表面に、該直交三軸のそれぞれに対して各辺が平行になるように固定された直方体状の参照物体に対し、前記三次元計測器からシート状のスリット光を照射して、該スリット光による前記参照物体への投映線を取得し、
前記投映線のプロファイルに基づいて、前記参照物体に対する前記三次元計測器の姿勢を求め、
前記三次元計測器の姿勢が所定の基準姿勢範囲内に入るように前記三次元計測器を移動させる
工程を有することを特徴とする。
【０００９】
上記姿勢とは、座標系の軸や所定面などの基準に対する傾きや向きを意味する。また、光切断法を実行可能な三次元計測器とは、計測器座標系に対する姿勢が既知であるスリット光を対象物に照射し、該スリット光による対象物の各面への投映線のデータを取得して、該対象物の三次元形状に関する情報を取得可能な計測器をいう。さらに、上記動作空間とは、ロボットの動作点が動作する空間をいう。
【００１０】
本発明に係るアライメント方法では、まず、動作空間座標系における原点に位置する第１基準点、該第１基準点で直交する2つの直線上にそれぞれ位置する第２基準点及び第３基準点のそれぞれにロボットの動作点を移動させてティーチングし、ロボット座標系と動作空間座標系の関係を決定する。つまり、第１基準点及び第２基準点により動作空間座標系の第１軸が規定され、第１基準点及び第３基準点により第２軸が規定され、さらに、これらの二軸に直交する軸として第３軸が規定される。
【００１１】
次に、動作空間座標系を規定する直交三軸のうちの二軸が載る平面に対して平行に板状部材の表面に、該直交三軸のそれぞれに対して各辺が平行になるように固定された直方体状の参照物体に対して、三次元計測器からスリット光を照射して、該スリット光による参照物体の各面への投映線を取得する。そして、取得した投映線のプロファイルに基づいて参照物体に対する三次元計測器の姿勢を求める。この投映線のプロファイルには、参照物体の上面への投映線の長さ、及び該参照物体の上面への投映線と板状部材の面（参照物体が載置されている面）への投映線の間の距離、及び三次元計測器の座標軸に対するそれらの投映線の傾きが含まれる。そして、三次元計測器の姿勢が所定の基準姿勢範囲内に入るように三次元計測器を移動させる。投映線のプロファイルから三次元計測器の姿勢を求める具体的な方法は後述する。
【００１２】
ここで、理解を容易にするため、参照物体が動作空間座標系の二軸（これをX軸及びY軸とする）を含む平面上に、Z軸とも平行になるように配置されており、また、シート状のスリット光が計測器座標系X'軸方向に幅を有してZ'軸方向に照射され、さらに、三次元計測器の姿勢が参照物体に対して略平行となる（即ち、この例ではロボット座標系と計測器座標系の3軸が相互に略平行である）ように基準姿勢範囲が設定されている場合の具体的な一例を説明する。このとき、計測器座標系の三軸が動作空間座標系の三軸と平行に（従って、参照物体の三辺とも平行に）なっていれば、参照物体の上面に照射されるスリット光の長さは該参照物体の上面の幅と一致する。また、参照物体の上面への投映線と板状部材の面（参照物体が載置されている面）への投映線の間の距離は、参照物体の高さに基づく所定の値となる。さらに、これらの投映線は三次元計測器のX'軸に対して平行になる。
【００１３】
一方、計測器座標系が、動作空間座標系のZ軸周りに大きく回転しているほど参照物体の上面に照射されるスリット光の長さが長くなる。また、計測器座標系が前記平面内の一軸（これをY軸とする）周りに動作空間座標系に対して傾いていると、参照物体の上面への投映線と板状部材の表面（参照物体が固定されている面）への投映線の、三次元計測器のX’軸に対する傾きが大きくなる。また、参照物体の側面にスリット光が照射された切断線が現れうる。さらに、計測器座標系が水平方向の別の軸（これをX軸とする）周りに動作空間座標系に対して大きく傾いているほど、参照物体の上面への投映線と板状部材の面への投映線の間の距離が長くなる。従って、これらの情報から、参照物体に対する三次元計測器の姿勢（この例では動作空間座標系の三軸のそれぞれに対する計測器座標系の軸の傾き）が求められる。
【００１４】
そして、いずれかの傾きが予め決められた閾値よりも大きい場合には、該傾きの全てが該閾値を下回るように三次元計測器を移動させる。これは、例えば、ユーザが参照物体に対する三次元計測器の姿勢を視認しつつコントローラを操作して参照物体に対して平行になるように三次元計測器を移動させ、その位置で前記傾きが全て前記閾値を下回っていることを確認することにより行うことができる。これにより、三次元計測器の姿勢が基準姿勢範囲内に入るように（この例では参照物体の三辺が延びる方向と計測器座標系の三軸を平行に）することができる。
【００１５】
上記のとおり、本発明に係るアライメント方法ではプログラミング言語を用いた行列演算を行う必要がないため、熟練者でなくても容易にロボット座標系のアライメントを行うことができる。
【００１６】
上記課題を解決するために成された本発明の別の一態様は、動作点を三次元的に移動するためのロボットの座標系であるロボット座標系と、光切断法を実行可能であり前記動作点に対する位置及び姿勢が不変である三次元計測器の座標系である計測器座標系をアライメントするシステムであって、
前記動作点の動作空間の座標系である動作空間座標系における原点に位置する第１基準点、該第１基準点を通り直交する2つの直線上にそれぞれ位置する第２基準点及び第３基準点に前記動作点を移動させて各基準点の位置をティーチングすることにより、前記動作空間座標系と前記ロボット座標系の関係を決定する動作空間座標系設定部と、
前記動作空間座標系を規定する直交三軸のうちの二軸が載る平面に対して平行に配置された板状部材の表面に、該直交三軸のそれぞれに対して各辺が平行になるように固定された直方体状の参照物体に対し、前記三次元計測器からシート状のスリット光を照射して、該スリット光による前記参照物体のへの投映線を取得する投映線取得部と、
前記投映線のプロファイルに基づいて、前記参照物体に対する前記三次元計測器の姿勢を求める計測器姿勢算出部と、
前記三次元計測器を移動させる計測器移動部と
を備えることを特徴とする。
【００１７】
上記課題を解決するために成された本発明の更に別の一態様は、動作点を三次元的に移動するためのロボットの座標系であるロボット座標系に予め対応付けられた前記動作点の動作空間の座標系である動作空間座標系と、光切断法を実行可能であり前記動作点に対する位置及び姿勢が不変である三次元計測器の座標系である計測器座標系をアライメントするために用いられる装置であって、
前記動作空間座標系を規定する直交三軸のうちの二軸が載る平面に対して平行に配置された板状部材の表面に、該直交三軸のそれぞれに対して各辺が平行になるように固定された直方体状の参照物体に対し、前記三次元計測器からシート状のスリット光を照射して、該スリット光による前記参照物体への投映線を取得する投映線取得部と、
前記投映線のプロファイルに基づいて、前記参照物体に対する前記三次元計測器の姿勢を求める計測器姿勢算出部と、
を備えることを特徴とする。
【発明の効果】
【００１８】
本発明に係るロボット用の座標系アライメント方法、アライメントシステム、又はアライメント装置を用いることにより、熟練者でなくても容易にロボット座標系のアライメントを行うことができる
【図面の簡単な説明】
【００１９】
【図１】本発明に係るロボット用の座標系アライメント装置及びアライメントシステムの一実施例を含むロボットシステムの概略構成図。
【図２】本実施例の三次元センサの構成を説明する図。
【図３】三次元センサのスリット光照射部とエリアセンサの配置を説明する図。
【図４】本発明に係るロボット用の座標系アライメント方法の一実施例に関するフローチャート。
【図５】本実施例において用いるアライメント治具について説明する図。
【図６】本実施例におけるスリット光によるブロックへの投映線について説明する図。
【図７】本実施例において得られる投映線のプロファイルの一例。
【発明を実施するための形態】
【００２０】
本発明に係るロボット用の座標系アライメント方法、アライメントシステム、及びアライメント装置の一実施例について、以下、図面を参照して説明する。図１は、本実施例のロボット用の座標系アライメントシステム及び装置（以下、「アライメントシステム」及び「アライメント装置」と呼ぶ。）を含むロボットシステム１の要部構成図である。
【００２１】
本実施例のロボットシステム１は、ロボット２と、該ロボット２を操作するためのコントローラ３を備えている。
【００２２】
ロボット２は、先端に動作点２０が設けられたアーム部２１と、該アーム部２１を三次元的に移動させるための直動機構２２a〜２２c及び回転機構２３a〜２３cを備えている。直動機構２２a〜２２c及び回転機構２３a〜２３cは、コントローラ３による制御の下で動作する。コントローラ３は後述するティーチングによって動作空間座標系とロボット座標系の関係を決定するための動作空間座標系設定部３１を、機能ブロックとして有している。
【００２３】
アーム部２１の動作点２０の近傍には、三次元センサ４が着脱可能に取り付けられている。三次元センサ４は、図２に示すように、対象物にスリット光を照射するスリット光照射部４１と、該スリット光の対象物への投映線を撮影するエリアセンサ４２を備えている。これらには計測器座標系が定義されており、図３に示すように、光照射部４１は計測器座標系のX’-Z’平面に対して角度θ1傾いた状態で配置され、エリアセンサ４２は、X’-Z’平面を挟んでスリット光照射部４１とは反対側に、同平面に対して角度θ2傾いた状態で配置されている。本実施例におけるθ1は0であるが、これは本発明に必須の要件ではなく、θ1の角度が既知でありさえすれば、対象物への投映線がどのようにエリアセンサ４２に捉えられるかを把握することができる。従って、該既知の角度に基づく適宜の演算処理によって以降に説明する処理を行うことができる。
【００２４】
本実施例ではスリット光照射部４１はX’-Z’平面上に配置され、X’-Z’平面に沿ってスリット光を対象物に照射する。θ2は、例えば、30°から40°の範囲内の適宜の角度に配置される。本実施例では、三次元センサ４として、該センサ４が有する光学系に含まれるレンズによって生じる収差や奥行き収差（カメラを斜め方向に向けたときに画角内で遠近法により生じる収差）を補正するものを使用する。これにより、後述する光切断法において正確な計測が行われ、座標系のアライメント精度が高くなる。
【００２５】
三次元センサ４には、さらに、制御・処理部４３が設けられている。制御・処理部４３は、記憶部４３１の他に、機能ブロックとして、投映線取得部４３２、計測器姿勢算出部４３３、及び座標系シフト部４３４を備えている。本実施例の制御・処理部４３は三次元センサ４の内部に組み込まれた演算処理機構として構成されている。また、この制御・処理部４３は、所定の通信インターフェース４４を介して、使用者が適宜の入力指示を行うための入力部６と、計測結果等を表示するための表示部７に接続されている。制御・処理部４３は、その他、三次元センサ４と別体で設けられ該三次元センサ４と通信可能に構成された携帯型端末等で構成することもできる。
【００２６】
次に、図４のフローチャートを参照して本実施例のアライメント方法の手順を説明する。
【００２７】
まず、アライメント用の治具を用意する。アライメント用の治具５は、板状部材５１と、該板状部材５１の上に固定されたブロック５２を含む。図５に示すように、板状部材５１は、その上面が、ロボット２の動作点２０を動作させる空間の座標系である動作空間座標系の二軸（X軸及びY軸）を含む平面と合致する位置に固定される。また、板状部材５１の上面の、動作空間座標系の原点に対応する位置に基準点Aを、動作空間座標系のX軸上の所定の位置に基準点Bを、動作空間座標系のY軸上の所定の位置に基準点Cを、それぞれ設定する。即ち、基準点A及びBにより動作空間座標系のX軸方向が規定され、基準点A及びCにより動作空間座標系のY軸が規定される。
【００２８】
ブロック５２の大きさは、X軸方向の長さがW(mm)、Y軸方向の長さがL(mm)、Z軸方向の長さがH(mm)である。ブロック５２のX軸方向の長さは、エリアセンサ４２の視野に入る範囲内で、できるだけ長いことが好ましい。これにより、後述する処理を行う際にブロック５２の上面に映るスリット光の投映線が長くなり、ブロック５２に対する三次元センサ４の姿勢を求める際の精度が高くなる。
【００２９】
一方、ブロック５２のY軸方向の長さは、例えば10〜100mmであり、ロボットの大きさ等を考慮して適宜に決めればよい。ブロック５２のY軸方向を長くすることにより、ブロック５２にスリット光を照射したときにスリット光の投映線とブロック５２の一辺（動作空間座標系のX軸に平行な辺）が平行であるか否かを視認しやすくなるためである。ただし、ブロック５２のY軸方向を短くすると、スリット光の投映線がブロック５２の一辺（動作空間座標系のX軸に平行な辺）を横切ってしまい、ブロック５２の上面を横断する投映線を得ることが難しくなる。
【００３０】
従来の座標系のアライメント方法では、動作点を正確に位置させるために可能な限り先端が尖った治具を用いることがあったが、先端が尖った治具を用いると光の拡散反射が生じやすく、動作点と治具の先端の位置関係を確認する際の撮像が困難になる場合があった。これに対し、本実施例では後述する方法及び装置によって座標系のアライメントを行うため、先端が尖った治具を用いる必要がなく、直方体状のブロック５２を用いればよいため拡散反射は生じず、容易かつ正確に後述する投映線等が撮像される。
【００３１】
また、ブロック５２の表面には、光の乱反射を抑えるための、つや消し処理が施されている。ブロック５２には、例えばつや消しアルマイトからなるものを好適に用いることができる。ブロック５２は、動作空間座標系において該ブロック５２の底面の中心が予め決められた座標に位置するように、動作空間座標系の三軸に平行に配置される。こうしてアライメント用の治具が設置される（ステップ１。図５参照）。
【００３２】
続いて、コントローラ３によりアーム部２１を動かし、動作点２０を基準点Aに移動させ、ロボット２に基準点Aの位置をティーチングする。同様に、動作点２０を基準点B及びCにも移動させ、それらの位置をロボット２にティーチングする（ステップ２）。このとき、コントローラ３を使用者が自ら操作してもよく、あるいは動作空間座標系設定部３１により動作点２０を各基準点に移動させてもよい。その後、動作空間座標系設定部３１は、基準点A、B、及びCの、動作空間座標系における座標をロボット２に登録し、該ロボット２に予め（例えば出荷時に）登録されているロボット座標系と動作空間座標系の関係を決定する。こうして、ロボット２に動作空間座標系が設定される（ステップ３）。
【００３３】
ロボット２に動作空間座標系を設定した後、コントローラ３によりアーム部２１を移動し、図５（ロボット２のうちアーム部２１以外の図示を省略）に示すように、三次元センサ４をブロック５２の上方に位置させる（ステップ４）。続いて、スリット光照射部４１からブロック５２に対してスリット光を照射し（ステップ５）、エリアセンサ４２によりブロック５２への投映線を取得する（ステップ６）。
【００３４】
本実施例におけるスリット光は、三次元センサ４の出力信号の基準となる計測器座標系の一軸（X'軸）方向に幅を持つ光であり、該計測器座標系の別の一軸（Z'軸）方向に発せられる。即ち、計測器座標系のX'-Z'平面に沿ったシート状のスリット光である（図６参照）。本実施例の三次元センサ４は、該センサ４が有する光学系に含まれるレンズによって生じる収差や奥行き収差（カメラを斜め方向に向けたときに画角内で遠近法により生じる収差）を補正する。具体的には、二次元的に配列された画素のどの位置にスリット光が入射しているかを特定し、続いてその位置をキャリブレーションにより補正する。そして補正後の画素の位置から投映線のプロファイルを取得する。
【００３５】
上述のとおり、ブロック５２の三辺は動作空間座標系の三軸に平行に配置されており、また、スリット光はX'-Z'平面に沿ったシート状の光である。従って、動作空間座標系のX軸、Y軸、及びZ軸と、計測器座標系のX’軸、Y’軸、及びZ’軸がそれぞれ平行になっていると、ブロック５２の上面への投映線は該ブロック５２のX軸に平行な一辺の長さWと同一になる。また、ブロック５２の上面への投映線と、板状部材５１への投映線の間の距離は、ブロック５２の高さH（及び三次元センサ４のエリアセンサ４２がブロック及び板状部材５１を捉える角度）に応じたものとなる。
【００３６】
一方、計測器座標系が動作空間座標系に対して傾いている場合には、上記と異なる長さ及び距離を有する投映線が現れる。そうした場合に現れる、投映線について、図６及び７を参照して説明する。図６は、治具５（板状部材５１及びブロック５２）を基準にスリット光が斜方から照射された状態を示している。なお、図６では、角度α、β、及びγを分かりやすくするため、これらの角度を実際よりも大きくして投映線を示している。図７は、エリアセンサ４２により計測された投映線に基づいて作成された表示例である。
【００３７】
本実施例の場合、エリアセンサ４２がX’-Z'平面に対して角度θ2傾いた位置に配置され、斜め上方から投映線を撮影する。そのため、エリアセンサ４２により捉えられる、ブロック５２の上面への投映線と板状部材５１への投映線の間の距離は実際よりも短くなる。そこで、投映線取得部４３２は、スリット光照射部４１及びエリアセンサ４２の配置（X’-Z’平面に対する角度θ1及びθ2）及び実際に計測された上記距離に基づいて該距離を補正し測定値hを求める。一方、ブロック５２の上面への投映線の長さはそのまま測定値wとする。そして、図７に示すように測定値w, hを表示部７に表示する。
【００３８】
ここで、図６及び７に示すように、ブロック５２の上面への投映線の一端（ブロック５２の側面への投映線も撮影されている場合は投映線の屈曲点）を通り計測器座標系のZ‘軸に平行な直線と、該一端を通り動作空間座標系のZ軸と平行な直線とがなす角度をα、エリアセンサ４２の画角の一方向（横方向）と該エリアセンサ４２で捉えられた投映線がなす角度をβ、ブロック５２の上面への投映線と、該投映線の一端を通り動作空間座標系のX軸に平行な直線がなす角度をγ、と規定する。
【００３９】
上記のように角度α、β、及びγを規定すると、ブロック５２のX軸方向の長さW及びZ軸方向の長さHと、上記測定値w及びhとから、次式により角度α及びγが求められる。
α=cos-1（H/h）…(1)
γ=cos-1（W/w）…(2)
また、角度βは、上記の通りエリアセンサ４２画角の横方向と、板状部材５１への投映線がなす角度として求められる。
【００４０】
計測器姿勢算出部４３３は、上記のようにして投映線のプロファイルから上記の角度α、β、及びγを算出し（ステップ７）、表示部７の画面にそれぞれの角度を表示する。
【００４１】
上記角度α、β、及びγを算出すると、計測器姿勢算出部４３３は、それらの値が全て予め決められた値（所定値）以下であるかを判定する（ステップ８）。この所定値は、動作空間座標系の各軸と計測器座標系の各軸とが実質的に互いに平行であるであるとみなせる値に設定される。所定値は、例えば0.2度である。角度α、β、及びγが全て所定値以下であれば（ステップ８でYES）、後述するステップ１０に進む。
【００４２】
一方、いずれかの角度が所定値を上回っている場合には（ステップ８でNO）、使用者がコントローラ３を用いて三次元センサ４の姿勢を調整する（ステップ９）。そして、ステップ５に戻って再びブロック５２にスリット光を照射し、上記角度α、β、及びγを算出して表示部７に表示するとともに、それらが全て所定値以下であるかを判定する（ステップ５〜８）。これらの処理は、角度α、β、及びγが全て所定値以下になるまで繰り返し行う。本実施例では、角度α、β、及びγを算出するごとに表示部７にそれらの値が表示されるため、使用者は角度α、β、及びγを確認し、計測器座標と動作空間座標がどの程度ずれているのかを直感的に把握することができる。また、その値の変化を確認しながら、ロボット２を用いて行おうとしている作業に求められる精度を考慮するなどして、どの程度まで両座標を合致させる必要があるかを判断することもできる。
【００４３】
上記角度α、β、及びγが全て所定値以下になると（ステップ８でYES）、座標系シフト部４３４は、三次元センサからのスリット光をY'軸（動作空間座標系と計測器座標系が相互に平行であるため実質的にY軸と同じ）方向に走査してブロック５２全体三次元データを取得し、ブロック５２の所定の位置（例えば動作空間座標系のX-Y平面上に位置する、ブロック５２の底面の中心）の、計測器座標系における座標位置を求める（ステップ１０）。そして、動作空間座標系におけるブロック５２の上記所定の位置座標位置と比較して差分（シフト量）を求める（ステップ１１）。最後に、計測器座標系を上記シフト量の大きさだけシフトさせることにより、計測器座標系と動作空間座標系を合致させる。
【００４４】
上記実施例で説明した具体的な構成や数値はいずれも一例であって、本発明の趣旨に沿って適宜に変更することができる。
上記実施例では、治具５を使用して両座標系のシフト量を求めた、同座標系をシフトさせて一致させる処理まで行ったが、これらの処理は必須ではない。例えば、実際にロボットを動作させる際に、計測器座標系で取得された位置に上記シフト量を加えて（あるいは減じて）動作空間座標系の位置に変換する処理を、実際にロボットを動作させる毎に行ってもよい。あるいは、動作空間座標系の三軸と計測器座標系の三軸を互いに平行にした後、別の治具を配置し、動作空間座標系と計測器座標系のそれぞれにおける、その治具の所定位置の座標の差からシフト量を求めることもできる。シフト量を求めるために使用する治具は必ずしも直方体状のものである必要はなく、上記所定位置を規定可能な適宜の形状のものを用いることができる。例えば、直方体状のブロック５２の全体のプロファイルを取得する際にエッジ部分の形状を正確に計測することが難しい場合には、円筒状のブロックを用いるとよい。また、シフト量の算出に用いる治具はブロックに限らず、所定位置（例えばX-Y平面上に位置する中心と該中心からの高さの座標が既知であり、三次元センサ４によって三次元データを取得可能な、適宜のものを用いることができる。
【産業上の利用可能性】
【００４５】
現在、製造業の現場では、人口の減少により、人力に代わるロボットの普及が急務とされている。しかし、ロボットと三次元計測器を使ったシステムの統合には高度な知識が必要とされるため、現場の作業員にとって必ずしも容易ではない。特に、様々なロボットメーカにより製造されたロボットが用いられる自動車産業などでは、ロボットメーカによって操作性が異なるために、その操作を熟知した専門の技術者の派遣が必要となる場合があり、人材の確保が難しく、また人材の育成も難しい。例えば、ロボットの使用中に、予期しない衝突等が起こり三次元計測器の取り付け位置がずれてしまうことがある。現場では速やかな復旧が求められるため、高度な知識を有することなく様々なロボットメーカにより製造されたロボットに共通して適用可能なアライメント技術が必要とされており、本発明を好適に用いることができる。
【符号の説明】
【００４６】
１…ロボットシステム
２…ロボット
２０…動作点
２１…アーム部
２２a〜２２c…直動機構
２３a〜２３c…回転機構
３…コントローラ
３１…動作空間座標系設定部
４…三次元センサ
４１…スリット光照射部
４２…エリアセンサ
４３…制御・処理部
４３１…記憶部
４３２…投映線取得部
４３３…計測器姿勢算出部
４４…通信インターフェース
５…治具
５１…板状部材
５２…ブロック
６…入力部
７…表示部
【要約】
【課題】ロボット座標系のアライメントを容易に行うことができる技術を提供する。
【解決手段】ロボット座標系と計測器座標系をアライメントするシステムにおいて、動作空間座標系の原点に位置する第１基準点A、該第１基準点を通る直交2直線上の第２基準点B、及び第３基準点Cの位置をティーチングして動作空間座標系とロボット座標系の関係を決定する動作空間座標系設定部３１と、動作空間座標系を規定する直交三軸の二軸が載る平面に平行に配置された板状部材５１に該直交三軸に対して各辺が平行になるように固定された参照物体５２に三次元計測器４からスリット光を照射して投映線を取得する投映線取得部４３２と、投映線のプロファイルに基づいて参照物体５２に対する三次元計測器３０の姿勢を求める計測器姿勢算出部４３３と、三次元計測器４を移動させる計測器移動部３を備える。
【選択図】図２【図１】
0006670974.tif 000002
【図２】
0006670974.tif 000003
【図３】
0006670974.tif 000004
【図４】
0006670974.tif 000005
【図５】
0006670974.tif 000006
【図６】
0006670974.tif 000007
【図７】
0006670974.tif 000008