JP7048188B2 - ロボットシステム及びロボット制御方法 - Google Patents

Description

本発明は、主として、３次元データを用いてロボットに教示が行われるロボットシステムに関する。

一般的に、平板状かつ剛性が低い検査対象物（以下、ワーク）に対して検査を行う場合、ワークを載置面に置いて検査を行うことで、ワークの自重による撓みを防止しつつ、検査を行うことができる。しかし、例えば湾曲した板状のワークに対して検査を行う場合、ワークを載置面に置いた場合でも、ワークの剛性によっては、ワークが自重により撓むことがある。

特許文献１には、ガラス板の設計データに基づいて、ガラス板を検査台に載置させたときの形状を示す仮想設計データを算出し、この仮想設計データによりガラス板の形状を検査する方法が記載されている。

特許第５４０３３７５号公報

従来から、ロボットを用いてワークの検査を行わせる方法が知られている。この方法では、ロボットの動作手順を記述した３次元ＣＡＤデータに基づくプログラムを作成する必要がある。上述のように検査時においてワークが撓む場合は、検査時のワークの形状と３次元ＣＡＤデータ上のワークの形状とが異なるため、このプログラムの作成が困難となる。以上の事情により、撓みが生じるワークに対して形状に応じた検査をロボットに行わせるためにはロボットに直接教示する必要があり、採用する際の障害となっている。そのため、従来では、目視による検査が行われていた。また、特許文献１では、撓みを考慮してガラス板の形状を検査する方法を開示しているだけであり、撓みが生じたワーク（ガラス板）に対して、形状に応じた検査を行うことは開示されていない。

本発明は以上の事情に鑑みてされたものであり、その主要な目的は、撓みが生じたワークに対しても、ワークの形状に応じた検査を直接教示することなしにロボットに行わせることが可能なロボットシステムを提供することにある。

本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段とその効果を説明する。

本発明の第１の観点によれば、以下の構成のロボットシステムが提供される。即ち、このロボットシステムは、検査装置と、ロボットと、計測装置と、教示データ記憶部と、差異データ算出部と、教示データ補正部と、動作制御部と、を備える。前記検査装置は、ワークの厚み及び表面欠陥の少なくとも一方の検査を行う。前記ロボットは、前記検査装置に対する前記ワークの相対位置を変化させる。前記計測装置は、前記ワークの少なくとも一部の形状を計測する。前記教示データ記憶部は、前記ワークの３次元データに基づいて設定された教示点を記憶する。前記差異データ算出部は、前記ワークの自重による撓み及び前記ワークの内部歪みの少なくとも一方に起因する形状の差異を示す差異データを、前記計測装置の計測結果と前記ワークの３次元データとを比較することで算出する。前記教示データ補正部は、前記教示点を、前記差異データに基づいて補正した補正教示点を算出する。前記動作制御部は、前記補正教示点に基づいて前記ロボットを動作させることで前記検査装置による前記ワークの検査を行わせる。前記ロボットが前記ワークを保持して移動させることで、当該ワークの端部が前記検査装置により検査される。前記計測装置は、前記ワークの端部の鉛直方向の位置を計測する。
本発明の別の観点によれば、前記検査装置及び前記計測装置が前記ロボットに取り付けられており、前記ロボットは、作業台に前記ワークを置いた状態で当該ワークに対して計測及び検査を行うことが好ましい。

本発明の第２の観点によれば、以下のロボット制御方法が提供される。即ち、このロボット制御方法では、ワークの厚み及び表面欠陥の少なくとも一方の検査を行う検査装置に対して前記ワークを相対移動させることで前記ワークの検査を補助するロボットを制御する。このロボット制御方法は、計測結果取得工程と、差異データ算出工程と、補正教示点算出工程と、動作制御工程と、を含む。前記計測結果取得工程では、前記ワークの少なくとも一部の形状を計測装置で計測して計測結果を取得する。前記差異データ算出工程では、前記ワークの自重による撓み及び前記ワークの内部歪みの少なくとも一方に起因する形状の差異を示す差異データを、前記計測結果取得工程での計測結果と前記ワークの３次元データとを比較することで算出する。前記補正教示点算出工程では、前記ワークの３次元データに基づいて設定された教示点を、前記差異データに基づいて補正した補正教示点を算出する。前記動作制御工程では、前記補正教示点に基づいて前記ロボットを動作させることで前記検査装置による前記ワークの検査を行わせる。前記ロボットが前記ワークを保持して移動させることで、当該ワークの端部が前記検査装置により検査される。前記計測装置は、前記ワークの端部の鉛直方向の位置を計測する。
本発明の別の観点によれば、前記検査装置及び前記計測装置が前記ロボットに取り付けられており、前記ロボットは、作業台に前記ワークを置いた状態で当該ワークに対して計測及び検査を行うことが好ましい。

これにより、ワークの３次元データと実際の形状との差異に基づいて教示点を補正できるので、撓みが生じたワークの形状に応じた適切な検査を直接教示することなしにロボットに行わせることができる。

本発明によれば、撓みが生じたワークに対しても、ワークの形状に応じた検査を直接教示することなしにロボットに行わせることが可能なロボットシステムを実現できる。

第１実施形態に係るロボットシステムの構成を示すブロック図。 ロボットがワークを保持して検査を行う様子を示す斜視図。 ３次元データを用いて教示を行う処理を示すフローチャート。 内部歪み及び撓みによりワークが変形する様子を示す模式図。 ワークの検査を開始する前に教示データの補正を行う処理を示すフローチャート。 ワークの検査と並行して教示データの補正を行う処理を示すフローチャート。 ワークの端部の１点のみを計測する様子を示す図、及び、それにより作成される補正教示データを示す表。 ワークの端部の複数点を計測する様子を示す図、及び、それにより作成される補正教示データを示す表。 ワークの端部の複数点の鉛直方向の位置及び水平方向の位置を計測する様子を示す図、及び、それにより作成される補正教示データを示す表。 第２実施形態で行われる検査の様子を示す斜視図。 ワークと検査装置の距離に応じてロボットの位置を補正する様子を示す図。 ワークと検査装置の距離及び傾きに応じてロボットの位置を補正する様子を示す図。 距離センサを増やすことでワークの端部においても傾きを計測できることを示す模式図。

次に、図面を参照して本発明の実施形態を説明する。初めに、図１を参照して第１実施形態のロボットシステム１について説明する。図１は、本発明の第１実施形態に係るロボットシステム１の構成を示すブロック図である。

ロボットシステム１は、ロボット１０と、制御装置２０と、教示装置３０と、を備えている。ロボットシステム１は、教示装置３０によりロボット１０の教示を行って教示データを作成し、この教示データを用いて制御装置２０がロボット１０を制御することで、検査対象物であるワーク１００に対して所定の検査が行われる。

本発明においてロボット１０が行う検査は、ワーク１００の形状に応じてロボット１０を動作させる必要がある検査である。この検査としては、例えばワーク１００の表面欠陥を調べる検査、ワーク１００の厚みを調べる検査等がある。

本実施形態のロボットシステム１は、作業時においてワーク１００の撓みの影響が無視できない場合に特に有効である。従って、ワーク１００は、撓みが生じ易い形状（湾曲又は屈曲等が含まれる板状、３軸の立体座標系で表面形状を表したときに３軸全ての値が変化する部分を有する形状等）であることが好ましい。また、ワーク１００の材料としては、ヤング率等の弾性率が小さいこと（即ち剛性が低い材料であること）が好ましい。以下では、一例として、ガラス板の表面欠陥を検査する作業について説明する。

なお、本実施形態のロボットシステム１は、様々な用途のガラス板に対して検査を行うことが可能であるが、例えば自動車等の乗物用の窓ガラス（特にプロジェクタが照射した映像を表示するヘッドアップディスプレイに用いられるガラス）や、曲面形状の有機ＥＬパネルや液晶パネルに用いられるガラスは、曲面形状かつ要求される品質が高いので、本実施形態の機能を特に有効に活用できる。

ロボット１０は、支持台１１と、多関節アーム１２と、エンドエフェクタ１３と、を備える。支持台１１は施設内の所定の位置に固定されている。多関節アーム１２は、複数の関節を有しており、各関節にはアクチュエータが備えられている。これらのアクチュエータが制御装置２０により制御されることで、多関節アーム１２の姿勢（位置）及び速度が調整される。エンドエフェクタ１３は、多関節アーム１２の先端に取り付けられている。エンドエフェクタ１３には、例えばワーク１００を把持するためのツールが取り付けられる。

制御装置２０は、公知のコンピュータにより構成されており、演算装置（ＣＰＵ等）と記憶装置（ＲＯＭ、ＲＡＭ、ＨＤＤ等）を備えている。また、この記憶装置には、各種のプログラムが記憶されている。演算装置がこのプログラムをＲＡＭ等に読み出して実行することで制御装置２０はロボット１０に関する様々な制御を行う。これにより、制御装置２０を動作制御部２１として機能させることができる。動作制御部２１は、上記の多関節アーム１２及びエンドエフェクタ１３を制御する。また、制御装置２０は、教示装置３０が作成した教示データを記憶する教示データ記憶部２２を備える。

教示装置３０は、公知のコンピュータにロボット１０の教示を行うためのソフトウェアがインストールされた構成である。従って、教示装置３０も制御装置２０と同様に演算装置及び記憶装置を備えている。教示装置３０は、３次元データ読込み部３１と、教示データ作成部３２と、差異データ算出部３３と、教示データ補正部３４と、を備える。なお、これらが行う処理については後述する。

ここで、本実施形態のロボットシステム１では、制御装置２０と教示装置３０が異なるハードウェアから構成されているが、本発明の機能が発揮できるのであれば、ハードウェアの構成は任意である。例えば、制御装置２０と教示装置３０とが同じハードウェアであってもよいし、制御装置２０と教示装置３０に加えて別のハードウェアを更に備える構成であってもよい。また、本実施形態の教示装置３０が有する機能の少なくとも一部を制御装置２０に持たせてもよいし、制御装置２０が有する機能の少なくとも一部を教示装置３０に持たせてもよい。

次に、ロボットシステム１を用いて行う検査の内容及び検査を行うための機器について、更に図２を参照して説明する。図２は、ロボット１０がワーク１００を保持して作業を行う様子を示す斜視図である。

本実施形態のワーク１００は板状であり、面積が大きい２つの面（厚み方向に略垂直な面）を主表面１０１と称する。また、２つの主表面を接続する面（厚み方向に略平行な面）を端面１０２と称する。また、端面１０２及びその近傍（即ち主表面１０１の縁部）を含む部分を端部と称する。本実施形態では、ワーク１００の端部の表面欠陥（傷、欠け、異常形状等）の有無及び程度等を調べる検査を行う方法を説明する。

この検査は、図２に示す端部検査装置（検査装置）４０を用いて行われる。端部検査装置４０は、一例として３方が壁面で囲まれた検査領域を有しており、これらの３方の壁面には撮像孔４１がそれぞれ形成されている。撮像孔４１の内部にはＣＣＤ等の撮像装置が配置されている。この構成により、２つの主表面１０１の縁部及び端面１０２の画像がそれぞれ撮影される。この画像を解析することで、ワーク１００の端部の表面欠陥を検査することができる。

ロボット１０は、エンドエフェクタ１３によりワーク１００を保持した状態で、当該ワーク１００の端部を端部検査装置４０の検査領域まで移動させることで、ワーク１００の端部の検査を行う。また、ロボット１０は、ワーク１００が端部検査装置４０等に当たらないように多関節アーム１２の姿勢を変えつつエンドエフェクタ１３を回転させることで、ワーク１００の全ての端部（検査対象が一部の端部の場合は、当該一部の端部）について端部検査装置４０による検査が行われる。また、端部検査装置４０による検査結果は、ワーク１００の検査等を管理する検査システム管理装置６０に送信される。また、端部検査装置４０の近傍には、距離センサ７１及び水平形状センサ７２等の計測装置が配置されており、ワーク１００の形状を計測する。なお、計測装置による計測及びそれに伴う処理については後述する。

次に、ロボット１０を教示する際に教示装置３０が行う処理について図３のフローチャートを参照して説明する。

ここで、本実施形態の教示装置３０は、ロボット１０を実際に動かすのではなく、コンピュータ上で構築される仮想空間においてロボット１０、周辺装置、及びワーク１００の３次元モデルを配置して教示を行う。初めに、教示装置３０（３次元データ読込み部３１）は、ワーク１００の３次元データを読み込む（Ｓ１０１）。ここで、教示装置３０が読み込む３次元データは、設計時等に作成した３次元のＣＡＤデータである。なお、この３次元データでは、無重力状態で外力を受けていない状態でのワーク１００の形状を示すデータである。これにより、仮想空間上にワーク１００を表示することができる。

次に、教示装置３０は、作業者の入力等に基づいて、ワーク１００の作業箇所、作業順序、作業内容、及び作業条件等を設定する（Ｓ１０２）。次に、教示装置３０（教示データ作成部３２）は、ステップＳ１０２で設定した内容に基づいて、ロボット１０（エンドエフェクタ１３）に行わせる動作の順序に応じて空間上の点（座標）を教示点として設定する処理を自動で行う（Ｓ１０３）。また、教示点には、空間上の位置だけでなく向き（ｘ軸回りの回転角α、ｙ軸回りの回転角β）についても設定される、なお、本実施形態では、ロボット１０に教示を行うことで作成したデータであって、ロボット１０を制御するために用いられるデータ（教示点及び作業条件等が含まれたデータ）を教示データと称する。

次に、教示装置３０は、作成した教示データに基づいて、仮想空間上でロボット１０を動作させるシミュレーションを行うことで、ロボット１０の動作及び干渉等のチェックを行う（Ｓ１０４）。そして、干渉等が生じず、かつ、作業者が教示データが適切であると判断することで教示作業が完了し、教示データが保存される（Ｓ１０５）。教示装置３０に保存された教示データは、有線通信又は無線通信により制御装置２０へ送られる。以上により、ロボット１０に教示を行うことができる。

次に、ワーク１００が自重による撓み及び内部歪みにより変形することが、ワーク１００の検査に及ぼす影響について図４を参照して説明する。

本実施形態のワーク１００であるガラス板は、高温状態から冷却を行うことで製造される。このとき、ガラス板の内部の温度ムラ等に起因して内部歪みが発生することで、図４（ａ）に示すように、ガラス板が変形することがある。従って、３次元データ上のワーク１００と、実際のワーク１００と、は形状に差異が生じることがある。更に、実際の作業時においては、ガラス板のように剛性が低いワーク１００は、エンドエフェクタ１３によって中央近傍が保持されることで、図４（ｂ）に示すように、ワーク１００（特に端部）に自重による撓みが生じる。なお、ワーク１００の内部歪みによる変形と、ワーク１００の自重による撓みのうち一方のみが生じることもある。

ここで、教示装置３０が読み込んだワーク１００の３次元データは、撓み及び内部歪み等に起因する変形が生じていない形状のデータである。そのため、ワーク１００の３次元データを用いて教示装置３０が作成した教示データを用いて制御装置２０がロボット１０を制御する場合、ワーク１００が端部検査装置４０等の周辺機器に接触してしまう可能性がある。また、接触しない場合であっても、端部検査装置４０が撮像を行う位置及び向きがズレることで、正しい検査結果が得られない可能性がある。

以上を考慮し、本実施形態では、自重による撓み及び内部歪みによりワーク１００が変形することを考慮して、教示データを補正しつつ、ワーク１００の検査を行う。

撓み等により変形したワーク１００を考慮して教示データを補正する処理としては、ワーク１００の検査前に予め教示データを補正する方法と、ワーク１００の検査と並行して教示データを補正する方法と、がある。

初めに、ワーク１００の検査前に予め教示データを補正する方法について、図５を参照して説明する。教示装置３０は、計測装置によるワーク１００の形状の計測結果を取得する（Ｓ２０１）。なお、ワーク１００の形状の計測方法（計測機器及び計測箇所等）には様々なバリエーションがあり、詳細は後述する。

次に、教示装置３０（差異データ算出部３３）は、ワーク１００の三次元データと、ワーク１００の計測結果と、を比較して、これらの形状の差異を示す差異データを算出する（Ｓ２０２）。次に、教示装置３０は、差異データの値が閾値以上か否かを判定する（Ｓ２０３）。差異データの値が閾値より小さい場合は、ワーク１００の３次元データと、計測結果（実際のワーク１００の形状）と、の差異が小さいため、教示装置３０は、事前に作成した教示データの補正を行うことなく、制御装置２０へワーク１００の検査を指示する（Ｓ２０５）。

一方、差異データの値が閾値以上である場合は、教示装置３０（教示データ補正部３４）は、ワーク１００の３次元データと、計測結果（実際のワーク１００の形状）と、の差異に応じて、事前に作成した教示データを補正して補正教示データを作成する（Ｓ２０４）。また、この補正教示データは、制御装置２０へ送信される。その後、教示装置３０は、制御装置２０へワーク１００の検査を指示する（Ｓ２０５）。制御装置２０が補正教示データに基づいてロボット１０を制御することで、ワーク１００の検査が行われる。

次に、ワーク１００の検査と並行して教示データを補正する方法について、図６を参照して説明する。教示装置３０は、ワーク１００の検査の開始後において、検査のためにワークを移動させる過程において、計測装置によるワーク１００の形状の計測結果を取得する（Ｓ３０１）。

次に、教示装置３０（差異データ算出部３３）は、計測結果を取得した範囲において、ワーク１００の三次元データと、ワークの計測結果と、を比較して、これらの形状の差異を示す差異データを算出する（Ｓ３０２）。なお、図６の処理では、ワーク１００の検査と計測が並行して行われるため、ステップＳ３０２で算出される差異データもワーク１００の一部分の差異データである。

次に、教示装置３０は、差異データの値が閾値以上か否かを判定する（Ｓ３０３）。差異データの値が閾値以上である場合は、教示装置３０（教示データ補正部３４）は、差異データを算出した範囲において補正教示データを作成する（Ｓ３０４）。また、この補正教示データは、制御装置２０へ送信される。次に、教示装置３０は、ワーク１００の検査が完了したか否かを判断し（Ｓ３０５）、ワーク１００の検査が完了していない場合は、再びステップＳ３０１以降の処理を行う。このように、ステップＳ３０１からＳ３０５の処理を繰り返すことで、ワーク１００の検査と並行して教示データを補正することができる。また、これらの処理はオンラインで即座に実行されるので安定した検査が行われる。

ワーク１００の検査前に教示データを補正する場合、教示データの補正が完了した状態でロボット１０を制御できるため、ワーク１００を素早く移動させた場合であっても衝突が生じる可能性が低い。これに対し、ワーク１００の検査と並行して教示データを補正する場合、事前の計測作業が不要となる。このように、これらの処理は長所が異なるため、どちらのタイミングで教示データを補正するかは、計測に掛かる時間、計測装置の構成、要求される仕様等に基づいて決定することが好ましい。

次に、ワーク１００の計測方法及び教示データの補正方法について複数の例を挙げて説明する。なお、以下で説明する処理は、基本的には、ワーク１００の検査前に予め教示データを補正する方法、ワーク１００の検査と並行して教示データを補正する方法の何れにも適用可能である。また、以下で説明する補正方法は、全てのワーク１００に対して行ってもよいし、ロットが変更された場合の最初のワーク１００に対して行ってもよいし、同じ形状のワーク１００に対して１回のみ行ってもよい。

初めに、図７を参照して、ワーク１００の端部の１点のみを計測して教示データを補正する処理を説明する。

第１実施形態では、検査対象がワーク１００の端部であるため、ワーク１００の端部の位置が重要である。また、エンドエフェクタ１３がワーク１００の中央を把持する場合であって、ワーク１００の厚み等が一様であれば、ワーク１００の端部の変形量（３次元データのワーク１００との差異）は大きくは異ならないと考えられる。以上を考慮し、図７の補正方法では、図７（ａ）に示すように、レーザセンサ等の距離センサ７１により計測を行うことで、距離センサ７１からワーク１００の端部までの距離が１点計測される。ここで、教示装置３０は、距離センサ７１と３次元データ上のワーク１００の端部の形状及び位置を把握しているため、距離センサ７１の計測結果に基づいて、ワーク１００の端部の鉛直方向下方への変形量ΔＺを算出することができる。

また、教示装置３０は、変形量ΔＺの影響を打ち消すために、図７（ｂ）に示すように、全ての教示点のｚ方向の値をΔＺ変化させる。なお、教示点の値を変更する処理に代えて、教示点の座標のｚ軸の基準点をΔＺ変化させてもよい。教示点の値の変更及び教示点の座標の変更の何れが補正された場合であっても、この補正が行われた後の教示点を補正教示点と称する。また、補正教示点を含む教示データを補正教示データと称する。

図７の補正方法は、ワーク１００の１点を計測するだけで全ての教示点を補正することができるので、計測及び教示データの補正に必要な時間を短くすることができる。

なお、図７の補正方法を応用して、ワーク１００の端部が４辺である場合、第１辺から第４辺について１回ずつ鉛直方向の変形量を計測し、ワーク１００の第１辺を検査する場合の教示点を第１辺の計測結果に応じて補正し、第２辺を検査する場合の教示点を第２辺の計測結果に応じて補正する等の処理を行うこともできる。

次に、図８を参照して、ワーク１００の端部の３点以上を計測して教示データを補正する処理を説明する。

図８の補正方法では、図８（ａ）及び図８（ｂ）に示すように、ワーク１００の端部のうち、３点の鉛直方向の位置が計測されることで、鉛直方向の変形量が計測される。計測方法としては、図８（ａ）に示すように距離センサ７１を固定してワーク１００を移動させる構成であってもよいし、ワーク１００に対して距離センサ７１を移動させる構成であってもよいし、複数の距離センサ７１でそれぞれの位置を計測する構成であってもよい。

また、教示装置３０は、３点の鉛直方向の変形量に基づいて、ワーク１００の端部の鉛直方向の変形量と、２つの回転角と、を算出する。これに基づいて、図８（ｃ）に示すように、各教示点の鉛直方向の変形量（Ｚｉ）、２つの回転角（αｉ、βｉ）を補正する。

また、水平方向の変位については、距離センサ７１に加え、図２及び図９（ｂ）に示す水平形状センサ７２を用いることで計測することができる。水平形状センサ７２は、鉛直方向の一側に平行光を照射する投光部が配置され、鉛直方向の他側に平行光を受光する受光部が配置されている。投光部と受光部の間にワーク１００が位置した場合、ワーク１００が存在する範囲においては受光部が平行光を受光しない。この構成により、ワーク１００の形状（特に鉛直方向の一側から見た形状である水平形状）を計測できる。

距離センサ７１に加えて水平形状センサ７２によりワーク１００の計測を行うことで、ワーク１００の実際の形状を詳細に検出することができる。例えば、ワーク１００の検査前に予め教示データを補正する場合は、距離センサ７１及び水平形状センサ７２の計測結果から得られる差異データを用いて補正教示データを作成することで、ワーク１００の端部が適切に検査されるようにワーク１００を動かすことができる。この場合、図９（ｄ）に示すように、教示データの水平方向ＸをΔＸ変化させる。

また、ワーク１００の検査と並行して教示データを補正する場合は、端部検査装置４０の近傍に距離センサ７１及び水平形状センサ７２を配置することが好ましい。この場合、初めは補正前の教示データを用いてロボット１０を動作させつつワーク１００の計測を行い、距離センサ７１及び水平形状センサ７２の計測結果に基づいてワーク１００の端部の位置が適切な位置から外れそうになった場合は、それを補正するための補正教示データを作成して制御装置２０がロボット１０を制御することで、ワーク１００の端部が適切に検査されるようにワーク１００を動かすことができる。

以上のようにして教示データの補正を行うことで、従来は人が行うことを余儀なくされていた検査をロボット１０に行わせることができるので、検査の精度及び信頼性を高めたることができる。また、撓み等による変形が生じたワーク１００に対しても教示データを自動的に作成するソフトウェアを利用できるため、教示作業に掛かる時間を低減できる。また、人が作業を行った場合と異なり、作業の結果をデータとして残すことができる。従って、これらの検査結果を統計的に処理することで、ワーク１００の品質を管理できる。検査システムの管理者は、例えば、ワーク１００の品質が他と比べて低いロットがあった場合に、ワーク１００の品質が低くなった原因を特定し、必要に応じて改善することができる。

次に、第２実施形態について図１０から図１３を参照して説明する。なお、以降の説明においては、前述の実施形態と同一又は類似の部材には図面に同一の符号を付し、説明を省略する場合がある。

第１実施形態では、ロボット１０がワーク１００を保持して移動させるが、第２実施形態では、ワーク１００を作業台１１０に置いて作業を行う。この場合においても、図１１に示すように、ワーク１００が作業台１１０から自重の垂直抗力を受けることで、ワーク１００に撓みが生じる。また、上述の内部歪みによる変形も生じることがある。

また、第２実施形態では、ロボット１０に主表面検査装置（検査装置）５０が設けられている。主表面検査装置５０はカメラ等の撮像装置であり、主表面検査装置５０が撮像した画像を解析することでワーク１００の主表面１０１に生じている表面欠陥の有無及び程度等を検査できる。

ロボット１０は、置かれているワーク１００と主表面検査装置５０の距離が一定となるように、かつ、ワーク１００と主表面検査装置５０が垂直となるように多関節アーム１２を動作させつつ、ワーク１００の表面に沿って主表面検査装置５０を移動させることで検査を行う。これにより、ワーク１００の主表面１０１の全体の表面欠陥を検査できる。なお、ワーク１００の主表面１０１の一部のみの検査を行う構成であってもよい。

ここで、ワーク１００に対する主表面検査装置５０の位置又は向きが変化した場合、主表面検査装置５０のカメラの焦点がズレたり、撮像される画像の大きさが変化したりするため、適切な検査を行うことができない。従って、第１実施形態と同様、教示データを補正する必要がある。

第２実施形態では、ワーク１００の形状を計測する距離センサ７１がロボット１０に設けられている。第２実施形態では、基本的にはワーク１００の検査と並行してワーク１００の計測及び教示データの補正を行う。ただし、事前にワーク１００の形状を計測して事前に教示データを補正する構成であってもよい。

図１１に示す例では、ロボット１０（エンドエフェクタ１３）に主表面検査装置５０と、１つの距離センサ７１と、が設けられている。ワーク１００の検査中において距離センサ７１は、距離センサ７１からワーク１００までの鉛直方向の距離を計測する。教示装置３０は、距離センサ７１と３次元データのワーク１００の鉛直方向の距離を把握しているため、距離センサ７１の計測結果に基づいてワーク１００の鉛直方向の変形量（３次元データのワーク１００との差異）を算出できる。従って、この変形量を打ち消すように教示データを補正することで、ワーク１００から主表面検査装置５０までの距離を一定に保ちつつ、ワーク１００の主表面１０１の表面欠陥を検査できる。

特に、本実施形態では、主表面検査装置５０（エンドエフェクタ１３）の移動方向が定められており、この移動方向の前側に距離センサ７１が配置され、その後側に主表面検査装置５０が配置されている。そのため、距離センサ７１がある点の計測を行った後に、主表面検査装置５０がこの点を検査するため、主表面検査装置５０とワーク１００の距離をより精度良く一定に保つことができる。

図１２及び図１３（ａ）に示す例では、主表面検査装置５０の周りに等間隔で３つの距離センサ７１がロボット１０に設けられている。この場合、主表面検査装置５０からワーク１００までの距離だけでなく、ワーク１００の傾きについても算出することができる。従って、３次元データのワーク１００と実際のワーク１００の高さ方向の差異及び傾きの差異を算出できる。教示装置３０がこれらの差異に基づいて教示データを補正することで、図１２に示すように、主表面検査装置５０からワーク１００までの距離だけでなく、ワーク１００に対する主表面検査装置５０の傾きについても補正できる。従って、より適切な検査を行うことができる。

ここで、ワーク１００の主表面１０１の縁部近傍を計測する場合、図１３（ａ）に示すように、距離センサ７１がワーク１００の外側に位置するため、ワーク１００の傾きを計測できないため、主表面検査装置５０の傾きを補正することができない。

そのため、主表面１０１の縁部近傍において主表面検査装置５０の傾きの補正が必要である場合は、図１３（ｂ）に示すように、更に多く（例えば主表面検査装置５０の周りに等間隔で６つ）の距離センサ７１を設ければよい。これにより、主表面検査装置５０がワーク１００のどの点を検査する場合であっても、３つ以上の距離センサ７１がワーク１００を計測できるため、主表面検査装置５０の傾きを補正することができる。

また、第１実施形態及び第２実施形態では、ワーク１００の表面欠陥を検査する構成であるが、ワーク１００の厚みを検査する場合は、例えばレーザセンサを用いることができる。レーザセンサは、ワーク１００にレーザを照射し、ワーク１００の上側の主表面１０１で反射した反射光と、ワーク１００の下側の主表面１０１で反射した反射光と、を受光素子で観測することでワーク１００の厚みを計測する。この種のレーザセンサでは、レーザセンサからワーク１００までの距離を一定にすること、及び、レーザセンサとワーク１００の向きを揃えることが適切な検査結果を得る上で好ましい。従って、撓みが生じたワーク１００の形状に沿って検査を行うことが要求されるので、上記実施形態の方法を有効に活用できる。

以上に説明したように、上記実施形態のロボットシステム１は、検査装置（端部検査装置４０又は主表面検査装置５０）と、ロボット１０と、計測装置（距離センサ７１、水平形状センサ７２）と、教示データ記憶部２２と、差異データ算出部３３と、教示データ補正部３４と、動作制御部２１と、を備える。また、制御装置２０がロボット１０を制御することでロボット制御方法が行われる。検査装置は、ワーク１００の厚み及び表面欠陥の少なくとも一方の検査を行う。ロボット１０は、（ワーク１００又は検査装置の少なくとも一方の位置を変化させることで）検査装置に対するワーク１００の相対位置を変化させる。計測装置は、ワーク１００の少なくとも一部の形状を計測する（計測結果取得工程）。教示データ記憶部２２は、ワーク１００の３次元データに基づいて設定された教示点を記憶する。差異データ算出部３３は、ワーク１００の自重による撓み及びワーク１００の内部歪みの少なくとも一方に起因する形状の差異を示す差異データを、計測装置の計測結果とワーク１００の３次元データとを比較することで算出する（差異データ算出工程）。教示データ補正部３４は、教示点を、差異データに基づいて補正した補正教示点を算出する（補正教示点算出工程）。動作制御部２１は、補正教示点に基づいてロボット１０を動作させることで検査装置によるワーク１００の検査を行わせる（動作制御工程）。

これにより、ワーク１００の３次元データと実際の形状との差異に基づいて教示点を補正できるので、撓みが生じたワーク１００の形状に応じた適切な検査をロボット１０に行わせることができる。

また、上記実施形態のロボットシステム１では、検査装置によるワーク１００の検査と並行して、差異データ算出部３３による差異データの算出及び教示データ補正部３４による補正教示点の算出が行われる。

これにより、検査を行いながら教示点を補正できるので、検査前に行う作業を減らすことができる。

また、上記実施形態のロボットシステム１では、差異データ算出部３３による差異データの算出及び教示データ補正部３４による補正教示点の算出が行われた後に、検査装置によるワーク１００の検査が行われる。

これにより、事前にワーク１００の形状に基づいて教示点が補正されるので、ワーク１００又は検査装置を素早く動かして検査を行うことができる。

また、上記実施形態のロボットシステム１では、ロボット１０がワーク１００を保持して移動させることで、当該ワーク１００の端部が検査装置により検査される。計測装置は、ワーク１００の端部の鉛直方向の位置を計測する。

これにより、ロボット１０がワーク１００を保持して検査装置に対して移動させる場合において、撓み等が生じたワーク１００の形状に応じた適切な検査を行わせることができる。

また、上記実施形態のロボットシステム１では、計測装置は、ワーク１００の端部の少なくとも１点の鉛直方向の位置を計測する。差異データ算出部３３は、計測装置の計測結果に基づいて、ワーク１００の端部のうち、計測された部分だけでなく、計測されていない部分についても差異データを算出する。

これにより、高い精度が要求されない場合は、計測に掛かる時間を短くしつつ、撓み等が生じたワーク１００の形状に応じた適切な検査を行わせることができる。

また、上記実施形態のロボットシステム１では、計測装置は、ワーク１００の端部の少なくとも３点の鉛直方向の位置を計測する。差異データ算出部３３は、計測装置の計測結果に基づいて、鉛直方向の形状だけでなく、ワーク１００の向きについても差異データを算出する。

これにより、ワーク１００の向きを考慮した検査を行う場合において、撓み等が生じたワーク１００の形状に応じた適切な検査を行わせることができる。

また、上記実施形態のロボットシステム１では、検査装置及び計測装置がロボット１０に取り付けられている。計測装置は、ワーク１００までの距離を計測する。ロボット１０は、作業台１１０にワーク１００を置いた状態で当該ワーク１００に対して計測及び検査を行う。

これにより、必要な機能をロボット１０に集約できるので構成をシンプルにすることができる。また、ワーク１００を把持して移動させることが困難な場合であっても、撓み等が生じたワーク１００の形状に応じた適切な検査を行わせることができる。

また、上記実施形態のロボットシステム１では、ロボット１０の移動方向において、検査装置よりも前側に計測装置が取り付けられている。計測装置による計測が行われた位置において、差異データ及び補正教示点が算出されて当該補正教示点に基づいてワーク１００に対するロボット１０の高さが調整された状態で、検査装置による検査が行われる。

これにより、計測を行って補正教示点を算出した後に検査を行うことができる。

また、上記実施形態のロボットシステム１では、ロボット１０には、３つ以上の計測装置が取り付けられている。計測装置の計測結果に基づいて、差異データ及び補正教示点が算出されることで、ワーク１００に対するロボット１０の高さだけでなく、ワーク１００に対するロボット１０の向きについても調整された状態で、検査装置によるワーク１００の該当位置の検査が行われる。

これにより、ワーク１００の向きを考慮した検査を行う場合において、撓み等が生じたワーク１００の形状に応じた適切な検査を行わせることができる。

また、上記実施形態のロボットシステム１では、ワーク１００がガラス板である。

これにより、撓みが生じ易く、用途によっては厚み及び表面欠陥等の影響が大きいガラス板に対して、ロボット１０による検査作業を行うことができる。

以上に本発明の好適な実施の形態を説明したが、上記の構成は例えば以下のように変更することができる。

上記実施形態では、水平形状センサ７２を用いてワーク１００の上面視での形状を計測する構成であるが、水平形状センサ７２に代えて、距離センサ７１と同様の反射型レーザ変位センサを用いて距離センサ７１とワーク１００の水平方向における距離を計測する構成であってもよい。

上記実施形態では、教示装置３０はワーク１００の３次元データを読み込む構成であるが、教示装置３０が実行するアプリケーション上で３次元データが作成される構成であってもよい。

上述した検査装置は一例であり、例えば端部検査装置４０は、３つではなく２つ以下又は４つ以上のＣＣＤによりワーク１００の端部の画像を撮像する構成であってもよい。

１ ロボットシステム
１０ ロボット
２０ 制御装置
２１ 動作制御部
２２ 教示データ記憶部
３０ 教示装置
４０ 端部検査装置（検査装置）
５０ 主表面検査装置（検査装置）
６０ 検査システム管理装置
７１ 距離センサ（計測装置）
７２ 水平形状センサ（計測装置）

Claims (12)

1. ワークの厚み及び表面欠陥の少なくとも一方の検査を行う検査装置と、
   前記検査装置に対する前記ワークの相対位置を変化させるロボットと、
   前記ワークの少なくとも一部の形状を計測する計測装置と、
   前記ワークの３次元データに基づいて設定された教示点を記憶する教示データ記憶部と、
   前記ワークの自重による撓み及び前記ワークの内部歪みの少なくとも一方に起因する形状の差異を示す差異データを、前記計測装置の計測結果と前記ワークの３次元データとを比較することで算出する差異データ算出部と、
   前記教示点を、前記差異データに基づいて補正した補正教示点を算出する教示データ補正部と、
   前記補正教示点に基づいて前記ロボットを動作させることで前記検査装置による前記ワークの検査を行わせる動作制御部と、
   を備え、
   前記ロボットが前記ワークを保持して移動させることで、当該ワークの端部が前記検査装置により検査され、
   前記計測装置は、前記ワークの端部の鉛直方向の位置を計測することを特徴とするロボットシステム。
2. 請求項１に記載のロボットシステムであって、
   前記計測装置は、前記ワークの端部の少なくとも１点の鉛直方向の位置を計測し、
   前記差異データ算出部は、前記計測装置の計測結果に基づいて、前記ワークの端部のうち、計測された部分だけでなく、計測されていない部分についても前記差異データを算出することを特徴とするロボットシステム。
3. 請求項１に記載のロボットシステムであって、
   前記計測装置は、前記ワークの端部の少なくとも３点の鉛直方向の位置を計測し、
   前記差異データ算出部は、前記計測装置の計測結果に基づいて、鉛直方向の形状だけでなく、前記ワークの向きについても前記差異データを算出することを特徴とするロボットシステム。
4. ワークの厚み及び表面欠陥の少なくとも一方の検査を行う検査装置と、
   前記検査装置に対する前記ワークの相対位置を変化させるロボットと、
   前記ワークの少なくとも一部の形状を計測する計測装置と、
   前記ワークの３次元データに基づいて設定された教示点を記憶する教示データ記憶部と、
   前記ワークの自重による撓み及び前記ワークの内部歪みの少なくとも一方に起因する形状の差異を示す差異データを、前記計測装置の計測結果と前記ワークの３次元データとを比較することで算出する差異データ算出部と、
   前記教示点を、前記差異データに基づいて補正した補正教示点を算出する教示データ補正部と、
   前記補正教示点に基づいて前記ロボットを動作させることで前記検査装置による前記ワークの検査を行わせる動作制御部と、
   を備え、
   前記検査装置及び前記計測装置が前記ロボットに取り付けられており、
   前記ロボットは、作業台に前記ワークを置いた状態で当該ワークに対して計測及び検査を行うことを特徴とするロボットシステム。
5. 請求項４に記載のロボットシステムであって、
   前記計測装置は、前記ワークまでの距離を計測することを特徴とするロボットシステム。
6. 請求項５に記載のロボットシステムであって、
   前記ロボットの移動方向において、前記検査装置よりも前側に前記計測装置が取り付けられており、
   前記計測装置による計測が行われた位置において、前記差異データ及び前記補正教示点が算出されて当該補正教示点に基づいて前記ワークに対する前記ロボットの高さが調整された状態で、前記検査装置による検査が行われることを特徴とするロボットシステム。
7. 請求項５に記載のロボットシステムであって、
   前記ロボットには、３つ以上の前記計測装置が取り付けられており、
   前記計測装置の計測結果に基づいて、前記差異データ及び前記補正教示点が算出されることで、前記ワークに対する前記ロボットの高さだけでなく、前記ワークに対する前記ロボットの向きについても調整された状態で、前記検査装置による前記ワークの該当位置の検査が行われることを特徴とするロボットシステム。
8. 請求項１から７までの何れか一項に記載のロボットシステムであって、
   前記検査装置による前記ワークの検査と並行して、前記差異データ算出部による前記差異データの算出及び前記教示データ補正部による前記補正教示点の算出を行うことを特徴とするロボットシステム。
9. 請求項１から７までの何れか一項に記載のロボットシステムであって、
   前記差異データ算出部による前記差異データの算出及び前記教示データ補正部による前記補正教示点の算出が行われた後に、前記検査装置による前記ワークの検査が行われることを特徴とするロボットシステム。
10. 請求項１から９までの何れか一項に記載のロボットシステムであって、
    前記ワークがガラス板であることを特徴とするロボットシステム。
11. ワークの厚み及び表面欠陥の少なくとも一方の検査を行う検査装置に対して前記ワークを相対移動させることで前記ワークの検査を補助するロボットを制御するロボット制御方法において、
    前記ワークの少なくとも一部の形状を計測装置で計測して計測結果を取得する計測結果取得工程と、
    前記ワークの自重による撓み及び前記ワークの内部歪みの少なくとも一方に起因する形状の差異を示す差異データを、前記計測結果取得工程での計測結果と前記ワークの３次元データとを比較することで算出する差異データ算出工程と、
    前記ワークの３次元データに基づいて設定された教示点を、前記差異データに基づいて補正した補正教示点を算出する補正教示点算出工程と、
    前記補正教示点に基づいて前記ロボットを動作させることで前記検査装置による前記ワークの検査を行わせる動作制御工程と、
    を含み、
    前記ロボットが前記ワークを保持して移動させることで、当該ワークの端部が前記検査装置により検査され、
    前記計測装置は、前記ワークの端部の鉛直方向の位置を計測することを特徴とするロボット制御方法。
12. ワークの厚み及び表面欠陥の少なくとも一方の検査を行う検査装置に対して前記ワークを相対移動させることで前記ワークの検査を補助するロボットを制御するロボット制御方法において、
    前記ワークの少なくとも一部の形状を計測装置で計測して計測結果を取得する計測結果取得工程と、
    前記ワークの自重による撓み及び前記ワークの内部歪みの少なくとも一方に起因する形状の差異を示す差異データを、前記計測結果取得工程での計測結果と前記ワークの３次元データとを比較することで算出する差異データ算出工程と、
    前記ワークの３次元データに基づいて設定された教示点を、前記差異データに基づいて補正した補正教示点を算出する補正教示点算出工程と、
    前記補正教示点に基づいて前記ロボットを動作させることで前記検査装置による前記ワークの検査を行わせる動作制御工程と、
    を含み、
    前記検査装置及び前記計測装置が前記ロボットに取り付けられており、
    前記ロボットは、作業台に前記ワークを置いた状態で当該ワークに対して計測及び検査を行うことを特徴とするロボット制御方法。

Images