JP7366264B2 - ロボット教示方法及びロボット作業方法 - Google Patents

Description

本発明は、主として、産業用のロボットを教示する方法に関する。

産業用のロボットを教示する方法としては、操作装置を用いてロボットを教示点まで実際に動作させた後に、ロボットの位置及び姿勢に関するデータ（内界センサの検出値）を登録する方法が知られている。

また、特許文献１は、ビジュアルサーボを用いて産業用のロボットに作業を行わせる方法を開示する。ビジュアルサーボとは、ロボットにカメラを装着して、作業中にカメラが撮影した画像が予め登録された教示画像に一致するようにロボットを動作させる制御である。つまり、ビジュアルサーボを行う場合は、カメラを用いて作業場及びワークを撮影することで、ロボットの教示が行われる。

特開２０１３－１５８８４７号公報

ここで、ロボットを実際に動作させて教示する方法では、操作装置を用いてロボットを操作する必要があるので、熟練が必要になる。また、ビジュアルサーボを用いる場合は、作業時にロボットをどのように動作させれば教示画像に近づくかを簡単に特定できない。

本発明は以上の事情に鑑みてされたものであり、その主要な目的は、簡単な方法で有用な教示情報を登録するロボット教示方法を提供することにある。

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

本発明の観点によれば、産業用のロボットを教示する以下のロボット教示方法が提供される。ロボット教示方法は、事前登録工程と、ロボット動作工程と、教示工程と、を含む。前記事前登録工程では、計測装置を用いて周囲環境を計測することにより前記周囲環境に対する前記計測装置の相対的な自己位置を特定し、前記周囲環境に対する相対的な自己位置を用いて特定された前記ロボットの教示点である環境教示点を登録する。前記ロボット動作工程では、前記計測装置を前記ロボットに装着した状態で、前記計測装置による周囲環境の計測結果に基づいて、前記周囲環境に対する前記ロボットの相対的な自己位置が前記環境教示点に一致するように前記ロボットを自動動作させる。前記教示工程では、前記周囲環境に対する前記ロボットの相対的な自己位置が前記環境教示点に一致した状態において、センサを用いて検出された前記ロボットの位置及び姿勢の検出値を教示情報として登録する。

これにより、作業者が環境教示点を指定する作業を行うだけでロボットを教示できるので、作業者がロボットを実際に動作させる教示方法と比較して、簡単な方法でロボットを教示できる。また、ビジュアルサーボの教示情報は画像であるのに対し、本発明で登録される教示情報はセンサの検出値であるため、ロボットの位置及び姿勢を適切に把握できる。

本発明によれば、簡単な方法で有用な教示情報を登録するロボット教示方法を実現できる。

ロボットシステムの構成図。 ロボット教示方法の工程図。 環境地図作成工程の説明図。 事前登録工程の説明図。 ロボット動作工程の説明図。 計測装置をロボットに装着せずに作業を行う際のフローチャート。 計測装置をロボットに装着して作業を行う際のフローチャート。 情報端末に仮想補助画像を表示する様子を示す説明図。 情報端末にＡＲ補助画像を表示する様子を示す説明図。

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

ロボットシステム１は、工場等の施設に配置されている。ロボットシステム１は、ロボット１０に作業を行わせるためのシステムである。図１に示すように、ロボットシステム１は、ロボット１０と、制御装置２０と、計測ユニット３０と、を備える。それぞれの装置は、有線又は無線のネットワークを介して互いに接続されている。図１には、ロボット１０と制御装置２０が１組しか記載されていないが、ロボットシステム１が複数組のロボット１０と制御装置２０を備える構成であってもよい。

ロボット１０は、産業用ロボットである。ロボット１０が行う作業は、例えば、組立て、溶接、塗装、洗浄等である。ロボット１０は、ティーチングプレイバック型である。ティーチングアンドプレイバック型とは、作業者によってロボット１０の動作及び作業が手動等で予め教示されており、教示された動作及び作業をロボット１０が繰り返し行うように運用されるタイプである。なお、ロボット１０は、ティーチングプレイバック型以外であってもよい。

ロボット１０は、台座に取り付けられたアーム１１を備える。アーム１１は、複数の関節を有しており、各関節にはアクチュエータが備えられている。ロボット１０は、外部から入力された動作指令に応じてアクチュエータを動作させることでアーム１１の位置及び姿勢を変化させる。それぞれの関節には、内界センサ１２が配置されている。内界センサ１２は、ロボット１０に取り付けられているとともに、ロボット１０の位置及び姿勢を検出するセンサである。具体的には、内界センサ１２は、アーム１１の各関節の回転角度又は角速度を検出する。内界センサ１２は、エンコーダと称されることもある。アーム１１の先端には、作業内容に応じたエンドエフェクタ１３が取り付けられている。ロボット１０は、外部から入力された動作指令に応じてエンドエフェクタ１３を動作させることで作業を行う。なお、内界センサ１２の検出値に基づいて、エンドエフェクタ１３の位置及び向き（向き）を特定できる。また、アーム１１には、計測ユニット３０を取り付けるための取付構造（例えば取付孔等）が設けられている。この取付構造は、エンドエフェクタ１３の近傍、言い換えればロボット１０の最も先端側（エンドエフェクタ１３側）の関節よりも更に先端側に設けられている。言い換えれば、この取付構造は、エンドエフェクタ１３と一体的に移動及び回転する位置に取り付けられている。なお、計測ユニット３０の取付構造は、ロボット１０の先端に限られず、ロボット１０の先端（エンドエフェクタ１３）との位置関係が特定できるのであれば、あらゆる位置に取り付けられていてもよい。

制御装置２０は、公知のコンピュータにより構成されており、演算装置（ＣＰＵ等）と記憶装置（例えばフラッシュメモリ又はＨＤＤ等）を備える。記憶装置に記憶されたプログラムを演算装置が読み出して実行することで、制御装置２０は様々な手段として機能する。例えば、制御装置２０は、ロボット１０の動作指令を作成してロボット１０に送信することで、ロボット１０を動作させる。ロボット１０の動作指令には、アーム１１の各関節に配置されたアクチュエータを動作させる指令と、エンドエフェクタ１３を動作させる指令と、が含まれる。

計測ユニット３０は、主としてロボット１０の教示に用いる装置である。計測ユニット３０は、教示を行う作業者（以下、単に作業者）が手で持って操作可能であるとともに、ロボット１０に着脱可能である。計測ユニット３０は、計測装置３１と、処理装置３２と、ポインタ３３と、を備える。計測装置３１、処理装置３２、及びポインタ３３は同一のハウジング等に固定されており、作業者が一体的に取り扱うことができる。ただし、計測装置３１と処理装置３２が無線通信可能である場合、計測装置３１から離れた位置に処理装置３２を設けてもよい。つまり、本実施形態の計測ユニット３０は、計測装置３１と処理装置３２を一体的に有するスタンドアロン構成であるが、処理装置３２を外部の装置とした構成であってもよい。また、本実施形態の計測ユニット３０は、ロボット１０の教示を行うための専用品であるが、スマートフォン等のような汎用の情報処理端末であってもよい。この場合、スマートフォンに設けられたカメラが計測装置３１に相当し、スマートフォンに設けられたＳＯＣが処理装置３２に相当し、スマートフォンに取り付けたポインタ（棒状の物体又はレーザポインタ）がポインタ３３に相当する。

計測装置３１は、計測装置３１の周囲にある物体の位置及び形状（周囲環境）を計測して、周囲環境を示す周囲環境データを検出する。計測装置３１は、所定の時間間隔で周囲環境データを検出する。本実施形態の計測装置３１は、ステレオカメラである。ステレオカメラは、互いに適宜の距離だけ離して配置された１対の撮像素子（例えばＣＣＤ）を備える。それぞれの撮像素子は、撮像を行って画像を取得する。それぞれの撮像素子で取得された画像を比較することで、取得した画像に含まれる物体等の位置を算出できる。また、計測装置３１は、ＬｉＤＡＲ（Ｌａｓｅｒ Ｉｍａｇｉｎｇ Ｄｅｔｅｃｔｉоｎ ａｎｄ Ｒａｎｇｉｎｇ）であってもよい。ＬｉＤＡＲは、電波を照射するとともに、当該電波の反射波を受信するまでの時間を計測することで、周囲の物体等の位置及び形状を取得する３次元計測センサの一種である。なお、計測装置３１は、ステレオカメラ及びＬｉＤＡＲに限られず、単眼カメラ又はＴｏＦ（Ｔｉｍｅ ｏｆ Ｆｌｉｇｈｔ）カメラであってもよい。

処理装置３２は、計測装置３１が取得した周囲環境データを処理する。処理装置３２は上述のような演算装置と記憶装置を備える。処理装置３２は、周囲環境データにＳＬＡＭ（Ｓｉｍｕｌｔａｎｅｏｕｓ Ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ Ｍａｐｐｉｎｇ）処理を行う。ＳＬＡＭ処理は周知であるので簡単に説明すると、計測装置３１が取得した周囲環境データから特徴点を抽出し、複数の周囲環境データの間での特徴点の移動量を分析することで、計測装置３１の位置及び姿勢の変化を取得するとともに、特徴点の位置に基づいて環境地図を作成する。環境地図とは、計測装置３１の周囲（本実施形態ではロボット１０が作業を行う場所である作業場）に配置された設備、機器、及びワーク等の３次元位置と３次元形状を示すデータである。なお、計測ユニット３０に処理装置３２を取り付けずに、計測ユニット３０から離れた位置に処理装置３２を配置してもよい。

ポインタ３３は、作業者がロボット１０の教示点を指定する作業を行い易くするための部材である。ポインタ３３は棒状であるため、教示点を指定する作業が正確になる。また、ポインタ３３は計測装置３１よりも前方に突出しているため、教示点を指定する作業を簡単に行うことができる。計測ユニット３０は、ポインタ３３が教示点を指し示している状態における環境地図の自己位置を取得することを目的としている。従って、計測装置３１とポインタ３３は、相対位置が定まっている。なお、ポインタ３３は計測ユニット３０に着脱可能であってもよい。棒状のポインタ３３は、棒状の部材で指し示す構成に限られず、例えばレーザを照射することで特定の位置又は方向を指し示す構成であってもよい。

次に、図２から図５を参照して、本実施形態のロボット教示方法について説明する。図２は、ロボット教示方法の工程図である。図３から図５は、ロボット教示方法の各工程の説明図である。

初めに、図３に示すように、計測ユニット３０を用いて作業場の環境地図を作成する（Ｓ１０１、準備工程）。具体的には、作業者が計測ユニット３０を手で持ち、計測ユニット３０の位置及び向きを変化させて作業場の周囲環境データを検出し、それらに対して処理装置３２がＳＬＡＭ処理を行うことにより、作業場の環境地図が作成される。また、ワーク４０を含む環境地図を作成するために、ワーク４０を作業時の位置に配置した状態で準備工程を行う必要がある。なお、作業者に代えてロボット１０が計測ユニット３０を動かしてもよい。具体的には、ロボット１０に計測ユニット３０を装着した後に、予め定められた軌跡を描くようにロボット１０を動作させることで、作業場の環境地図を作成することもできる。

次に、図４に示すように、環境地図上の環境教示点を登録する（Ｓ１０２、事前登録工程）。環境教示点とは、作業場におけるロボット１０の周囲の環境（以下、周囲環境）に対する相対的な自己位置を用いて特定されたロボット１０の教示点である。本実施形態では、環境教示点は、環境地図の座標系で記述される。つまり、本実施形態では、「周囲環境に対する相対的な自己位置」の一例として、環境地図上の座標値が用いられる。また、環境教示点は、３次元位置だけでなく向き（例えば３軸回りの回転角度）を含む概念である。環境教示点の登録とは、例えば計測ユニット３０又は制御装置２０の記憶部に、環境教示点（環境地図の座標値）を記憶することである。

本実施形態では、環境教示点を実空間で指定する。具体的には、図４に示すように、作業者は計測ユニット３０を手で持って、教示点として登録したい位置まで計測ユニット３０を移動させる。このとき、作業者は、ポインタ３３の位置及び向きを見ながら、計測ユニット３０を移動させる。ポインタ３３とエンドエフェクタ１３の位置関係は予め定められている。例えば、ポインタ３３の先端の位置とエンドエフェクタ１３の先端の位置が対応すると定めてもよいし、エンドエフェクタ１３の先端から所定距離だけオフセットした位置（例えば５ｃｍ下）がエンドエフェクタ１３の先端に対応すると定めてもよい。そして、作業者は、この位置関係を考慮しながら計測ユニット３０を適切な位置に合わせる。その後、作業者が計測ユニット３０の図略の操作部を操作することで、その状態における環境地図上の自己位置が取得される。ここで、計測ユニット３０をロボット１０に装着した状態のポインタ３３とエンドエフェクタ１３の位置関係と、上記で定めたポインタ３３とエンドエフェクタ１３の位置関係と、が一致する場合は、ここで取得された自己位置が環境教示点として登録される。なお、これらの位置関係が相違する場合は、上記で取得した自己位置に、この相違を解消する補正値を足し合わせることで算出された座標値が環境教示点として登録される。

また、環境教示点は環境地図を表示して指定することもできる。この場合、制御装置２０は、所定のディスプレイ（制御装置２０が備えるディスプレイ、又は、作業者が所有する情報端末のディスプレイ等）に環境地図を表示して、作業者による環境教示点の入力を受け付ける。作業者は、環境地図を確認しながら、環境地図上で例えば環境教示点をクリックするか、又は、環境座標の座標値を入力すること等により、環境教示点を指定する。このようにして指定された環境教示点が登録される。環境地図はＳＬＡＭ処理により作成されるので、作業場及びロボット１０の３次元モデルが必須では無いため、作業者の手間を削減できる可能性がある。また、取得した環境地図は作業者が編集することができる。環境地図に対して特定の領域を作業者が指定することでその領域内の情報を無効にしたり、その領域を自己位置の推定に優先的に使用させることができる。なお、環境地図上にマーカを設置することで、特定領域を指定してもよい。

また、環境地図の作成は必須ではない。つまり、周囲環境に対する自己位置が特定できれば当該自己位置を環境教示点として用いることができるため、環境地図を用いることなく環境教示点を指定することができる。この場合、準備工程を省略することもできる。具体的には、本実施形態の計測装置３１を用いることで、周囲環境を計測できるため、周囲環境に対する自己位置を特定できる。なお、自己位置を特定する精度を高くするために、周囲に配置された物体に関する情報を予め登録しておいたり、周囲にマーカ等を配置しておくことが更に好ましい。

また、本実施形態では、作業者が計測ユニット３０を教示点に合わせるまでに計測装置３１が取得した画像は、制御装置２０又は外部サーバ等に記憶される。この種の画像には、作業者がどのような点を考慮して教示点を定めたかという意図が表れていることがある。従って、教示が完了した後にこの画像を削除せずに、教示後少なくとも一定期間は保存しておくことで、後から教示の意図を確認できる。なお、動画は時間間隔で取得した画像を並べたものであるため、「画像の保存」等という表現には、動画を保存等することも含まれる。

次に、計測ユニット３０をロボット１０に装着させた状態で、計測ユニット３０の自己位置が環境教示点に一致するようにロボット１０を自動動作させる（Ｓ１０３、ロボット動作工程）。なお、計測ユニット３０はロボット１０に装着されているので、ここでの計測ユニット３０の自己位置はロボット１０の自己位置に含まれる（計測ユニット３０とは異なる点をロボット１０の位置としてもよい）。また、以下の方法でロボット１０を自動動作させることができる。即ち、処理装置３２は、環境地図での現在の自己位置を算出できる（言い換えれば、環境座標での座標値を算出できる）。また、制御装置２０は、内界センサ１２の検出値に基づいて、現在のロボット１０の位置及び姿勢を算出できる（言い換えれば、ロボット座標での座標値を算出できる）。従って、環境座標での座標値と、ロボット座標での座標値と、の対応関係を取得できる。ロボット１０の位置又は姿勢を変化させて環境座標とロボット座標での座標値を取得することにより、この対応関係を複数取得できる。また、環境座標とロボット座標は基本的には一対一に対応する。以上により、複数の対応関係に基づいて、環境座標とロボット座標を変換するための変換行列（変換データ）を作成できる。

これにより、例えば計測ユニット３０が算出した自己位置をロボット座標の座標値に変換できるので、ロボット座標ベースでロボット１０を制御できる。また、変換行列の精度を向上させるために、所定のタイミングで新たな対応関係を取得し、新たな対応関係に基づいて変換行列を更新してもよい。また、環境教示点を変換行列を用いてロボット座標の座標値に変換した値を目標値として用いてもよい。なお、ロボット１０を自動動作させる方法は上記に限られず、例えば環境座標ベースでロボット１０を制御してもよいし、ビジュアルサーボを用いてロボット１０を制御してもよい。

次に、自己位置が環境教示点に一致した状態においてロボット１０の内界センサ１２の検出値を教示情報として登録する（Ｓ１０４、教示工程）。教示情報が登録されるとは、教示情報が制御装置２０に記憶されることである。

なお、本実施形態ではロボット１０の位置及び姿勢は、内界センサ以外のセンサ（例えば、ロボット１０を外部から計測する外部センサ）を用いて検出してもよい。外部センサを用いる場合、外部センサが検出したロボット１０の位置及び姿勢に関する検出値が教示情報となる。なお、外部センサを用いる場合は、外部センサが検出したロボット１０の位置及び姿勢に関する検出値（あるいは目標の検出値と現在の検出値の差分）を、制御装置２０がロボット１０へ出力する動作指令に変換するための情報を登録しておくことが好ましい。

本実施形態の教示方法では、予め環境教示点を登録することにより、ロボット動作工程においてロボット１０を自動動作する。これに対し、従来の一般的な方法では、操作装置を用いてロボットを教示点まで移動させる必要がある。また、操作装置の操作には熟練が必要となる。従って、本実施形態では、この従来の教示方法と比較して、簡単な方法でロボットを教示できる。なお、本実施形態で登録される教示情報は、この従来の教示方法で得られる教示情報と同じである。

上述した教示方法は、教示情報を新たに登録する場合に限られず、既存の教示情報を更新する状況においても活用できる。

次に、上記の方法で登録された教示情報を用いてロボット１０に作業を行わせる方法について図６及び図７を参照して簡単に説明する。

ロボット１０の教示情報は内界センサ１２の検出値であるため、ロボット１０は、計測ユニット３０を装着せずに作業を行うことができる。ただし、一定条件下では、計測ユニット３０を装着して作業を行うことが好ましい場合もある。

初めに、計測ユニット３０を装着せずに作業を行う場合に制御装置２０が行う処理について説明する。制御装置２０は、教示情報が示すロボット座標の座標値と、現在のロボット座標の座標値と、を比較して差分を算出する（図６のＳ２０１）。制御装置２０は、差分が閾値以下か否かを判定する（Ｓ２０２）。制御装置２０は、差分が閾値以下でない場合、この差分が小さくなるようにロボット１０を動作させる（Ｓ２０３）。制御装置２０は、差分が閾値以下である場合、エンドエフェクタ１３を用いた作業を実行させる（Ｓ２０４）。その後、制御装置２０は、ロボット１０を所定の待機位置まで移動させ（Ｓ２０５）、新たなワーク４０に対して再び同じ処理を行う。

計測ユニット３０を装着せずに作業を行うことの利点は、ビジュアルサーボを用いる場合と比較して、ロボットシステム１の導入コストが低いことである。つまり、教示時には計測ユニット３０が必要であるが、作業時には計測ユニット３０は不要である。そのため、複数のロボット１０の教示を１つの計測ユニット３０で行うことにより、計測ユニット３０の必要数が少なくなるからである。

また、同種のロボット１０を複数台導入して、それぞれのロボット１０に同じ作業を行わせる場合、１台のロボット１０の教示時に作成した教示情報を、別のロボット１０に流用することもできる。具体的には、教示を行ったロボット１０を制御する制御装置２０に登録された教示情報を、別のロボット１０を制御する制御装置２０に登録する。これにより、教示の手間を削減できる。また、教示情報ではなく、環境教示点を流用してもよい。この場合、ロボット１０に計測ユニット３０を取り付けて自動動作させる作業（ロボット動作工程）はロボット毎に必要となるが、作業者が計測ユニット３０を用いて環境教示点を登録する作業（事前登録工程）は１回でよい。この方法により、ロボット１０毎の個体差を考慮した教示情報を作成できる。

次に、計測ユニット３０を装着して作業を行う場合に制御装置２０が行う処理について説明する。図７には、計測ユニット３０を装着して作業を行う際の処理が記載されている。なお、ステップＳ２１０以外の処理は、計測ユニット３０を装着せずに作業を行う場合と同じである（つまり、Ｓ２０１～Ｓ２０５の処理は、計測ユニット３０の装着に関係なく共通の処理である）。計測ユニット３０を装着することにより、ワーク４０の位置を検出できる。そのため、例えばワーク４０の位置が既定位置から少しズレていた場合においても、適切な作業を行うことができる。具体的には、制御装置２０は、差分が閾値以下と判定された後に（即ちステップＳ２０２の後に）、ワーク４０に対するエンドエフェクタ１３の位置及び向きが適切になるようにロボットの位置及び姿勢を調整する（Ｓ２１０）。

具体的には、事前に教示工程時（Ｓ１０４）において、自己位置が環境教示点に一致している状態における自己位置に対するワーク４０の相対位置を追加で登録しておく。ワーク４０の相対位置は、ロボット１０（エンドエフェクタ１３）とワーク４０の適切な位置関係を示すものである。そして、ステップＳ２１０では、計測装置３１の計測結果に基づいて、現在の自己位置に対するワーク４０の相対位置を特定する。次に、現在のワーク４０の相対位置と、予め登録したワーク４０の相対位置と、を比較して差分を求め、この差分が小さくなるようにロボット１０を動作させる。これにより、ワーク４０の位置が既定位置から少しズレていた場合においても、適切な作業を行うことができる。なお、ポインタ３３が着脱可能である場合、作業時にはポインタ３３を外してもよい。

次に、本実施形態の応用例について説明する。初めに、図８を参照して、事前登録工程時に仮想補助画像を情報端末５１に表示する応用例について説明する。

仮想補助画像とは、現在の計測ユニット３０の位置及び向きに対応するロボット１０が仮想空間上に配置された画像である。作業者は、仮想補助画像を見ることで、ロボット１０が作業場の他の物体と干渉しているか否かを簡単に確認できる。また、作業者が指示した位置及び向きが実現可能か否か（ロボット１０が指定された姿勢をとることが可能か否か）についても確認できる。また、仮想補助画像は、ロボット１０の特定の姿勢だけでなく、ロボット１０が取ることが可能な姿勢の範囲、言い換えればロボット１０（特にロボット１０のハンド）の実現可能な角度又は位置を示す画像であってもよい。

なお、本実施形態では、作業者が手に持つことが可能な情報端末５１（携帯端末）のディスプレイ（出力装置）に仮想補助画像が表示されるが、例えば作業場に別のディスプレイがあれば、そのディスプレイに仮想補助画像を表示してもよい。また、ディスプレイに限られず、画像を出力可能な様々な機器（例えば、プロジェクタ又はヘッドマウントディスプレイ等）に仮想補助画像を出力してもよい。本実施形態では、情報端末５１が仮想補助画像を作成する処理を行うが、別の装置が仮想補助画像を作成して情報端末５１に送信してもよい。

以下、仮想補助画像の作成方法の一例を説明する。仮想補助画像を作成するために、事前に、作業場（特にワーク４０）とロボット１０の３次元モデル（３次元ＣＧデータ）を準備して仮想空間に配置する。この時点でのロボット１０の位置は、仮決めされた位置である。また、情報端末５１には、エンドエフェクタ１３の位置及び向きと、ロボット１０の設置位置と、が入力されると、その入力された状態を実現するための各関節の回転角度を出力するプログラムを有しているものとする。

事前登録工程時において、計測ユニット３０は、環境地図上の自己位置を算出して情報端末５１に出力する。情報端末５１は、環境地図に含まれる作業場の各箇所の位置と、仮想空間に含まれる作業場の各箇所の位置と、の対応関係を取得する。情報端末５１は、これらの対応関係に基づいて、環境座標を仮想空間の座標に変換する変換データを作成する。情報端末５１は、環境地図上の自己位置をこの変換データで変換することにより、仮想空間における計測ユニット３０の位置及び姿勢を特定し、これにより、仮想空間におけるエンドエフェクタ１３の位置及び向きを特定する。そして、情報端末５１は、特定したエンドエフェクタ１３の位置及び向きに上記のプログラムを適用することにより、ロボット１０の各関節の回転角度を取得する。なお、情報端末５１は、ロボット１０が指定された姿勢をとることができない場合は、その旨をディスプレイに表示する。情報端末５１は、ロボット１０が指定された姿勢をとることができる場合、その状態を仮想空間上に描画する。以上により、仮想補助画像が作成される。なお、この作成方法は一例であり、別の方法（例えば３次元マーカを用いて変換データを作成する方法）を用いることもできる。

次に、図９を参照して、ＡＲ補助画像を情報端末５１に表示する応用例について説明する。ＡＲとは拡張現実（Ａｕｇｍｅｎｔｅｄ Ｒｅａｌｉｔｙ）のことである。

ＡＲ補助画像とは、情報端末５１のカメラで撮影した画像上に、現在の計測ユニット３０の位置及び向きに対応するロボット１０（特にエンドエフェクタ１３）を重ねた画像である。作業者は、ＡＲ補助画像を見ることで、エンドエフェクタ１３の位置及び向きを直感的に把握しながら環境教示点の登録を行うことができる。また、仮想補助画像において示した変形例は、ＡＲ補助画像にも適用可能である。

以下、ＡＲ補助画像の作成方法を説明する。なお、カメラ上に別の画像を重畳して表示する方法は公知であり、様々な作成方法がある。以下で示すのは、その一例であり、別の作成方法を用いることもできる。ＡＲ補助画像を作成するためには、カメラで撮影した画像にロボット１０を重ねる場合に、ロボット１０の位置、姿勢、大きさをどのように描画するかを特定する必要がある。それらを特定するために、作業場にＡＲマーカ５３を配置する。ＡＲマーカ５３が配置される位置（実空間の座標）及びＡＲマーカ５３の大きさは予め登録されている。情報端末５１は、カメラで撮影した画像にＡＲマーカ５３が含まれる場合、ＡＲマーカ５３が表示される位置に基づいてＡＲマーカ５３が存在する方向を特定し、ＡＲマーカ５３が表示される向きに基づいてＡＲマーカ５３の向きを特定し、ＡＲマーカ５３の画像上のサイズに基づいてＡＲマーカ５３までの距離を特定する。また、上述したように、作業場におけるＡＲマーカ５３の位置及び向きは予め定められている。また、作業場におけるロボット１０の位置及び姿勢は環境地図上の自己位置に基づいて特定できる。以上により、情報端末５１のカメラで撮影した画像上にロボット１０を重畳する場合における、ロボット１０の位置、向き、及び大きさを特定できるので、ＡＲ補助画像を作成できる。

以上に説明したように、本実施形態のロボット教示方法は、事前登録工程と、ロボット動作工程と、教示工程と、を含む。事前登録工程では、計測装置３１を用いて周囲環境を計測することにより周囲環境に対する計測装置３１の相対的な自己位置を特定し、周囲環境に対する相対的な自己位置を用いて特定されたロボット１０の教示点である環境教示点を登録する。ロボット動作工程では、計測装置３１をロボット１０に装着した状態で、計測装置３１による周囲環境の計測結果に基づいて、周囲環境に対するロボット１０の相対的な自己位置が環境教示点に一致するようにロボット１０を自動動作させる。教示工程では、周囲環境に対するロボット１０の相対的な自己位置が環境教示点に一致した状態において、内界センサ１２を用いて検出されたロボット１０の位置及び姿勢の検出値を教示情報として登録する。

これにより、作業者が環境教示点を指定する作業を行うだけでロボット１０を教示できるので、作業者がロボット１０を実際に動作させる教示方法と比較して、簡単な方法でロボット１０を教示できる。また、ビジュアルサーボの教示情報は画像であるのに対し、本実施形態で登録される教示情報はセンサの検出値であるため、ロボット１０の位置及び姿勢を適切に把握できる。

本実施形態のロボット教示方法において、事前登録工程では、作業者が計測装置３１を持って、計測装置３１を実空間におけるロボット１０の教示点に移動させたときの自己位置に基づいて環境教示点を登録する。

これにより、作業者は計測装置３１を教示点に移動させるだけの簡単な作業で、環境教示点の登録を行うことができる。

本実施形態のロボット教示方法において、計測装置３１はステレオカメラであり、教示工程が終了した後においても、事前登録工程で撮影された画像を作業者の教示意図を示す画像として保存し続ける。

これにより、作業者の教示意図を確認できる。

本実施形態のロボット教示方法では、計測装置３１を用いて周囲環境を計測してＳＬＡＭ処理を行うことにより当該周囲環境の環境地図を作成する準備工程を事前登録工程の前に行う。事前登録工程では、環境地図を表示するとともに作業者による環境教示点の入力を受付け、作業者の入力内容に基づいて、環境教示点を登録する。

これにより、環境地図上で環境教示点を指定するだけの簡単な作業で、環境教示点の登録を行うことができる。

本実施形態のロボット教示方法において、ロボット動作工程では、周囲環境の環境地図の座標である環境座標と、内界センサ１２の検出値に基づくロボット１０の座標であるロボット座標と、の複数の対応関係を取得する。次に、複数の対応関係に基づいて、環境座標をロボット座標に変換するための変換データを作成する。次に、計測装置３１の計測結果にＳＬＡＭ処理を行うことで得られた環境地図上の自己位置を変換データを用いて変換することでロボット座標における現在の座標値を算出する。次に、ロボット座標における現在の座標値に基づいてロボット１０を制御して、環境地図における自己位置を環境教示点に一致させる。

これにより、ロボット座標に基づいてロボット１０を制御できるので、ロボット１０を合理的な動作で教示点まで動作させることができる。

本実施形態のロボット教示方法において、変換データの作成後に、再び環境座標とロボット座標との対応関係を取得し、対応関係に基づいて、変換データを更新する。

これにより、変換データの精度を高くすることができるので、より正確なロボット座標を用いてロボット１０を動作させることができる。

本実施形態のロボット教示方法では、教示工程で用いる、ロボット１０の位置及び姿勢を検出するためのセンサが当該ロボット１０の内界センサ１２である。

内界センサ１２の検出値は、ロボット１０の位置及び姿勢を示す値そのものであるため、作業時においてロボット１０の位置及び姿勢をどの方向に動作させるべきかを適切に把握できる。

本実施形態のロボット教示方法では、ロボット１０がティーチングプレイバック型である。

これにより、一般的な産業用ロボットに本発明を適用できる。

本実施形態のロボット教示方法では、事前登録工程において、現在の計測装置３１の位置及び向きに対応するロボット１０が仮想空間上の作業場に配置された画像である仮想補助画像を出力装置を用いて出力する。

これにより、作業場とロボット１０が干渉するか否か等を簡単に確認できる。

本実施形態のロボット教示方法では、事前登録工程において、情報端末５１のカメラで撮影した画像上に、現在の計測装置３１の位置及び向きに対応するロボット１０を重ねた画像であるＡＲ補助画像を情報端末５１のディスプレイに表示する。

これにより、作業者は、ＡＲ補助画像を見ることで、エンドエフェクタ１３の位置及び向きを直感的に把握しながら環境教示点の登録を行うことができる。

本実施形態のロボット作業方法では、ロボット１０が計測装置３１を装着せずに作業を行う。

これにより、ロボット１０にカメラを付けることが前提となるビジュアルサーボと比較して導入コストを低くすることができる。

本実施形態のロボット作業方法では、ロボット１０が計測装置３１を装着した状態で作業を行う。制御装置２０は、作業対象であるワーク４０に対するロボット１０の位置及び姿勢を調整する処理を行う。

これにより、ワーク４０の位置が既定位置から少しズレていた場合においても、適切な作業を行うことができる。

１ ロボットシステム
１０ ロボット
２０ 制御装置
３０ 計測ユニット
３１ 計測装置
３２ 処理装置
３３ ポインタ

Claims (12)

1. 産業用のロボットを教示する方法において、
   計測装置を用いて周囲環境を計測することにより前記周囲環境に対する前記計測装置の相対的な自己位置を特定し、前記周囲環境に対する相対的な自己位置を用いて特定された前記ロボットの教示点である環境教示点を登録する事前登録工程と、
   前記計測装置を前記ロボットに装着した状態で、前記計測装置による周囲環境の計測結果に基づいて、前記周囲環境に対する前記ロボットの相対的な自己位置が前記環境教示点に一致するように前記ロボットを自動動作させるロボット動作工程と、
   前記周囲環境に対する前記ロボットの相対的な自己位置が前記環境教示点に一致した状態において、センサを用いて検出された前記ロボットの位置及び姿勢の検出値を教示情報として登録する教示工程と、
   を含むことを特徴とするロボット教示方法。
2. 請求項１に記載のロボット教示方法であって、
   前記事前登録工程では、作業者が前記計測装置を持って、当該計測装置を実空間における前記ロボットの教示点に移動させたときの自己位置に基づいて前記環境教示点を登録することを特徴とするロボット教示方法。
3. 請求項２に記載のロボット教示方法であって、
   前記計測装置はステレオカメラであり、前記教示工程が終了した後においても、前記事前登録工程で撮影された画像を作業者の教示意図を示す画像として保存し続けることを特徴とするロボット教示方法。
4. 請求項１に記載のロボット教示方法であって、
   前記計測装置を用いて前記周囲環境を計測してＳＬＡＭ処理を行うことにより当該周囲環境の環境地図を作成する準備工程を前記事前登録工程の前に行い、
   前記事前登録工程では、前記環境地図を表示するとともに作業者による前記環境教示点の入力を受付け、当該作業者の入力内容に基づいて、前記環境教示点を登録することを特徴とするロボット教示方法。
5. 請求項１から４までの何れか一項に記載のロボット教示方法であって、
   前記ロボット動作工程では、
   前記計測装置の計測結果にＳＬＡＭ処理を行うことで得られた環境地図の座標である環境座標と、前記センサの検出値に基づく前記ロボットの座標であるロボット座標と、の複数の対応関係を取得し、
   複数の前記対応関係に基づいて、前記環境座標を前記ロボット座標に変換するための変換データを作成し、
   前記計測装置の計測結果にＳＬＡＭ処理を行うことで得られた環境地図上の自己位置を前記変換データを用いて変換することで前記ロボット座標における現在の座標値を算出し、当該座標値に基づいて前記ロボットを制御して、前記環境地図における自己位置を前記環境教示点に一致させることを特徴とするロボット教示方法。
6. 請求項５に記載のロボット教示方法であって、
   前記変換データの作成後に、再び前記環境座標と前記ロボット座標との対応関係を取得し、当該対応関係に基づいて、前記変換データを更新することを特徴とするロボット教示方法。
7. 請求項１から６までの何れか一項に記載のロボット教示方法であって、
   前記教示工程で用いる、前記ロボットの位置及び姿勢を検出するための前記センサが当該ロボットの内界センサであることを特徴とするロボット教示方法。
8. 請求項１から７までの何れか一項に記載のロボット教示方法であって、
   前記ロボットがティーチングプレイバック型であることを特徴とするロボット教示方法。
9. 請求項１から８までの何れか一項に記載のロボット教示方法であって、
   前記事前登録工程において、現在の前記計測装置の位置及び向きに対応する前記ロボットが仮想空間上の作業場に配置された画像である仮想補助画像を出力装置を用いて出力することを特徴とするロボット教示方法。
10. 請求項１から８までの何れか一項に記載のロボット教示方法であって、
    前記事前登録工程において、情報端末のカメラで撮影した画像上に、現在の前記計測装置の位置及び向きに対応する前記ロボットを重ねた画像であるＡＲ補助画像を当該情報端末のディスプレイに表示することを特徴とするロボット教示方法。
11. 請求項１から１０までの何れか一項に記載のロボット教示方法で登録された前記教示情報を用いて前記ロボットが作業を行うロボット作業方法において、
    前記ロボットが前記計測装置を装着せずに作業を行うことを特徴とするロボット作業方法。
12. 請求項１から１０までの何れか一項に記載のロボット教示方法で登録された前記教示情報を用いて前記ロボットが作業を行うロボット作業方法において、
    前記ロボットが前記計測装置を装着した状態で作業を行い、前記計測装置の計測結果に基づいて、作業対象であるワークに対する前記ロボットの位置及び姿勢を調整する処理を行うことを特徴とするロボット作業方法。

Images