特開 2023-142081 校正機能を有する対象物の検出方法及び検出装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2023142081

(43)【公開日】2023-10-05

(54)【発明の名称】校正機能を有する対象物の検出方法及び検出装置

(51)【国際特許分類】

   G01B 11/00 20060101AFI20230928BHJP

【ＦＩ】

G01B11/00 B

【審査請求】未請求

【請求項の数】6

【出願形態】ＯＬ

(21)【出願番号】P 2022048768

(22)【出願日】2022-03-24

(71)【出願人】

【識別番号】590001164

【氏名又は名称】アイシンシロキ株式会社

(71)【出願人】

【識別番号】594124993

【氏名又は名称】東京貿易テクノシステム株式会社

(71)【出願人】

【識別番号】599085633

【氏名又は名称】株式会社タマディック

(71)【出願人】

【識別番号】517139967

【氏名又は名称】平野 慎也

(71)【出願人】

【識別番号】521335708

【氏名又は名称】タクトシステム株式会社

(74)【代理人】

【識別番号】100121083

【弁理士】

【氏名又は名称】青木 宏義

(74)【代理人】

【識別番号】100138391

【弁理士】

【氏名又は名称】天田 昌行

(74)【代理人】

【識別番号】100166408

【弁理士】

【氏名又は名称】三浦 邦陽

(72)【発明者】

【氏名】奥村 祐

(72)【発明者】

【氏名】松下 直史

(72)【発明者】

【氏名】中村 純也

(72)【発明者】

【氏名】内山 友和

(72)【発明者】

【氏名】藤野 真司

(72)【発明者】

【氏名】隠家 元弘

(72)【発明者】

【氏名】八木 恒平

(72)【発明者】

【氏名】平野 慎也

(72)【発明者】

【氏名】藤山 仁

【テーマコード（参考）】

2F065

【Ｆターム（参考）】

2F065AA04

2F065BB28

2F065CC12

2F065DD02

2F065FF11

2F065GG04

2F065HH04

2F065MM16

2F065MM26

2F065PP05

2F065PP22

2F065PP25

(57)【要約】

【課題】外部環境の変化（気温など）にかかわらずに対象物の検出精度を維持することができる校正機能を有する対象物の検出方法及び検出装置を提供する。
【解決手段】定量値を算出するステップと、第１の位置情報生成装置で第１の対象物を測定するステップと、第２の位置情報生成装置で第２の対象物を測定するステップと、前記第１の位置情報生成装置による前記第１の対象物の測定値と、前記第２の位置情報生成装置による前記第２の対象物の測定値と、前記定量値とに基づいて、前記第１の位置情報生成装置を基準とした前記第２の対象物の位置を算出するステップと、前記第２の位置情報生成装置で第３の対象物を測定する前に、前記定量値を校正するステップと、を有することを特徴とする対象物の検出方法。
【選択図】図９

【特許請求の範囲】

【請求項1】

定量値を算出するステップと、
第１の位置情報生成装置で第１の対象物を測定するステップと、
第２の位置情報生成装置で第２の対象物を測定するステップと、
前記第１の位置情報生成装置による前記第１の対象物の測定値と、前記第２の位置情報生成装置による前記第２の対象物の測定値と、前記定量値とに基づいて、前記第１の位置情報生成装置を基準とした前記第２の対象物の位置を算出するステップと、
前記第２の位置情報生成装置で第３の対象物を測定する前に、前記定量値を校正するステップと、
を有することを特徴とする校正機能を有する対象物の検出方法。

【請求項2】

前記定量値は、前記第２の位置情報生成装置とマーカの少なくとも一方を基準とした前記第２の位置情報生成装置の原点の位置と姿勢であり、
前記定量値の算出及び／又は校正のための処理ステップは、
前記第１の位置情報生成装置で前記第２の位置情報生成装置と前記マーカの少なくとも一方を測定する第１ステップと、
前記第１の位置情報生成装置で第４の対象物を測定する第２ステップと、
前記第２の位置情報生成装置で前記第４の対象物を測定する第３ステップと、
前記第１ステップと前記第２ステップと前記第３ステップの測定結果に基づいて、前記定量値を算出及び／又は校正する第４のステップと、
を有することを特徴とする請求項１に記載の校正機能を有する対象物の検出方法。

【請求項3】

前記第４の対象物の位置と姿勢を担保するための第５の対象物を測定するステップを有する、
ことを特徴とする請求項２に記載の校正機能を有する対象物の検出方法。

【請求項4】

前記定量値は、前記第２の位置情報生成装置の温度によって異なる予め決定された値であり、前記第２の位置情報生成装置の温度測定に基づいて、前記定量値を算出及び／又は校正する、
ことを特徴とする請求項１に記載の校正機能を有する対象物の検出方法。

【請求項5】

前記第１の位置情報生成装置は、レーザトラッカであり、
前記第２の位置情報生成装置は、３Ｄスキャナである、
ことを特徴とする請求項１から請求項４のいずれかに記載の校正機能を有する対象物の検出方法。

【請求項6】

定量値を算出する装置と、
第１の対象物を測定する第１の位置情報生成装置と、
第２の対象物を測定する第２の位置情報生成装置と、
を有し、
前記第１の位置情報生成装置による前記第１の対象物の測定値と、前記第２の位置情報生成装置による前記第２の対象物の測定値と、前記定量値とに基づいて、前記第１の位置情報生成装置を基準とした前記第２の対象物の位置を算出し、
前記第２の位置情報生成装置で第３の対象物を測定する前に、前記定量値を校正する、
ことを特徴とする校正機能を有する対象物の検出装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、校正機能を有する対象物の検出方法及び検出装置に関する。

【背景技術】

【0002】

従来、アームロボットによってワークを把持したまま、他のワークと溶接する技術が知られている。この場合、専用の位置決め機構（位置決め用の型や治具を含む）を使用して、アームロボットひいては当該アームロボットに把持されたワークの位置決め（位置や姿勢の検出）を行う。しかし、位置決め機構を別で設けなければならないので、設備費が高額で、設備の設置スペースが広く必要である。しかも、位置決め機構は車種分必要であるため、車種が多い場合、段替え回数が多く、トータルの段替え時間が長くなってしまう。また、新規車種の立ち上げ毎に、同様の問題が発生してしまう。

【0003】

特許文献１には、空間内において少なくとも１つのオブジェクトを産業用ロボットによって最終姿勢に位置決めするための方法が記載されている。この方法では、オブジェクトを位置決めするために、第１の産業用ロボットと、第１の光学的撮像装置と、少なくとも１つの第２の光学的撮像装置とを使用する。第１の産業用ロボットは、所定のポジショニングに位置調整することができる。第１の光学的撮像装置は、三次元の空間座標系で校正され、既知の第１の位置に既知の方向に位置決めされている。第２の光学的撮像装置は、空間座標系で校正され、既知の第２の位置に既知の方向で位置決めされている。

【0004】

第１の光学的撮像装置は、第１のカメラと、第１の駆動ユニットと、第１の角度測定ユニットとを有している。第１のカメラは、所定の第１の視界内で画像を撮像するために光学的校正されている。第１の駆動ユニットは、第１の視界を位置調整するために第１のカメラを方向決めするための構成要素である。第１の角度測定ユニットは、第１のカメラの角度方向を検出して、空間座標系において第１の視界を求めるための空間座標系で校正されている。

【0005】

第２の光学的撮像装置は、第２のカメラと、第２の駆動ユニットと、第２の角度測定ユニットとを有している。第２のカメラは、所定の第２の視界内で画像を撮像するために光学的校正されている。第２の駆動ユニットは、第２の視界を位置調整するために第２のカメラを方向決めするための構成要素である。第２の角度測定ユニットは、第２のカメラの角度方向を検出して、空間座標系において第２の視界を求めるための空間座標系で校正されている。

【先行技術文献】

【特許文献】

【0006】

【特許文献1】特許第５２９０３２４号公報

【発明の概要】

【発明が解決しようとする課題】

【0007】

しかしながら、特許文献１は、外部環境の変化（気温など）に対して、校正する機能がなく、最初に設定した精度を維持することが困難であったため、改良の余地があった。

【0008】

本発明は、以上の問題意識に基づいてなされたものであり、外部環境の変化（気温など）にかかわらずに対象物の検出精度を維持することができる校正機能を有する対象物の検出方法及び検出装置を提供することを目的とする。

【課題を解決するための手段】

【0009】

本実施形態の校正機能を有する対象物の検出方法は、定量値を算出するステップと、第１の位置情報生成装置で第１の対象物を測定するステップと、第２の位置情報生成装置で第２の対象物を測定するステップと、前記第１の位置情報生成装置による前記第１の対象物の測定値と、前記第２の位置情報生成装置による前記第２の対象物の測定値と、前記定量値とに基づいて、前記第１の位置情報生成装置を基準とした前記第２の対象物の位置を算出するステップと、前記第２の位置情報生成装置で第３の対象物を測定する前に、前記定量値を校正するステップと、を有することを特徴とする。

【発明の効果】

【0010】

本発明によれば、外部環境の変化（気温など）にかかわらずに対象物の検出精度を維持することができる校正機能を有する対象物の検出方法及び検出装置を提供することができる。

【図面の簡単な説明】

【0011】

【図1】点群データの各点情報の表現の一例を示す図である。

【図2】４×４マトリックスでの原点の表現の一例を示す図である。

【図3】４×４マトリックスを使用した原点計算の一例を示す図である。

【図4】本実施形態の校正機能を有する対象物の検出方法及び検出装置を適用した車両部品の溶接装置の構成の第１の例を示す図である。

【図5】本実施形態の校正機能を有する対象物の検出方法及び検出装置を適用した車両部品の溶接装置の構成の第２の例を示す図である。

【図6】本実施形態の校正機能を有する対象物の検出方法及び検出装置を適用した車両部品の溶接装置の構成の第３の例を示す図である。

【図7】形状マーカの第１の例を示す図である。

【図8】形状マーカの第２の例を示す図である。

【図9】第２の位置情報生成装置と位置補正用マーカの間の位置校正処理の一例を示す図である。

【発明を実施するための形態】

【0012】

まず、本明細書における用語の定義を行う。

【0013】

本明細書における「位置情報生成装置（３Ｄスキャナ）」とは、ワーク（例えば、アッパサッシュ、立柱サッシュ、ドアフレーム、ブラケット等）及びその把持装置（例えば、ロボットアーム等）、並びにその他のターゲット（例えば、ロボットアーム又はその近傍に設けられたマーカや固定物等）の形状情報を点群データとして取得するための装置である。点群データの各点情報は、「対象物の位置と姿勢」と読み替えることができる。点群データの各点情報（対象物の位置と姿勢）は、３Ｄスキャナ原点を原点とした座標Ｘ、Ｙ、Ｚとその法線方向Ｉ、Ｊ、Ｋの数値で表すことができる。本明細書では、「３Ｄスキャナ」を「第２の位置情報生成装置」と呼ぶことがある。

【0014】

本明細書における「位置情報生成装置（レーザトラッカ）」とは、例えば、ターゲットの三次元情報（位置情報や角度）を自らの座標系基準に算出することが可能な装置である。「位置情報生成装置（レーザトラッカ）」は、例えば、レーザ光を照射して、ターゲットから反射したレーザ光が発光源に戻ることで、ターゲットの三次元位置情報を取得する。ターゲットの三次元情報（位置情報や角度）は、「対象物の位置と姿勢」と読み替えることができる。「位置情報生成装置（レーザトラッカ）」は、測定範囲が広いため、「位置情報生成装置（レーザトラッカ）」とターゲット、もしくは後述するマーカ付きタッチプローブのようなものがあれば、高精度に各設備間の寸法や精度、原点位置等を算出することができる。本明細書では、「位置情報生成装置（レーザトラッカ）」を「第１の位置情報生成装置」と呼ぶことがある。

【0015】

本明細書における「マーカ」とは、例えば、第１の位置情報生成装置（レーザトラッカ）や第２の位置情報生成装置（３Ｄスキャナ）にて、位置座標と角度を取得するためのターゲットの一種である。「マーカ」の位置座標と角度は第１の位置情報生成装置（レーザトラッカ）又は第２の位置情報生成装置（３Ｄスキャナ）を原点として、算出される。これは座標Ｘ、Ｙ、Ｚと角度Ｒｘ、Ｒｙ、Ｒｚで表すことができ、角度Ｒｘ、Ｒｙ、Ｒｚは、それぞれ、後述するように、基準Ｘ軸、基準Ｙ軸、基準Ｚ軸からの姿勢変更分の単位ベクトル（Ｉ、Ｊ、Ｋ）と、基準点からの移動量（Ｘ、Ｙ、Ｚ）とを用いた４×４の行列データ（マトリックスデータ）で表すことができる。「マーカ」は、例えば、ロボットアーム先端の把持部等に取り付けられ、第１の位置情報生成装置（レーザトラッカ）又は第２の位置情報生成装置（３Ｄスキャナ）を原点としたロボットアームの動作精度（把持部の三次元空間上の絶対位置）を数値として取得するために用いられる。また、他にも後述するような対象ワークを接触で計測するようなマーカ付きタッチプローブや、対象ワークを非接触で計測する３Ｄスキャナに取り付けたタイプなど、広く用いられる。どの計測情報においても第１の位置情報生成装置（レーザトラッカ）又は第２の位置情報生成装置（３Ｄスキャナ）の原点にて配置するために用いられる。

【0016】

本明細書における「マーカ付きタッチプローブ」とは、例えば、第１の位置情報生成装置（レーザトラッカ）又は第２の位置情報生成装置（３Ｄスキャナ）で「マーカ付きタッチプローブ」のターゲット部をロックオンした状態で、プローブ先端を対象ワークにタッチして測定することで、第１の位置情報生成装置（レーザトラッカ）又は第２の位置情報生成装置（３Ｄスキャナ）を原点とした対象ワークの三次元空間上の位置を算出することができるものである。

【0017】

本明細書における「マーカ付き３Ｄスキャナ」とは、例えば、第１の位置情報生成装置（レーザトラッカ）で「マーカ付き３Ｄスキャナ」のターゲット部をロックオンした状態で、対象ワークを３Ｄスキャンすることにより、第１の位置情報生成装置（レーザトラッカ）の原点からのマーカ原点座標／角度と、マーカ原点からの第２の位置情報生成装置（３Ｄスキャナ）の原点座標／角度（後述）から、第２の位置情報生成装置（３Ｄスキャナ）で取得した点群情報を、第１の位置情報生成装置（レーザトラッカ）の原点として算出することが可能である。マーカ原点位置と第２の位置情報生成装置（３Ｄスキャナ）の原点位置の関係は据付時点で、基準となるブロックを第１の位置情報生成装置（レーザトラッカ）とマーカ付きタッチプローブを用いて位置情報を算出したものと、第２の位置情報生成装置（３Ｄスキャナ）で撮像した基準ブロックの位置情報を合わせること（キャリブレーション）により、第２の位置情報生成装置（３Ｄスキャナ）の原点／角度情報を算出している。通常、第２の位置情報生成装置（３Ｄスキャナ）は、撮像範囲を広くすると、精度が低下する特徴があるため、広範囲の撮像には向いておらず、後述するような設備全体の運用には第２の位置情報生成装置（３Ｄスキャナ）単体では限界がある。このため、撮像範囲や測定範囲を広げるために第１の位置情報生成装置（レーザトラッカ）を用いた対応とすることが考えられる。しかし、後述するように、本実施形態の対象物の検出方法及び検出装置では、第１の位置情報生成装置（レーザトラッカ）と第２の位置情報生成装置（３Ｄスキャナ）を適切に組み合わせることで、第１の位置情報生成装置（レーザトラッカ）を初期設定（キャリブレーション）のみに使用して、その後は第２の位置情報生成装置（３Ｄスキャナ）と形状マーカとによる最終位置補正を実行することができる。このため、例えば、複数の製造ラインのそれぞれに専用の第１の位置情報生成装置（レーザトラッカ）を備え付ける必要がなくなり、複数の製造ラインで第１の位置情報生成装置（レーザトラッカ）を使い回すことができる。

【0018】

本明細書における「点群データ」とは、例えば、３Ｄスキャナ（カメラ）等の機器を使用してワーク（例えば、アッパサッシュ、立柱サッシュ、ドアフレーム、ブラケット等）を３Ｄスキャンする（ワークを撮像する）ことによって取得されるワークの三次元情報を意味する。また点群データの各点情報は、例えば、図１のように、座標Ｘ、Ｙ、Ｚとその法線方向Ｉ、Ｊ、Ｋの数値（図１）で表すことができる。図１の例では、点群１、点群２、点群３、点群４、点群５、点群＊＊を描いている。

【0019】

本明細書における「基準データ」とは、例えば、ワーク（例えば、アッパサッシュ、立柱サッシュ、ドアフレーム、ブラケット等）の設計上の基準となるデータ（例えば、マスターワークデータ、設計値データ、生データ、ＣＡＤデータ）を意味する。

【0020】

本明細書における「形状合わせ点群データ」とは、上述の「点群データ」を「基準データ」に合わせた点群データを意味する。

【0021】

本明細書における「移動マトリックス」及び「逆マトリックス」は、例えば、４×４の行列データ（マトリックスデータ）により表される。例えば、図２に示すように、「移動マトリックス」及び「逆マトリックス」は、原点や、基準原点からある目標原点までの位置の情報として表される。左から一列目は、基準Ｘ軸からの姿勢変更分の単位ベクトル（Ｉ、Ｊ、Ｋ）を示しており、左から二列目は、基準Ｙ軸からの姿勢変更分の単位ベクトル（Ｉ、Ｊ、Ｋ）を示しており、左から三列目は、基準Ｚ軸からの姿勢変更分の単位ベクトル（Ｉ、Ｊ、Ｋ）を示しており、左から四列目は、基準点からの移動量（Ｘ、Ｙ、Ｚ）を示している。

【0022】

マトリックスを使用すれば、各座標の移動量においても図３のようにマトリックスを用いて計算を行うことが可能である。このマトリックス計算を行うことにより、各座標系の位置・角度の量を算出することができる。上述した点群データを基準データに合わせる際の移動についても４×４の行列データにて表すことができる。また、この４×４の行列データを逆行列変換により、基準データを点群データに合わせる移動の４×４の行列データを出力することも可能である。図３では、原点基準、原点基準から見た原点Ａ、原点Ｂから見た原点Ａ、原点基準から見た原点Ｂ、原点Ｂの逆行列を、それぞれ、４×４の行列データで示している。

【0023】

図４、図５は、本実施形態の校正機能を有する対象物の検出方法及び検出装置を適用した車両部品の溶接装置１の構成の第１、第２の例を示す図である。

【0024】

溶接装置１は、装置中央部に位置する固定治具（例えばタクトシステムの治具）１０を有している。固定治具１０は、例えば、アッパサッシュ（フロントメーンフレーム）の端部と立柱サッシュ（フロント立柱フレーム）の端部とを位置合わせ状態で溶接したドアフレーム１１を固定状態で支持する。固定治具１０とドアフレーム１１の相対位置関係はワーク着脱毎に変化しても良いため、通常の治具に求められる繰返し位置決め機能は不要である（後述する逆マトリックスにより、ドアフレーム１１のワーク位置を求めるため）。このため、固定治具１０はドアフレーム１１のどの位置を固定してもよい。なお、作図の便宜上の理由により、図４は固定治具１０がドアフレーム１１を支持した状態を描いており、図５は固定治具１０がドアフレーム１１を支持していない状態を描いている（ドアフレーム１１を省略して描いている）。

【0025】

溶接装置１は、固定治具１０を挟んだ図中の左側と右側にそれぞれ位置するロボットアーム２０とロボットアーム３０とを有している。ロボットアーム２０は、例えば、複数の軸（例えば６軸）を有するアームロボットから構成されており、ロボットアーム２０の先端部の把持部２１に把持したロックブラケット（図４に吹き出しで描いている）をドアフレーム１１の所定の部位に位置合わせするために運動（移動）する。また、ロボットアーム２０の先端部の把持部２１の近傍には、位置補正用マーカ２２が設けられている。位置補正用マーカ２２は、例えば、後述する第１の位置情報生成装置（レーザトラッカ）７０によって追跡可能なリフレクタを有している。ロボットアーム３０は、例えば、複数の軸（例えば６軸）を有するアームロボットから構成されており、ロボットアーム３０の先端部の把持部３１に把持したヒンジブラケット（図４に吹き出しで描いている）をドアフレーム１１の所定の部位に位置合わせするために運動（移動）する。また、ロボットアーム３０の先端部の把持部３１の近傍には、位置補正用マーカ３２が設けられている。位置補正用マーカ３２は、例えば、後述する第１の位置情報生成装置（レーザトラッカ）７０によって追跡可能なリフレクタを有している。

【0026】

ロボットアーム２０とロックブラケット（図４に吹き出しで描いている）の相対位置関係、及び、ロボットアーム３０とヒンジブラケット（図４に吹き出しで描いている）の相対位置関係は、ワーク着脱毎に変化してもよいため、通常の治具に求められる繰返し位置決め機能は不要である（後述する逆マトリックスにより、ロックブラケットとヒンジブラケットのワーク把持位置を求めるため）。よって、ロボットアーム２０はロックブラケットのどの位置を把持してもよく、ロボットアーム３０はヒンジブラケットのどの位置を把持してもよい。固定治具１０とドアフレーム１１の相対位置精度と、ロボットアーム２０とロックブラケットの相対位置精度と、ロボットアーム３０とヒンジブラケットの相対位置精度とが担保されており、かつ、ロボット空間座標の絶対位置決め精度が担保されているような装置（例えば、マシニングセンタのような工作機械）であれば、高精度な位置決めが可能となる。

【0027】

溶接装置１は、固定治具１０とロボットアーム２０との間の奥行方向にずれた位置に溶接ロボット４０を有しており、固定治具１０とロボットアーム３０との間の奥行方向にずれた位置に溶接ロボット５０を有している。溶接ロボット４０は、例えば、複数の軸（例えば６軸）を有するアームロボットから構成されており、先端部に設けた溶接ノズル４１によって、固定治具１０が支持するドアフレーム１１と、ロボットアーム２０の把持部２１が把持するロックブラケットとを所定の位置合わせ状態で溶接する。溶接ロボット５０は、例えば、複数の軸（例えば６軸）を有するアームロボットから構成されており、先端部に設けた溶接ノズル５１によって、固定治具１０が支持するドアフレーム１１と、ロボットアーム３０の把持部３１が把持するヒンジブラケットとを所定の位置合わせ状態で溶接する。

【0028】

溶接装置１は、固定治具１０の後方かつ溶接ロボット４０と溶接ロボット５０の間に挟まれるようにして、３Ｄスキャナ支持アーム６０を有している。３Ｄスキャナ支持アーム６０は、例えば、複数の軸（例えば６軸）を有するアームロボットから構成されており、アーム先端部に、第２の位置情報生成装置（３Ｄスキャナ）６１と、位置補正用マーカ６２とが設けられている。位置補正用マーカ６２は、例えば、後述する第１の位置情報生成装置（レーザトラッカ）７０によって追跡可能なリフレクタを有している。

【0029】

溶接装置１は、第１の位置情報生成装置（レーザトラッカ）７０と組み合わせて使用されてもよい。第１の位置情報生成装置（レーザトラッカ）７０は、溶接装置１の各構成要素（例えば、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケット、ロボットアーム２０の位置補正用マーカ２２、ロボットアーム３０の位置補正用マーカ３２、３Ｄスキャナ６１、３Ｄスキャナ６１の位置補正用マーカ６２）をターゲットとして、その三次元情報（位置情報や角度）を自らの座標系基準に算出する。

【0030】

図４、図５に示すように、溶接ロボット４０の側方（３Ｄスキャナ支持アーム６０との間）には、位置校正用基準台が設けられており、この位置校正用基準台の上方に形状マーカ（固定物、金属塊）８０が設けられている。形状マーカ８０の具体的な構成及び機能については、後に詳細に説明する。形状マーカ８０は、第１の位置情報生成装置（レーザトラッカ）７０及び第２の位置情報生成装置（３Ｄスキャナ）６１と協働して、対象物の検出（位置・姿勢の検出）の校正機能を発揮する。さらに、位置校正用基準台には、形状マーカ８０のやや下方に位置させて、位置補正用マーカ（第５の対象物）４２が設けられている。

【0031】

本実施形態では、マーカ付き３Ｄスキャナ６１を使用して、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットをスキャン（撮像）することにより、これらの点群データ（三次元情報）を取得する。つまり、マーカ付き３Ｄスキャナ６１は「点群データ取得部」として機能する。そして、マーカ付き３Ｄスキャナ６１を第１の位置情報生成装置（レーザトラッカ）７０で仮想ロックオンした状態で点群取得することにより、マーカ付き３Ｄスキャナ６１で取得した点群データは、第１の位置情報生成装置（レーザトラッカ）７０を原点として算出される（第１の位置情報生成装置（レーザトラッカ）７０の仮想ロックオンに伴う架空原点として算出される）。この点群データは、例えば、各点の座標Ｘ、Ｙ、Ｚとその法線方向Ｉ、Ｊ、Ｋで表され、点群データの原点は４×４の行列データ（マトリックスデータ）で表される（詳細については後述する）。

【0032】

なお、点群データの取得に際して固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの全体を３Ｄスキャンするのではなく、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの一部、例えば製品評価のための基準となる部位のみを３Ｄスキャンしてもよい。この３Ｄスキャンは、２Ｄスキャナを移動させながら点群取得する方式でも良いし、３Ｄスキャナを位置決めしてスキャンする方式や、固定した３Ｄスキャンを複数個所に設置してスキャンする方式でも良い。後述するように、点群データを基準データに合わせる際には基準データ上の任意の位置を必要な数だけ基準に設定し、位置合せをすることを可能とする。また、この各基準には優先度を設定して、より重要度の高い部分の位置合わせを優先することができる。これにより、基準データと点群データの位置合わせ方式のコントロールが可能となっている。本実施形態では、各基準部の誤差量が大きかった場合、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットのドアフレーム１１との溶接部同士が干渉する可能性があるため、溶接部の優先度をその他基準部に対して、高く設定することにより、溶接部の形状合わせを優先して位置決めすることが可能となっている。

【0033】

また、本実施形態では、予め、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの設計上の基準となる基準データ（例えばＣＡＤデータ）が用意（準備）されている。この基準データは、原点（例えば車両原点、この場合は車両原点＝位置情報生成装置原点）を含むとともに、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの位置合わせ状態のデータとすることができる。そして、本実施形態では、後述する制御部を使用して、原点（車両原点）を含む基準データに点群データを位置合わせした形状合わせ点群データを算出する。また、基準データに点群データを移動した際の移動量、基準データおよび形状合わせ点群データの原点は４×４の行列データ（マトリックスデータ）で表される（詳細については後述する）。

【0034】

形状合わせ点群データの原点座標は、位置情報生成装置原点で取得された点群データの原点を移動させたことと同じこととなる。この基準データに点群データを合わせる際の４×４の行列データ（マトリックス）を逆行列変換することにより、基準データを点群データに合わせることと同じことになるため、点群データに原点を付与した形になる（基準データ原点で表されていた形状合わせ点群データの状態を点群データ基準で表した形である）。この方式により、原点の存在しない点群データにＣＡＤ原点情報を付与することを実現している。

【0035】

固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの点群データをＣＡＤデータ（基準データ）に合わせるという移動の結果は、原点を移動したというマトリックスで表記が可能（すなわち等価）である。マトリックスを逆マトリックスに変換することで、ＣＡＤデータ（基準データ）を点群データに合わせる移動量が求まる。点群データをＣＡＤデータ（基準データ）に合わせることが正マトリックスに相当し、ＣＡＤデータ（基準データ）を点群データに合わせることが逆マトリックスに相当する（正マトリックスから見ると原点に戻ることに相当する）。すなわち、原点から見ると、ＣＡＤデータ（基準データ）と点群データが合わさっていた状態を、ＣＡＤ座標を点群データに合わせるように移動させたことになる。例えば、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの一部の実際のワーク配置をＣＡＤ座標系通りでの位置で再現できる場合は、その一部の位置は既知となるため、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの他部のマトリックス計算だけでも原点間の計算が可能となる（この場合、逆行列変換は不要である）。

【0036】

第１の位置情報生成装置（レーザトラッカ）７０は、位置補正用マーカ２２、３２を常に位置監視する（追跡し続ける）ことにより、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの位置合わせ（微小駆動）を補助する。ロボットアーム２０、３０は、第１の位置情報生成装置（レーザトラッカ）７０と位置補正用マーカ２２、３２によって事前にキャリブレーションされており、空間座標における絶対精度を向上している。

【0037】

ロボットアーム２０、３０に取り付けられた位置補正用マーカ２２、３２を計測する際に、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの車両原点をマーカに置き換えることで、第１の位置情報生成装置（レーザトラッカ）７０から常に三次元座標を監視できるようにする。また、マーカ目標位置と現在位置の差分を動作させ、最終位置を補正することで、強制的にロボットの空間座標精度を向上させる。

【0038】

図６は、本実施形態の校正機能を有する対象物の検出方法及び検出装置を適用した車両部品の溶接装置１の構成の第３の例を示す図である。図６は、上述した点群データ、基準データおよび形状合わせ点群データに基づくロボットアーム２０、３０（把持部２１、３１）の運動（移動）制御を実行するための機能構成要素を例示して描いている。各機能構成要素は、ＣＰＵ（Central Processing Unit）から構成される制御部９０の一部を構成している。

【0039】

制御部９０は、点群データ取得部９１と、基準データ取得部９２と、移動マトリックス演算部９３と、逆マトリックス演算部９４と、目標移動マトリックス演算部９５と、ロボットアーム制御部９６とを有している。

【0040】

点群データ取得部９１は、第１の位置情報生成装置（レーザトラッカ）７０と第２の位置情報生成装置（３Ｄスキャナ）６１による、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの点群データ（三次元情報）を取得する（が入力される）。この点群データは、第１の位置情報生成装置（レーザトラッカ）７０を原点（架空原点）とした点群データであってもよい。

【0041】

基準データ取得部９２は、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの設計上の基準となる基準データ（例えばＣＡＤデータ）を取得する（を記憶する）。この基準データは、原点（例えば車両原点、この場合は車両原点＝位置情報生成装置原点）を含むとともに、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの位置合わせ状態のデータとすることができる。

【0042】

移動マトリックス演算部９３は、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットの位置合わせ状態の基準データに、点群データを位置合わせするための移動マトリックスを演算する。この移動マトリックス演算により、移動マトリックスに基づいて基準データに点群データを位置合わせした形状合わせ点群データが得られる。

【0043】

逆マトリックス演算部９４は、移動マトリックス演算部９３で求めた基準データに点群データを合わせる際の４×４の行列データ（マトリックス）を逆行列変換する。本変換により、前述の点群データに原点を付与した形になる（基準データ原点で表されていた形状合わせ点群データの状態を点群データ基準で表した形）。この方式により、原点の存在しない点群データにＣＡＤ原点情報を付与することを実現している。

【0044】

目標移動マトリックス演算部９５は、固定治具１０が支持するドアフレーム１１、ロボットアーム２０が把持するロックブラケット、ロボットアーム３０が把持するヒンジブラケットのそれぞれについて、逆マトリックスを使用し、原点（車両原点）を付与した状態から、ロックブラケットとヒンジブラケットの原点からもう一方の原点までの移動量を算出することができる。

【0045】

ロボットアーム制御部９６は、移動マトリックスと逆マトリックスの少なくとも一方に基づいて、ロックブラケットをロボットアーム２０で移動させ、ヒンジブラケットをロボットアーム３０で移動させることにより、ロックブラケットとヒンジブラケットをドアフレーム１１に位置決めする。より具体的に、ロボットアーム制御部９６は、移動マトリックスと逆マトリックスの少なくとも一方に基づいて、位置決め対象であるロックブラケットとヒンジブラケットを初期位置や現在位置から目標位置に到達するまで、例えば、ロボットアーム２０、３０の各軸（６軸）を微小動作させる。この時の微小動作量の指令値は、第１の位置情報生成装置（レーザトラッカ）７０から見た位置補正用マーカ２２、３２の現状位置と目標位置の差分である。この微少動作量の数値を係数調整、動作回数で設定することにより、ロボットの精度に依存しない位置決めを可能とする。すなわち、本実施形態では、（１）移動マトリックスと逆マトリックスの少なくとも一方に基づくワーク（把持部）の移動（例えば逆マトリックスによるロックブラケットとヒンジブラケットに付加した原点をもとにどちらか一方の原点を基準にもう一方の原点へ移動）と、（２）位置補正用マーカ２２、３２に基づくロックブラケットとヒンジブラケットの移動（位置補正用マーカ２２、３２による補正位置決め、（１）の動作誤差を補正するもの）との二段階で、ワーク同士（ロックブラケットとヒンジブラケット）の位置決めを実行する。ロボットアーム制御部９６によるロックブラケットとヒンジブラケットの位置決め状態で、溶接ロボット４０、５０によって両者の溶接部が溶接される。

【0046】

制御部９０の機能は、次のように表現することもできる。すなわち、制御部９０は、三次元データ（例えば点群データ）を取得するとともに、ハンドとワークの相対位置データ（例えば基準データ）を取得する。制御部９０は、取得した三次元データ（例えば点群データ）と相対位置データ（例えば基準データ）とをベストフィットさせるための空間位置決め処理を実行する。制御部９０は、ハンドによるワークの移動分座標値を出力する。制御部９０は、ロボット逆運動学に基づく６軸計算により、ハンドとワークの運動（移動）制御を実行する。

【0047】

本実施形態の位置決め処理は、例えば、次の処理ステップによって実行される。まず、ロックブラケットとヒンジブラケットの点群データをＣＡＤデータ（基準データ）に位置合わせして、その移動分量を４×４の行列データ（マトリックスデータ）である移動マトリックスで出力する。これにより、ロックブラケットとヒンジブラケットに関して、移動マトリックスに基づいて基準データに点群データを位置合わせした形状合わせ点群データが得られる。また、ドアフレーム１１の点群データをＣＡＤデータ（基準データ）に位置合わせして、その移動分量を４×４の行列データ（マトリックスデータ）である移動マトリックスで出力する。これにより、ドアフレームの１１に関して、移動マトリックスに基づいて基準データに点群データを位置合わせした形状合わせ点群データが得られる。また、計算した移動マトリックスから逆行列演算（逆マトリックス演算）を実行することにより、点群データに原点を付与する。つまり、一方の原点を基準に他方の原点を合わせる。あるいは、形状合わせ点群データを移動させることにより、基準データの原点（車両原点）を一緒に移動させ、ロックブラケットとヒンジブラケットとドアフレーム１１の移動させた原点どうしを合わせてもよい。また、計算した逆マトリックスを使用して、ロックブラケットとヒンジブラケットとドアフレーム１１の点群データに座標値（例えばＣＡＤ座標）を付与する。そして、原点（車両原点）を基準とした座標系で、点群データの移動量を算出し、算出した移動量に基づいて、ロックブラケットとヒンジブラケットを把持するロボットアーム２０、３０を移動させることにより、ロックブラケットとヒンジブラケットをドアフレーム１１に位置決めする。本実施形態では、ドアフレーム１１が固定でロックブラケットとヒンジブラケットが可動であるため、当該移動量は、ロックブラケットとヒンジブラケットのドアフレーム１１に対する移動量（ロックブラケットとヒンジブラケットのＣＡＤ座標からドアフレーム１１のＣＡＤ座標への移動量）に相当する。最後に、算出したロックブラケットとヒンジブラケットのドアフレーム１１に対する移動量に基づいて、ロックブラケットとヒンジブラケットをドアフレーム１１に対して移動させることにより、ロックブラケットとヒンジブラケットがドアフレーム１１に対して位置決めされる。

【0048】

本実施形態の点群データを基準データに位置合わせするプロセスは、例えば、点群情報を強制数値（定量値）移動させる強制数値移動ステップと、点群全体とＣＡＤ全体形状で位置合わせを行う全体形状合わせのベストフィットステップと、基準部位、例えば製品評価の基準となる部位に合わせて詳細位置合わせを行う基準位置合わせステップとを含んでいる。

【0049】

ところで、例えば、溶接装置１の初期設定時（キャリブレーション時）には、第１の位置情報生成装置（レーザトラッカ）７０により第２の位置情報生成装置（３Ｄスキャナ）６１の位置補正用マーカ６２の位置や姿勢を毎回計測している。また、上述した通り、３Ｄスキャナ６１は３Ｄスキャナ支持アーム６０の先端側に支持されており、第２の位置情報生成装置（３Ｄスキャナ）６１が得た点群データを第１の位置情報生成装置（レーザトラッカ）７０の原点データに置き換えている。

【0050】

しかしながら、稼働時には第２の位置情報生成装置（３Ｄスキャナ）６１やその周辺金属が昇温（例えば２０℃）して熱膨張を起こすことで、３Ｄスキャナ６１の位置精度がバラつく結果、３Ｄスキャナ６１の初期原点と、３Ｄスキャナ６１の昇温後原点とがずれてしまい、対象物（例えばロックブラケットとヒンジブラケットとドアフレーム１１）の位置合わせの精度が悪化するおそれがある。これにより、ずっと同じところに置いてあるワークを３Ｄスキャンし続けていると（取得した点群情報をレーザトラッカ原点に変換）、取得した点群データの位置や姿勢が時間経過（昇温経過）によりばらつく問題が発生する。

【0051】

そこで、本実施形態では、第１の位置情報生成装置（レーザトラッカ）７０から形状マーカ８０までの距離が算出できれば、第２の位置情報生成装置（３Ｄスキャナ）６１から位置補正用マーカ６２までの寸法が算出可能であることに着目して、実際のワーク測定に入る前に、３Ｄスキャナ６１と位置補正用マーカ６２の間の寸法を再測定して、両者の位置校正機能を追加している。温度等の環境状況に応じて変化してしまう３Ｄスキャナ６１の原点位置を定期的に校正して、例えば１サイクル毎に１回校正することで、温度等の環境状況に対応して常に高精度な位置や姿勢の検出を維持し続けることが可能になる。

【0052】

図７Ａ～図７Ｄは、形状マーカ（固定物、金属塊）８０の第１の例を示す図である。図７Ａ～図７Ｄは、形状マーカ８０が三角錐の形状を含んでいる。形状マーカ８０は、符号８３ａ面視（例えば符号８３ａの面に垂直な方向から見た時に）直角三角形形状をなす基部８２と、平面視直角三角形形状の中心部に延びる３つの側面部８３と、３つの側面部８３の集合部分を切り取った符号８３ａ面視（例えば符号８３ａの面に垂直な方向から見た時に）直角三角形形状の頂面部８４とを有している。基部８２及び頂面部８４は、平面視したときに相似形の直角三角形形状を有している。後述する座標抽出時にどの座標軸がどこを向いているか特定するために一部平面部８３ａを設けても良い。または一部の面を色分けして座標軸を特定するなど、向きを特定する手段は何であっても良い。つまり三角錐の形状を含むとは、図７Ａ～図７Ｄのような頂面部８４を有している形状も含むものである。

【0053】

図８は、形状マーカ（固定物、金属塊）８０の第２の例を示す図である。図８は、形状マーカ８０が３つの球８５の形状を含んでいる。３つの球８５のうちの１つによって対象物の位置を把握することができ、３つによって対象物の姿勢を把握することができる。３つの球８５によって規定された点を結ぶことにより、互いに直交するＸ軸とＹ軸とＺ軸を基準とする空間座標（３次元座標）における対象物の位置と姿勢を把握することができる。後述する座標抽出時にどの座標軸がどこを向いているか特定するために３つの球の配置は各々寸法が異なるように配置しても良い。または一部の面を色分けして座標軸を特定するなど、向きを特定する手段は何であっても良い。

【0054】

図７Ａ～図７Ｄ及び図８に示した形状マーカ８０の形状はあくまで一例であり、種々の設計変更が可能である。形状マーカ８０は、互いに直交するＸ軸とＹ軸とＺ軸を基準とする空間座標（３次元座標）における対象物の位置と姿勢を把握することができるものであればよい。例えば図７Ａ～図７Ｄの三角錐の形状を含むマーカについては、８３ａの点群の平均平面と８３ｂの点群の平均平面から、両平面の交わる交線をＸ軸として算出し、８３ｂの点群の平均平面と８３ｃの点群の平均平面から、両平面の交わる交線をＹ軸として算出し、残りのＺ軸はＸ軸とＹ軸の関係から算出することで形状マーカ８０の姿勢が特定できる。この際に形状マーカ８０が回転してしまうと、計算上では、Ｘ軸、Ｙ軸、Ｚ軸の向きがわからなくなる可能性があるため、前述したようなマーカの向きを特定するような形状差があると、その部分をＺ軸方向にするなど、定義することで、形状マーカ８０が回転しても正確にその姿勢を求めることができる。位置については８３ａ、８３ｂ、８３ｃの点群の平均平面の交点から算出することで算出できる。この際に、頂面部８４にこの交点を投影して、その位置情報を使用しても良い。３Ｄスキャンの特徴として、面直で取得した点群情報の方が、傾斜している面をスキャンした時よりもより正確な点群情報を得られることから、この処理を挟むことによって位置誤差を軽減することが可能である。図８の球についても球の配置を均等配置するのでなく、８５ａ、８５ｂ、８５ｃの３つの球間寸法に差をつけることでＸ軸、Ｙ軸又はＺ軸の方向を特定し、形状マーカ８０の向きを特定することが可能である。なお、８５ａ、８５ｂ、８５ｃの３つの球間寸法には自由度があり、種々の設計変更が可能である。

【0055】

なお、形状マーカ８０は、ワーク（例えばロックブラケット、ヒンジブラケット）を把持するロボットアーム２０、３０の先端側に設けられてもよい。この場合、ロボットアーム２０、３０の位置補正用マーカ２２、３２に代えて／加えて、形状マーカ８０を設けてもよい。

【0056】

図９は、第２の位置情報生成装置（３Ｄスキャナ）６１と位置補正用マーカ６２の間の位置校正処理の一例を示す図である。図９の位置校正処理は、第２の位置情報生成装置（３Ｄスキャナ）６１と位置補正用マーカ６２の少なくとも一方を基準とした第２の位置情報生成装置（３Ｄスキャナ）６１の原点の位置と姿勢である定量値を算出・校正するためのものである。本明細書において、第２の位置情報生成装置（３Ｄスキャナ）６１の位置と姿勢は、第２の位置情報生成装置（３Ｄスキャナ）６１の原点を基準とした値（パラメータ）を意味するものとする。初期設定時の定量値（デフォルト値）を算出する（Ｃ）。第１の位置情報生成装置（レーザトラッカ）７０を用いて、第１の対象物としての位置補正用マーカ６２の位置と姿勢を測定する（Ｄ）。第２の位置情報生成装置（３Ｄスキャナ）６１を用いて、第２の対象物としての、位置校正用基準台に設けられた形状マーカ８０の位置と姿勢を測定する（Ｂ）。第１の位置情報生成装置（レーザトラッカ）７０による第１の対象物としての位置補正用マーカ６２の測定値（Ｄ）と、第２の位置情報生成装置（３Ｄスキャナ）６１による第２の対象物としての位置校正用基準台に設けられた形状マーカ８０の測定値（Ｂ）と、初期設定時の定量値（デフォルト値）（Ｃ）とに基づいて、第１の位置情報生成装置（レーザトラッカ）７０を基準とした第２の対象物としての位置校正用基準台に設けられた形状マーカ８０の位置を算出する（Ａ）。そして、第２の位置情報生成装置（３Ｄスキャナ）６１を用いて第３の対象物（例えば、ロボットアーム２０、３０が把持するロックブラケット、ヒンジブラケットを位置合わせするドアフレーム１１）を測定する前に、位置補正用マーカ６２を基準とした第２の位置情報生成装置（３Ｄスキャナ）６１の原点の位置と姿勢である定量値を校正する。具体的に、第１の位置情報生成装置（レーザトラッカ）７０を基準とした第２の対象物としての位置校正用基準台に設けられた形状マーカ８０の位置（Ａ）から、第１の位置情報生成装置（レーザトラッカ）７０による第１の対象物としての位置補正用マーカ６２の測定値（Ｄ）と、第２の位置情報生成装置（３Ｄスキャナ）６１による第２の対象物としての位置校正用基準台に設けられた形状マーカ８０の測定値（Ｂ）とを計算することにより、位置補正用マーカ６２を基準とした第２の位置情報生成装置（３Ｄスキャナ）６１の原点の位置と姿勢である定量値（Ｃ）を校正する。その際、第２の位置情報生成装置（３Ｄスキャナ）６１で撮像したデータが第２の位置情報生成装置（３Ｄスキャナ）６１の原点で点群出現し、点群から抽出した座標を合わせることで、第１の位置情報生成装置（レーザトラッカ）７０の原点からの第２の位置情報生成装置（３Ｄスキャナ）６１の位置と姿勢を求めることができる。

【0057】

上記の定量値の算出及び／又は校正のための処理ステップは、次の第１ステップ～第４ステップを含むことができる。
（１）第１の位置情報生成装置（レーザトラッカ）７０で第２の位置情報生成装置（３Ｄスキャナ）６１と位置補正用マーカ６２の少なくとも一方を測定する第１ステップ（Ｄ）。
（２）第１の位置情報生成装置（レーザトラッカ）７０で第４の対象物としての形状マーカ８０を測定する第２ステップ（Ａ）。
（３）第２の位置情報生成装置（３Ｄスキャナ）６１で第４の対象物としての形状マーカ８０を測定する第３ステップ（Ｂ）。
（４）第１ステップ（Ｄ）と第２ステップ（Ａ）と第３ステップ（Ｂ）の測定結果に基づいて、位置補正用マーカ６２を基準とした第２の位置情報生成装置（３Ｄスキャナ）６１の原点の位置と姿勢である定量値を算出及び／又は校正する第４のステップ（Ｃ）。

【0058】

なお、上記の説明では、形状マーカ８０が第２の対象物と第４の対象物を兼用する場合を例示しているが、位置校正用基準台に位置する形状マーカ８０と別個の形状マーカを設けて、これらを第２、第４の対象物としてもよい。また、第２の位置情報生成装置（３Ｄスキャナ）６１の位置ずれ校正用の形状マーカとして、第４の対象物の位置と姿勢を担保するための第５の対象物（マーカ）、すなわち位置補正用マーカ４２を設けて、当該第５の対象物を測定するステップを追加してもよい。第１の対象物としての位置補正用マーカ６２が温度による位置ずれの可能性があるため、精度を担保するため、最初に予め位置を測定した第５の対象物（マーカ）を介在させて校正時の測定を行い、位置補正用マーカ６２を基準とした第２の位置情報生成装置（３Ｄスキャナ）６１の原点の位置と姿勢である定量値を算出及び／又は校正してもよい。

【0059】

代替的には、位置補正用マーカ６２を基準とした第２の位置情報生成装置（３Ｄスキャナ）６１の位置と姿勢である定量値を、第２の位置情報生成装置（３Ｄスキャナ）６１の温度によって異なる予め決定された値としてテーブルとして保持してもよい。そして、このテーブルを参照して、第２の位置情報生成装置（３Ｄスキャナ）６１の温度測定に基づいて、位置補正用マーカ６２を基準とした第２の位置情報生成装置（３Ｄスキャナ）６１の位置と姿勢である定量値を算出及び／又は校正してもよい。例えば、所定の温度範囲毎に定量値（校正値）を保持したテーブルを参照して、測定温度に応じた定量値（校正値）を算出してもよいし、温度を入力パラメータとした計算式に測定温度を代入することで定量値（校正値）を算出してもよい。

【0060】

以上説明した定量値の校正処理を、例えば、温度等の環境変化が懸念される所定タイミングで実行する（例えば、１サイクル毎の３Ｄスキャン測定前に校正処理を実行する）。これにより、３Ｄスキャナとマーカ間の位置・姿勢を校正して、環境影響（温度）によるバラつきを吸収することができる。

【0061】

以上のように、本実施形態の対象物の検出方法は、定量値を算出するステップと、第１の位置情報生成装置で第１の対象物を測定するステップと、第２の位置情報生成装置で第２の対象物を測定するステップと、前記第１の位置情報生成装置による前記第１の対象物の測定値と、前記第２の位置情報生成装置による前記第２の対象物の測定値と、前記定量値とに基づいて、前記第１の位置情報生成装置を基準とした前記第２の対象物の位置を算出するステップと、前記第２の位置情報生成装置で第３の対象物を測定する前に、前記定量値を校正するステップと、を有している。これにより、外部環境の変化（気温など）にかかわらずに対象物の検出精度を維持することができる。３Ｄスキャナとマーカ間の位置・姿勢を校正して、環境影響（温度）によるバラつきを吸収することができる。

【符号の説明】

【0062】

１ 溶接装置
１０ 固定治具
１１ ドアフレーム（第３の対象物）
２０ ロボットアーム
２１ 把持部
２２ 位置補正用マーカ
３０ ロボットアーム
３１ 把持部
３２ 位置補正用マーカ
４０ 溶接ロボット
４１ 溶接ノズル
４２ 位置補正用マーカ（第５の対象物）
５０ 溶接ロボット
５１ 溶接ノズル
６０ ３Ｄスキャナ支持アーム
６１ 第２の位置情報生成装置（３Ｄスキャナ）
６２ 位置補正用マーカ（第１の対象物）
７０ 第１の位置情報生成装置（レーザトラッカ）
８０ 形状マーカ（第２の対象物、第４の対象物、固定物、金属塊）
８２ 基部
８３ 側面部
８４ 頂面部
８５ ３つの球
９０ 制御部
９１ 点群データ取得部
９２ 基準データ取得部
９３ 移動マトリックス演算部
９４ 逆マトリックス演算部
９５ 目標移動マトリックス演算部
９６ ロボットアーム制御部

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】