特許 5939202 ロボット教示補助装置、ロボットシステムおよびロボット教示方法

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

(12)【公報種別】特許公報(B2)

(11)【特許番号】5939202

(24)【登録日】2016年5月27日

(45)【発行日】2016年6月22日

(54)【発明の名称】ロボット教示補助装置、ロボットシステムおよびロボット教示方法

(51)【国際特許分類】

   B25J 9/22 20060101AFI20160609BHJP

   G05B 19/409 20060101ALI20160609BHJP

   G05B 19/42 20060101ALI20160609BHJP

【ＦＩ】

   B25J9/22 A

   G05B19/409 C

   G05B19/42 H

【請求項の数】9

【全頁数】23

(21)【出願番号】特願2013-117904(P2013-117904)

(22)【出願日】2013年6月4日

(65)【公開番号】特開2014-233814(P2014-233814A)

(43)【公開日】2014年12月15日

【審査請求日】2015年1月15日

(73)【特許権者】

【識別番号】000006622

【氏名又は名称】株式会社安川電機

(74)【代理人】

【識別番号】100089118

【弁理士】

【氏名又は名称】酒井 宏明

(72)【発明者】

【氏名】泉 哲郎

(72)【発明者】

【氏名】永井 亮一

(72)【発明者】

【氏名】橋口 幸男

【審査官】 臼井 卓巳

(56)【参考文献】

【文献】 特開２０１１−１２５９９０（ＪＰ，Ａ）

【文献】 特開平０５−２９３７８２（ＪＰ，Ａ）

【文献】 特開２００２−１５４０８５（ＪＰ，Ａ）

【文献】 特開２００９−２９７８７７（ＪＰ，Ａ）

【文献】 特開２０１１−１１０６３０（ＪＰ，Ａ）

【文献】 特開２０１２−２３２３８４（ＪＰ，Ａ）

【文献】 特開２０１１−２２４６９６（ＪＰ，Ａ）

【文献】 特開２０１０−２１４５７３（ＪＰ，Ａ）

【文献】 特開平０８−１１８２７８（ＪＰ，Ａ）

【文献】 特開平０８−１９４５１７（ＪＰ，Ａ）

【文献】 特開平０４−２８９０８９（ＪＰ，Ａ）

【文献】 米国特許第０６１４１８６３（ＵＳ，Ａ）

【文献】 米国特許出願公開第２００２／００５６１８１（ＵＳ，Ａ１）

(58)【調査した分野】（Int.Cl.，ＤＢ名）

Ｂ２５Ｊ ９／２２−１９／４２

Ｂ２３Ｐ ２１／００

Ｇ０５Ｂ １９／４０９

Ｇ０５Ｂ １９／４２

(57)【特許請求の範囲】

【請求項1】

ロボットに加わる力を計測する力センサの計測値に基づいて前記ロボットの動作態様を修正することを含む動作命令を定義するための指定値の入力操作を受け付ける操作部と、
前記ロボットへ動作態様を教示する教示装置へ、前記ロボットの動作態様を修正するために入力すべきパラメータを、前記操作部によって入力された前記指定値、および、前記力センサの計測値に基づいて調整する調整部と、
前記調整部によって調整された前記教示装置へ入力すべき前記パラメータと、当該パラメータの前記教示装置への入力に関するガイダンス情報とを含む教示操作画面を生成する画面生成部と
を備え、
前記パラメータは、
前記ロボットの力制御に関する力制御パラメータ、および、前記ロボットの動作条件に関する動作条件パラメータであって、
前記調整部は、
前記教示装置へ入力すべき前記力制御パラメータを調整する第１の調整部と、
前記教示装置へ入力すべき前記動作条件パラメータを調整する第２の調整部と
を備えることを特徴とするロボット教示補助装置。

【請求項2】

前記ロボットは、
作業に用いるエンドエフェクタを有し、
前記力センサは、
前記エンドエフェクタに加わる力を計測する
ことを特徴とする請求項１に記載のロボット教示補助装置。

【請求項3】

前記第２の調整部は、
前記動作態様を前記ロボットが行う複数の動作に分割したうえで、該複数の動作における前記教示装置へ入力すべき前記動作条件パラメータを調整する
ことを特徴とする請求項１または請求項２に記載のロボット教示補助装置。

【請求項4】

前記動作態様によって行われる作業は、
第１のワークを第２のワークへ嵌合させる嵌合作業であって、
前記第２の調整部は、
前記嵌合作業を、前記第１のワークを前記第２のワークへ接触させる接触動作と、前記第１のワークで前記第２のワークの形状を探る探り動作と、前記第１のワークを前記第２のワークへ挿入する挿入動作とに分割したうえで、該接触動作、該探り動作および該挿入動作のために前記教示装置へ入力すべき前記動作条件パラメータを調整すること
を特徴とする請求項３に記載のロボット教示補助装置。

【請求項5】

前記第２の調整部は、
前記接触動作、前記探り動作および前記挿入動作ごとに前記教示装置へ入力すべき前記動作条件パラメータを個別に調整すること
を特徴とする請求項４に記載のロボット教示補助装置。

【請求項6】

前記画面生成部は、
前記ガイダンス情報として、前記教示装置の操作手順を示すガイダンスメッセージと、該ガイダンスメッセージの内容に対応したガイド図とを含む前記教示操作画面を生成すること
を特徴とする請求項１〜５のいずれか一つに記載のロボット教示補助装置。

【請求項7】

前記画面生成部は、
前記調整部による前記教示装置へ入力すべき前記パラメータの調整が行われた場合に、該調整の状態を示す状態モニタと、前記力センサの計測値に基づく波形モニタとを含む前記教示操作画面を生成すること
を特徴とする請求項１〜６のいずれか一つに記載のロボット教示補助装置。

【請求項8】

ロボットと、
前記ロボットへ動作態様を教示する教示装置と、
前記教示装置による教示の補助を行うロボット教示補助装置と
を含み、
前記ロボット教示補助装置は、
前記ロボットに加わる力を計測する力センサの計測値に基づいて前記ロボットの動作態様を修正することを含む動作命令を定義するための指定値の入力操作を受け付ける操作部と、
前記教示装置へ、前記ロボットの動作態様を修正するために入力すべきパラメータを、前記操作部によって入力された前記指定値、および、前記力センサの計測値に基づいて調整する調整部と、
前記調整部によって調整された前記教示装置へ入力すべき前記パラメータと、当該パラメータの前記教示装置への入力に関するガイダンス情報とを含む教示操作画面を生成する画面生成部と
を備え、
前記パラメータは、
前記ロボットの力制御に関する力制御パラメータ、および、前記ロボットの動作条件に関する動作条件パラメータであって、
前記調整部は、
前記教示装置へ入力すべき前記力制御パラメータを調整する第１の調整部と、
前記教示装置へ入力すべき前記動作条件パラメータを調整する第２の調整部と
を備えることを特徴とするロボットシステム。

【請求項9】

ロボットに加わる力を計測する力センサの計測値に基づいて前記ロボットの動作態様を修正することを含む動作命令を定義するための指定値の入力操作を操作部によって受け付ける工程と、
前記ロボットへ動作態様を教示する教示装置へ、前記ロボットの動作態様を修正するために入力すべきパラメータを、前記操作部によって入力された前記指定値、および、前記力センサの計測値に基づいて調整部によって調整する工程と、
前記調整部によって調整された前記教示装置へ入力すべき前記パラメータと、当該パラメータの前記教示装置への入力に関するガイダンス情報とを含む教示操作画面を画面生成部によって生成する工程と
を含み、
前記パラメータは、
前記ロボットの力制御に関する力制御パラメータ、および、前記ロボットの動作条件に関する動作条件パラメータであって、
前記パラメータを調整する工程は、
前記教示装置へ入力すべき前記力制御パラメータを調整する第１の調整工程と、
前記教示装置へ入力すべき前記動作条件パラメータを調整する第２の調整工程と
を含むことを特徴とするロボット教示方法。

【発明の詳細な説明】

【技術分野】

【0001】

開示の実施形態は、ロボット教示補助装置、ロボットシステムおよびロボット教示方法に関する。

【背景技術】

【0002】

従来、エンドエフェクタを用いてワークに接触しながらの所定の組立作業等をロボットに行わせるにあたって、かかるロボットを動作させるジョブの作成、いわゆる「教示」のためのシステムが種々提案されている。

【0003】

かかるシステムには、一般にプログラミングペンダントと呼ばれる可搬式の専用デバイスが含まれており、教示者は、かかるプログラミングペンダントを操作してロボットを逐一動かしながら、教示を行う（たとえば、特許文献１参照）。

【先行技術文献】

【特許文献】

【0004】

【特許文献1】特開２００７−１３６５８８号公報

【発明の概要】

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

【0005】

しかしながら、従来のシステムには、教示者の熟練度に関わりなく、簡易な操作で効率的かつ高精度な教示を行うという点で更なる改善の余地がある。

【0006】

具体的にはまず、上述のプログラミングペンダントの操作には、ある程度教示者の熟練度が求められる。そのうえ、教示の内容は、作業やワークの種別等によりさまざまである。とりわけ、ワーク同士を嵌合させるといった作業の場合、ロボットに対しては、単なる位置姿勢の教示だけでなく、ワークとの接触状態に応じた力制御等を考慮した教示を行う必要がある。

【0007】

そして、このような場合の教示の精度を保つにあたり、従来のシステムでは、熟練度の高い教示者であっても、視認や触認を含む試行錯誤（いわゆる、トライアルアンドエラー）を繰り返しながら教示を行う必要があった。このため、教示者の熟練度に関わりなく、簡易な操作で効率的かつ高精度な教示を行うという点で不十分であった。

【0008】

実施形態の一態様は、上記に鑑みてなされたものであって、教示者の熟練度に関わりなく、簡易な操作で効率的かつ高精度な教示を行うことができるロボット教示補助装置、ロボットシステムおよびロボット教示方法を提供することを目的とする。

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

【0009】

実施形態の一態様に係るロボット教示補助装置は、操作部と、調整部と、画面生成部とを備える。操作部は、センサの計測値に基づいてロボットの動作態様を修正することを含む動作命令を定義するための指定値の入力操作を受け付ける。調整部は、入力された前記指定値、および、前記センサの計測値に基づいて、前記ロボットの動作態様を修正するパラメータを調整する。画面生成部は、前記ロボットへ動作態様を教示する教示装置への前記パラメータの入力に関するガイダンス情報を含む教示操作画面を生成する。

【発明の効果】

【0010】

実施形態の一態様によれば、教示者の熟練度に関わりなく、簡易な操作で効率的かつ高精度な教示を行うことができる。

【図面の簡単な説明】

【0011】

【図1】図１は、実施形態に係るロボットシステムの全体構成を示す模式図である。

【図2】図２は、実施形態に係るロボットシステムのブロック図である。

【図3A】図３Ａは、嵌合作業を構成する各種動作を示す模式図(その１)である。

【図3B】図３Ｂは、嵌合作業を構成する各種動作を示す模式図(その２)である。

【図3C】図３Ｃは、嵌合作業を構成する各種動作を示す模式図(その３)である。

【図4A】図４Ａは、力条件調整処理の説明図（その１）である。

【図4B】図４Ｂは、力条件調整処理の説明図（その２）である。

【図4C】図４Ｃは、力条件調整処理の説明図（その３）である。

【図4D】図４Ｄは、力条件調整処理の説明図（その４）である。

【図5A】図５Ａは、力条件調整処理の操作手順の一例を示す模式図（その１）である。

【図5B】図５Ｂは、力条件調整処理の操作手順の一例を示す模式図（その２）である。

【図6A】図６Ａは、動作条件調整処理の説明図（その１）である。

【図6B】図６Ｂは、動作条件調整処理の説明図（その２）である。

【図6C】図６Ｃは、動作条件調整処理の説明図（その３）である。

【図7A】図７Ａは、接触動作調整処理の操作手順の一例を示す模式図（その１）である。

【図7B】図７Ｂは、接触動作調整処理の操作手順の一例を示す模式図（その２）である。

【図8A】図８Ａは、探り動作調整処理の操作手順の一例を示す模式図（その１）である。

【図8B】図８Ｂは、探り動作調整処理の操作手順の一例を示す模式図（その２）である。

【図9A】図９Ａは、挿入動作調整処理の操作手順の一例を示す模式図（その１）である。

【図9B】図９Ｂは、挿入動作調整処理の操作手順の一例を示す模式図（その２）である。

【図10】図１０は、実施形態に係るＰＣが実行する処理手順を示すフローチャートである。

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

【0012】

以下、添付図面を参照して、本願の開示するロボット教示補助装置、ロボットシステムおよびロボット教示方法の実施形態を詳細に説明する。なお、以下に示す実施形態によりこの発明が限定されるものではない。

【0013】

また、以下では、ロボットに教示する所定の作業の作業内容が、ワーク同士を嵌合する嵌合作業である場合を例に挙げて説明を行う。また、以下では、エンドエフェクタを「ハンド」と記載する。また、プログラミングペンダントについては「ＰＰ」と記載する場合がある。

【0014】

図１は、実施形態に係るロボットシステム１の全体構成を示す模式図である。図１に示すように、ロボットシステム１は、制御装置１０と、ロボット教示補助装置となるＰＣ（Personal Computer）２０と、ロボット３０と、ロボット３０へ動作態様を教示する教示装置となるプログラミングペンダント４０とを備える。

【0015】

制御装置１０は、演算処理装置や記憶装置等を含んで構成されるコントローラである。かかる制御装置１０は、ＰＣ２０、ロボット３０、プログラミングペンダント４０をはじめとするロボットシステム１の各種装置と情報伝達可能に接続される。ここで、接続形態は問わない。したがって、有線接続であっても、無線接続であってもよい。

【0016】

また、制御装置１０は、力条件ファイル１２ａと、動作条件パラメータ１２ｂと、ジョブ情報１２ｃとを備える。力条件ファイル１２ａは、後述する力制御に用いられる力制御パラメータを含む情報である。

【0017】

動作条件パラメータ１２ｂは、嵌合作業を構成する「接触動作」、「探り動作」、「挿入動作」の各動作において用いられるパラメータを含む情報である。かかる各動作の詳細については図３Ａ〜図３Ｃ等を用いて後述する。ジョブ情報１２ｃは、教示結果として生成されるジョブを含む情報である。ジョブとは制御装置１０により制御されるロボット３０等の装置の動作命令が定義されたプログラムであり、後述するように制御装置１０により解釈実行されることによりロボット３０及びハンド３２が動作するようになっている。

【0018】

なお、図１では、１筐体の制御装置１０を示しているが、これに限られるものではなく、たとえば、制御対象となる各種装置のそれぞれに対応付けられ、相互に情報伝達可能に接続された複数個の筐体で構成されてもよい。

【0019】

ロボット３０は、アーム３１と、ハンド３２と、力センサ３３とを備える。アーム３１は、複数の構造部材と各構造部材を可動とするサーボモータを有する複数の関節とを有している。ハンド３２は、アーム３１の終端可動部に取り付けられるエンドエフェクタである。

【0020】

力センサ３３は、アーム３１とハンド３２との間、いわばロボット３０の手首部に装着される力覚センサである。かかる力センサ３３は、３次元の３方向の力とねじれを計測可能な６軸センサであることが好ましい。

【0021】

なお、以下では、力センサ３３が計測し、出力する値については、「計測値」と総称する場合がある。力センサ３３の計測値は、制御装置１０へ送られて力条件ファイル１２ａに格納された後、ＰＣ２０によって読み出されて、後述の力条件調整処理、および、動作条件調整処理において用いられる。

【0022】

プログラミングペンダント４０は、教示者によって入力される各種パラメータを制御装置１０へ出力することによってロボット３０へ種々の動作態様を教示する教示装置として機能する。制御装置１０は、プログラミングペンダント４０から入力される各種パラメータ等に基づいてジョブを生成し、生成したジョブをロボット３０に実行させる動作指示をロボット３０へ出力することによって、ロボット３０の動作を制御する。

【0023】

ＰＣ２０は、教示者に対してプログラミングペンダント４０への各種パラメータの入力に関するガイダンス情報を提供することにより、教示者によるロボット３０への動作態様の教示を補助するロボット教示補助装置として機能する。なお、ＰＣ２０および制御装置１０の構成の一例については、図２を参照して後述する。

【0024】

かかるＰＣ２０は、力センサ３３の計測値に基づいてロボット３０の動作態様を修正することを含むジョブ（動作命令）を定義するための指定値の入力操作を受け付ける。続いて、ＰＣ２０は、入力された指定値と力センサ３３の計測値とに基づいて、ロボット３０の動作態様を修正するパラメータを調整する。

【0025】

さらに、ＰＣ２０は、調整したパラメータのプログラミングペンダント４０への入力に関するガイダンス情報を含む教示操作画面を生成して表示させることにより、教示者へプログラミングペンダント４０の操作手順等を案内する。

【0026】

これにより、教示者は、ＰＣ２０によって提供されるガイダンス情報に従ってプログラミングペンダント４０へ各種パラメータを入力することにより、ロボット３０に対して、熟練度に関係なく誤りの少ない精度の高い教示を行うことができる。

【0027】

なお、ここでは、ロボット教示補助装置として、ＰＣ２０を例に挙げているが、ロボット教示補助装置は、ＰＣ２０と同様の機能を備え、教示者による操作の受け付けや、各種情報の表示が可能なデバイスであれば、たとえばタブレット端末等であってもよい。

【0028】

また、本実施形態における「嵌合作業」は、図１に示すように、ロボット３０が、ハンド３２でオス型のワークＷ１（第１のワーク）を把持し、メス型のワークＷ２（第２のワーク）へ嵌合するものであることとする。また、以下では、ワークＷ１およびワークＷ２を総称する場合、ワークＷと記載する。

【0029】

また、図１では、ロボット３０が、一本の腕を有する単腕ロボットである例を示しているが、腕の数を問うものではなく、ロボットシステム１に適用されるロボットは、２本以上の腕を備える複腕ロボットであってもよい。

【0030】

次に、実施形態に係るロボットシステム１のブロック構成について、図２を用いて説明する。図２は、実施形態に係るロボットシステム１のブロック図である。なお、図２では、ロボットシステム１の説明に必要な構成要素のみを示しており、一般的な構成要素についての記載を省略している。

【0031】

まず、制御装置１０から説明する。図２に示すように、制御装置１０は、制御部１１と、記憶部１２とを備える。制御部１１は、制御装置１０の全体制御を行う処理部であり、ジョブ生成部１１ａと、動作指示部１１ｂとをさらに備える。記憶部１２は、ハードディスクドライブや不揮発性メモリといった記憶デバイスであり、力条件ファイル１２ａと、動作条件パラメータ１２ｂと、ジョブ情報１２ｃとを記憶する。

【0032】

ここで、力条件ファイル１２ａには、後述の力条件調整処理用の動作をロボット３０に実行させるために必要な各種パラメータ等が含まれている。かかる力条件ファイル１２ａには、初期状態では既定値が書き込まれている。

【0033】

また、教示者は、プログラミングペンダント４０を操作して所望のパラメータを入力し、力条件ファイル１２ａへ上書きすることにより、ロボット３０による力条件調整処理用の動作態様を修正することができる。

【0034】

なお、力条件ファイル１２ａには、ロボット３０の動作時に力センサ３３によって計測される計測値や、ロボット３０に設けられる他のセンサ（図示略）によって計測される計測値のフィードバック値等も書き込まれる。なお、ここでの他のセンサは、例えば、アーム３１やハンド３２を駆動するサーボモータの回転位置を検出する位置センサ等である。

【0035】

また、動作条件パラメータ１２ｂには、後述の接触動作、探り動作、および挿入動作といった動作条件調整処理用の動作をロボット３０に実行させるために必要な各種パラメータ等が含まれる。また、教示者は、プログラミングペンダント４０を操作して所望のパラメータを入力し、かかる動作条件パラメータ１２ｂへ上書きすることにより、ロボット３０による動作条件調整処理用の動作態様を修正することができる。

【0036】

ジョブ生成部１１ａは、力条件ファイル１２ａに含まれる各種パラメータに基づき、ロボット３０に力条件調整処理用の動作を実行させるためのジョブを定義するジョブ情報１２ｃを生成して記憶部１２に記憶させる。

【0037】

また、ジョブ生成部１１ａは、力条件ファイル１２ａに含まれる各種パラメータ、および、動作条件パラメータ１２ｂに基づき、ロボット３０に動作条件調整処理用の動作を実行させるためのジョブを定義するジョブ情報１２ｃを生成して記憶部１２に記憶させる。

【0038】

動作指示部１１ｂは、プログラミングペンダント４０から教示者の操作に応じた所定の動作を開始させる制御信号が入力された場合に、ジョブ生成部１１ａを介して記憶部１２からジョブ情報１２ｃを読み出す。

【0039】

そして、動作指示部１１ｂは、読み出したジョブ情報１２ｃを解釈してロボット３０の各関節（サーボモータ）に対する動作命令を生成し、ロボット３０へ出力することにより、ロボット３０に力条件調整処理用の動作や動作条件調整処理用の動作等を実行させる。

【0040】

プログラミングペンダント４０は、教示者がロボット３０に対して、動作態様の教示や動作態様の修正、および動作の開始を行うために操作する端末装置である。教示者は、かかるプログラミングペンダント４０を操作して、前述した各種パラメータ等を入力することにより、ロボット３０に対して動作態様の教示や修正等を行うことができる。

【0041】

ただし、プログラミングペンダント４０を操作する教示者には、一定の熟練度が要求される。つまり、プログラミングペンダント４０は、ロボット３０の動作態様の教示や修正に関する操作を誰もが簡単に行えるものではない。

【0042】

そこで、ロボットシステム１では、ＰＣ２０によって、プログラミングペンダント４０の操作方法の案内や、プログラミングペンダント４０へ入力すべき適切なパラメータの提案を行うことによって、教示者によるプログラミングペンダント４０の操作を補助する。

【0043】

ＰＣ２０は、プログラミングペンダント４０へ入力すべき項目や指定値等を教示者へ提案し、教示者に対して、ＰＣ２０およびプログラミングペンダント４０へ例えばパラメータの既定値等の入力を促す。そして、ＰＣ２０は、教示者に対して、プログラミングペンダント４０の操作によってロボット３０の動作を開始させるよう促す。

【0044】

その後、ＰＣ２０は、かかるロボット３０が動作することによって得られる力センサ３３の計測値や、ロボット３０に設けられる他のセンサ（図示略）によって計測される計測値のフィードバック値に基づいて各種パラメータの調整を行う。

【0045】

そして、ＰＣ２０は、調整後のパラメータを教示者によってＰＣ２０およびプログラミングペンダント４０へ入力させ、再びプログラミングペンダント４０の操作によってロボット３０を動作させて動作結果に基づくパラメータの調整を行うという動作を繰り返す。

【0046】

かかるＰＣ２０は、制御部２１と、記憶部２２と、操作部２３と、表示部２４とを備える。記憶部２２は、ハードディスクドライブや不揮発性メモリといった記憶デバイスであり、後述のガイダンス情報２２ａや調整結果情報２２ｂ等を記憶する。

【0047】

操作部２３は、キーボードやマウスといった操作デバイスであり、教示者の操作を受け付け、その内容を制御部２１へ出力する。例えば、操作部２３は、力センサ３３の計測値に基づいてロボット３０の動作態様を修正することを含む動作命令を定義するための指定値等の入力操作を受け付け、その内容を制御部２１へ出力する。

【0048】

制御部２１は、ＰＣ２０の全体制御を行う処理部であり、力条件調整部２１ａと、動作条件調整部２１ｂと、画面生成部２１ｃとを備える。

【0049】

力条件調整部２１ａは、操作部２３から入力される操作内容、制御装置１０の記憶部１２から読み出す力条件ファイル１２ａ中の力制御パラメータ、前述のフィードバック値に基づき、力制御パラメータを調整する力条件調整処理を行う。

【0050】

そして、力条件調整部２１ａは、調整後の力制御パラメータを動作条件調整部２１ｂおよび画面生成部２１ｃへ出力する。なお、力条件調整処理の具体例については、図４Ａ〜図５Ｂを参照して後述する。

【0051】

動作条件調整部２１ｂは、操作部２３から入力される操作内容、調整後の力制御パラメータ、制御装置１０の記憶部１２から読み出す動作条件パラメータ１２ｂ、前述のフィードバック値に基づき、動作条件パラメータ１２ｂを調整する動作条件調整処理を行う。ここで調整される動作条件パラメータ１２ｂは、嵌合作業における「接触動作」、「探り動作」、「挿入動作」の動作条件を規定するパラメータである。

【0052】

そして、力条件調整部２１ａは、調整後の動作条件パラメータ１２ｂを画面生成部２１ｃへ出力する。なお、ロボット３０が行う嵌合動作の具体例については、図３Ａ〜図３Ｃを参照して後述し、動作条件調整処理の具体例については、図６Ａ〜図９Ｂを参照して後述する。

【0053】

画面生成部２１ｃは、力条件調整部２１ａおよび動作条件調整部２１ｂから入力される各種パラメータと、記憶部２２から読み出すガイダンス情報２２ａとに基づいて、プログラミングペンダント４０の操作を補助する表示画面を生成し、表示部２４へ出力する。

【0054】

このとき、画面生成部２１ｃは、力条件ファイル１２ａや動作条件パラメータ１２ｂの直近の状況や、ガイダンス情報２２ａに含まれる教示者へのガイダンスメッセージ等を適宜反映させた表示画面を生成し、表示部２４へ出力する。表示部２４は、ディスプレイ等の表示デバイスであり、画面生成部２１ｃから入力される表示画面を表示する。

【0055】

また、画面生成部２１ｃは、力条件調整部２１ａによる力条件調整処理が完了した場合の表示画面、および、動作条件調整部２１ｂによる動作条件調整処理が完了した場合の表示画面を調整結果情報２２ｂとして記憶部２２に記憶させる。

【0056】

これにより、ＰＣ２０は、例えば、次回、他の教示者がロボットシステム１を使用する場合に、調査結果情報２２ｂを表示部２４に表示させることにより、教示者へ始めから調整済みの適切なパラメータを提案することができる。

【0057】

次に、図３Ａ〜図３Ｃを参照して、ロボット３０が行う嵌合作業について説明する。図３Ａ〜図３Ｃは、嵌合作業を構成する各種動作を示す模式図(その１)〜（その３）である。図３Ａに示すように、「接触動作」は、ハンド３２で把持したワークＷ１をワークＷ２の穴に入らない位置でワークＷ２に接触させる動作である（図中の矢印３０１参照）。これにより、後述する接触距離を取得することとなる。

【0058】

また、図３Ｂに示すように、「探り動作」は、ワークＷ１をワークＷ２に押し当てつつ（図中の矢印３０２参照）、ワークＷ１をワークＷ２の穴の周囲で揺動させる動作である（図中の矢印３０３参照）。これにより、後述する探り周期を取得することとなる。

【0059】

また、図３Ｃに示すように、「挿入動作」は、ワークＷ１をワークＷ２の穴に挿入させる動作である。これにより、後述する挿入量の上下限閾値を取得することとなる。

【0060】

本実施形態に係るロボットシステム１は、嵌合作業をこの図３Ａ〜図３Ｃに示す３つの工程に分割し、個別に動作条件パラメータ１２ｂを調整することによって、嵌合作業を精度よくロボット３０に教示することを可能にしている。

【0061】

そして、ロボットシステム１では、教示者によってプログラミングペンダント４０を操作させることによって、「接触動作」、「探り動作」および「挿入動作」をロボット３０に行わせ、これによって得られる力フィードバック値を力センサ３３から取得する。

【0062】

なお、動作条件パラメータ１２ｂには、「接触動作」、「探り動作」および「挿入動作」それぞれの既定の動作条件があらかじめ既定パラメータとして含まれている。そして、ＰＣ２０は、最初にかかる既定パラメータを教示者によってプログラミングペンダント４０から入力するよう促して、動作指示部１１ｂにロボット３０を動作させる。

【0063】

続いて、ＰＣ２０は、取得した力フィードバック値に基づいて動作条件パラメータ１２ｂを調整する。このとき、取得した力フィードバック値や状態遷移の状況は逐次ＰＣ２０の表示部２４によって表示される。

【0064】

教示者は、かかるＰＣ２０の表示に従って再調整値の入力が可能であり、ＰＣ２０は、教示者から再調整値が入力された場合には、入力された再調整値をプログラミングペンダント４０へ入力するよう促し、ロボット３０を動作させる。

【0065】

そして、ＰＣ２０は、その結果取得するフィードバック値に基づき、動作条件パラメータ１２ｂを再調整する。この繰り返しにより、動作条件パラメータ１２ｂが最適化されてゆくこととなる。

【0066】

次に、力条件調整処理の詳細について説明する。まず、図４Ａ〜図４Ｄを用いて力条件調整処理の内容について説明した後、図５Ａおよび図５Ｂを用いて具体的な操作手順の一例について説明する。

【0067】

図４Ａ〜図４Ｄは、力条件調整処理の説明図（その１）〜（その４）である。また、図５Ａおよび図５Ｂは、力条件調整処理の操作手順の一例を示す模式図（その１）および（その２）である。

【0068】

本実施形態の力条件調整処理は、力制御のモデルとして、下記の式（１）に示すインピーダンス制御を用いている。

【数1】

【0069】

インピーダンス制御パラメータ、すなわち力制御パラメータには、図４Ａに示すように慣性係数Ｍ、粘性係数Ｄおよびバネ係数Ｋがあり、力条件調整処理では、このうち慣性係数Ｍとバネ係数Ｋとを固定で使用する。

【0070】

すなわち、力条件調整処理では、一定の力指令を与えたときにその指令に早く追従するように粘性係数Ｄを自動的に調整する。なお、上記の式（１）における括弧内の単位は、前者が並進方向、後者が回転方向を示している。

【0071】

そして、力条件調整処理は、第１の調整ステップと、第２の調整ステップとからなる。第１の調整ステップでは、所定時間の間、微力でワークＷ１をワークＷ２へ押し付け、発散せずに接触安定を保てる粘性限界値を求める。

【0072】

なお、図４Ｂには、粘性初期値から開始後、力波形が発散していない、すなわち接触安定が保てている状態を示している。また、図４Ｃには、力波形が発散した、接触不安定な状態を示している。すなわち、力条件調整処理の第１の調整ステップでは、図４Ｂに示す力波形となるような粘性限界値が求められる。

【0073】

また、図４Ｄに示すように、第２の調整ステップでは、力指令を与えて繰り返しワークＷを接触させ、そのときの力フィードバック値Ｆ_ｆｂの応答性が良好となる粘性値を求める。すなわち、力応答が力指令（図中の矩形波参照）に対し、条件Ａのようにハンチングを起こさず、また、条件Ｃのように遅延せずに、条件Ｂのように早く追従するよう粘性値を調整する。

【0074】

そして、かかる力条件調整処理は、たとえば、図５Ａに示すような、ＰＣ２０の表示部２４に表示される力条件調整画面に従って、教示者がＰＣ２０およびプログラミングペンダント４０を操作することによって実現される。なお、図５Ａを含め、以下の説明で用いるすべての表示画面例は、ＰＣ２０の表示部２４へ表示されるものである。

【0075】

また、かかるすべての表示画面例は、「教示操作画面」と総称する場合がある。また、かかる「教示操作画面」に従って、教示者がＰＣ２０およびプログラミングペンダント４０へ入力する入力値については、「指定値」と総称する場合がある。

【0076】

図５Ａに示すように、力条件調整画面は、ガイダンス画面を含んで構成される。ガイダンス画面は、教示者への教示支援情報を出力する領域であり、たとえば、図５Ａに示すように、「１．ロボットを選択してください。」といった操作手順を示すガイダンスメッセージが表示される。

【0077】

また、図５Ａに示すように、ガイダンス画面にはあわせて、教示者の理解を助けるためのガイド図を表示することができる。一例として、図５Ａでは、教示対象となるロボットのロボット名称や座標系の名称が表示された例を示している。

【0078】

教示者は、かかるガイダンス画面およびガイド図を参考にしながら、ＰＣ２０およびプログラミングペンダント４０に対して力制御パラメータの調整に必要となる操作を行うことにより、熟練度に関わりなく、誤りの少ない、精度の高い教示を行うことができる。

【0079】

たとえば、図５Ａの力条件調整画面には、右側上段の領域に入力項目が設けられている。そして、教示者がガイダンス画面を参考にして、ＰＣ２０を操作し、力条件ファイル１２ａの「ファイル番号」、教示対象となる「ロボット」、「座標系」、「ツール番号」、「嵌合方向」等の指定値を入力すると、入力項目に入力結果が表示される。

【0080】

なお、図５Ａに示す「調整対象パラメータ」である粘性係数Ｄの「Ｘ」、「Ｙ」、「Ｚ」は並進３軸分であり、「Ｒｘ」、「Ｒｙ」、「Ｒｚ」は回転３軸分である。そして、これらは、調整前は順に「ａ」、「ｂ」、「ｃ」、「ｄ」、「ｅ」、「ｆ」であるものとする。

【0081】

また、力条件調整画面の右側下段の領域には、調整対象となる力制御パラメータが「調整対象パラメータ」として表示されており、教示者はかかる表示により力制御パラメータの現在値を知ることができる。

【0082】

教示者は、ＰＣ２０の表示部２４に表示される条件調整画面を参照しながら、プログラミングペンダント４０を操作して調整前の粘性係数Ｄを入力し、プログラミングペンダント４０の「開始」ボタンを操作して、力条件調整処理用の動作をロボット３０に実行させる。

【0083】

ロボット３０による力条件調整処理用の動作時に力センサ３３によって計測された計測値は、制御装置１０へ送られ、力条件ファイル１２ａに記録される。かかる計測値は、ＰＣ２０の力条件調整部２１ａによる力条件調整処理に用いられる。

【0084】

その後、教示者は、力条件調整画面の右側下段に配置された「調整実行」ボタンを押下することによって、力条件調整処理を実行させる。つづく図５Ｂには、図５Ａの「調整実行」ボタンが押下され、力条件調整処理が１回実行された後の力条件調整画面の一例を示している。

【0085】

図５Ｂに示すように、処理実行後の力条件調整画面においてもガイダンス画面が表示され、教示者の次なる操作を支援する。一例として、図５Ｂには、「モニタを確認して、警告であればＰＰから再調整してください。エラーであれば処理をキャンセルしてください。」とガイダンス表示された例を示している。

【0086】

かかるガイダンス表示にあるように、処理実行後の力条件調整画面には、たとえば、「正常」、「警告」、「エラー」で示される状態モニタを表示することができる。なお、ここでは、点灯ランプ状の状態モニタを例示しているが、無論これに限られるものではない。教示者は、ガイダンス画面とかかる状態モニタの表示内容とに応じて次なる操作を選択することができる。

【0087】

また、たとえば、図５Ｂに示すように、力センサ３３の計測値による力波形を、波形モニタとして表示させてもよい。これら状態モニタや波形モニタのようなモニタ表示を行うことによって、教示者の熟練度に関わりなく、教示者が、誤りの少ない精度の高い教示を行えるよう支援することができる。

【0088】

さらに、処理実行後の力条件調整画面には、下段の領域に調整結果が表示される。ここでは、先ほど入力した「座標系」、「嵌合方向」、「指定値」等の入力項目に対応する粘性係数Ｄとして、上から順に、「ａ’」、「ｂ’」、「ｃ’」、「ｄ’」、「ｅ’」、「ｆ’」と調整された例を示している（図中の閉曲線６０１参照）。

【0089】

教示者は、かかる調整結果を参照しながらプログラミングペンダント４０を操作して、調整後の粘性係数Ｄを入力し、プログラミングペンダント４０の「開始」ボタンを操作して、力条件調整処理用の動作をロボット３０に実行させる。

【0090】

その後、教示者は、力条件調整画面の左側下段に配置された「調整実行」ボタンを押下することによって、力条件調整処理を再度実行させる。そして、教示者は、図５Ｂに示すように状態モニタの「正常」が点灯していれば、調整結果を確認して「終了」ボタンを押下し、調整結果をＰＣ２０に保存させる。また、状態モニタが「エラー」であれば、「キャンセル」ボタンを押下して力条件調整処理をキャンセルする。

【0091】

次に、動作条件調整処理の詳細について説明する。図６Ａ〜図６Ｃは、動作条件調整処理の説明図（その１）〜（その３）である。なお、図６Ａ〜図６Ｃに示す構成要素のうち、図３Ａ〜図３Ｃに示す構成要素と同一の構成要素については、図３Ａ〜図３Ｃに示す符号と同一の符号を付している。

【0092】

本実施形態の動作条件調整処理は、力条件調整処理において調整された力制御パラメータと教示者の操作とに基づき、嵌合作業における上述の「接触動作」、「探り動作」、「挿入動作」それぞれの動作条件を規定する動作条件パラメータ１２ｂを調整する。

【0093】

ここで、動作条件パラメータ１２ｂとしては、図６Ａに示すように、接触動作については、ワークＷ１からワークＷ２までの「接触距離」等が調整される。また、図６Ｂに示すように、探り動作については、「探り周期」（探り量）等が調整される。また、図６Ｃに示すように、挿入動作については、「挿入量閾値下限」や「挿入量閾値上限」等が調整される。

【0094】

これら「接触距離」、「探り周期」、「挿入量閾値下限」および「挿入量閾値上限」等は、ワークＷの形状に適した設定値へと調整される必要がある。したがって、動作条件調整処理では、ガイダンスに則した教示者によるプログラミングペンダント４０の操作に基づいてロボット３０を動作させる。

【0095】

そして、かかるロボット３０の動作によって得られる力センサ３３からの計測値のフィードバック値およびロボット３０（各サーボモータの位置センサ）からの位置のフィードバック値からワークＷの形状を計測しつつ、動作条件パラメータ１２ｂを調整してゆく。

【0096】

次に、かかる動作条件調整処理の具体的な操作手順の一例について図７Ａ〜図９Ｂを用いて説明する。図７Ａおよび図７Ｂは、接触動作調整処理の操作手順の一例を示す模式図（その１）および（その２）である。

【0097】

また、図８Ａおよび図８Ｂは、探り動作調整処理の操作手順の一例を示す模式図（その１）および（その２）である。また、図９Ａおよび図９Ｂは、挿入動作調整処理の操作手順の一例を示す模式図（その１）および（その２）である。

【0098】

まず、接触動作の場合から説明する。図７Ａに示すように、接触動作調整画面は、力条件調整画面（図５Ａおよび図５Ｂ）と同様に、ガイダンス画面を含んで構成される。

【0099】

ここで、ガイダンス画面には、たとえば、図７Ａに示すように、「１．嵌合開始位置Ｐ１（穴から数ｍｍ真上）をＰＰで教示してください。」や「２．Ｐ１から水平方向に数ｍｍずらした位置Ｐ２（穴に入らない位置）をＰＰで教示してください。」といった操作手順を示すガイダンスメッセージが表示される。

【0100】

また、図７Ａに示すように、ガイダンス画面には、かかるガイダンスメッセージに応じたガイド図をあわせて表示することができる。

【0101】

これにより、教示者の熟練度に関わりなく、教示者が、誤りの少ない、精度の高い教示を行えるよう支援することができる。そして、教示者は、かかるガイダンス画面の内容に従い、接触動作に関する動作条件パラメータ１２ｂの調整に必要な操作を行う。

【0102】

たとえば、図７Ａの接触動作調整画面は、左側下段の領域に操作画面を有しており、教示者はかかる操作画面の入力項目に、たとえば、「接触距離」等の指定値を入力することとなる。なお、教示者の入力操作前においては、操作画面の入力項目には、動作条件パラメータ１２ｂに含まれる既定値が表示される。

【0103】

また、たとえば、接触動作調整画面の右側には、力条件調整画面（図５Ｂ参照）と同様の状態モニタや波形モニタといったモニタ表示領域が設けられる。

【0104】

かかるモニタ表示領域には、接触動作調整処理においてロボット３０を接触動作させることによって得られる力波形（図中の波形モニタ（力）参照）や状態遷移波形（図中の波形モニタ（状態遷移）参照）、位置波形（図中の波形モニタ（位置）参照）等が表示される。

【0105】

教示者は、ガイダンスメッセージに従い、ＰＣ２０を操作して「接触距離」等の指定値を入力し、さらに、プログラミングペンダント４０を操作して「接触距離」等の指定値を入力することにより、ロボット３０に対して動作態様の教示を行う。そして、教示者がプログラミングペンダント４０の「開始」ボタンを操作すると、ロボット３０が接触動作を開始する。

【0106】

ロボット３０による接触動作時に力センサ３３によって計測された計測値およびロボット３０（各サーボモータ）からの位置のフィードバック値は、制御装置１０へ送られ、力条件ファイル１２ａに記録される。かかる計測値及びロボット３０（各サーボモータの位置センサ）からの位置のフィードバック値は、ＰＣ２０の動作条件調整部２１ｂによる接触動作調整処理に用いられる。

【0107】

その後、教示者は、接触動作調整画面の左側下段に配置された「調整実行」ボタンを押下することによって、接触動作調整処理を実行させる。つづく図７Ｂには、図７Ａの「調整実行」ボタンが押下され、接触動作調整処理が１回実行された後の接触動作調整画面の一例を示している。図７Ｂに示すように、処理実行後の接触動作調整画面においてもガイダンス画面が表示され、教示者の次なる操作を支援する。

【0108】

一例として、図７Ｂには、図５Ｂと同様に、「モニタを確認して、警告であればＰＰから再調整してください。エラーであれば処理をキャンセルしてください。」とガイダンス表示された例を示している。

【0109】

また、たとえば、ガイダンス画面の下段には、計測結果である接触距離が表示される（図中の閉曲線８０１参照）。教示者は、この計測結果によって、計測値を確認することができる。

【0110】

そして、たとえば、処理実行後の接触動作調整画面の左側下段の領域には、「接触距離」等の指定値の調整結果が表示される。図７Ｂに示すガイダンス画面の指示に沿えば、状態モニタが「警告」であれば、教示者は、プログラミングペンダント４０を操作して、調整後の指定値を入力することにより、ロボット３０に対して接触動作の再教示を行うことができる。

【0111】

そして、教示者がプログラミングペンダント４０の「開始」ボタンを操作すると、ロボット３０が再び接触動作を開始する。その後、教示者は、接触動作調整画面の左側下段に配置された「調整実行」ボタンを押下することによって、接触動作調整処理を実行させる。

【0112】

そして、教示者は、図７Ｂに示すように状態モニタの「正常」が点灯していれば、各波形モニタや計測結果を確認して「終了」ボタンを押下し、調整結果をＰＣ２０に保存させる。また、状態モニタが「エラー」であれば、「キャンセル」ボタンを押下して接触動作調整処理をキャンセルする。

【0113】

つづいて、探り動作の場合について説明する。図８Ａに示すように、探り動作調整画面は、基本的に接触動作調整画面（図７Ａおよび図７Ｂ）と同様の画面レイアウトで構成される。

【0114】

すなわち、ガイダンス画面には、たとえば、図８Ａに示すように、「１．Ｐ１から水平方向にずらした位置Ｐ３（２ｍｍ以内）をＰＰで教示してください。」や「２．移動完了後、設定完了ボタンを押してください。」といった操作手順を示すガイダンスメッセージが表示される。

【0115】

また、ガイダンス画面には、かかるガイダンスメッセージに応じたガイド図があわせて表示される。

【0116】

これにより、教示者の熟練度に関わりなく、教示者が、誤りの少ない、精度の高い教示を行えるよう支援することができる。そして、教示者は、かかるガイダンス画面の内容に従い、探り動作に関する動作条件パラメータ１２ｂの調整に必要な操作を行う。

【0117】

たとえば、教示者は、左側下段の操作画面の入力項目から、「探り周期」や位置Ｐ３の「指定値」等を入力することとなる。ここで、入力される「探り周期」も教示者によって入力される指定値の一種である。なお、教示者の入力操作前においては、操作画面の入力項目には、動作条件パラメータ１２ｂに含まれる既定値や前工程から引き継がれた現在値が表示される。

【0118】

そして、教示者は、プログラミングペンダント４０（ＰＰ）を操作し、「探り周期」等を入力してロボット３０へ探り動作の教示を行う。さらに、教示者がプログラミングペンダント４０の「開始」ボタンを押下すると、ロボット３０が探り動作を開始する。

【0119】

ロボット３０による探り動作時に力センサ３３によって計測された計測値及びロボット３０（各サーボモータの位置センサ）からの位置のフィードバック値は、制御装置１０へ送られ、力条件ファイル１２ａに記録される。かかる計測値及びロボット３０（各サーボモータの位置センサ）からの位置のフィードバック値は、ＰＣ２０の動作条件調整部２１ｂによる探り動作調整処理に用いられる。

【0120】

その後、教示者は、探り動作調整画面の左側下段に配置された「調整実行」ボタンを押下することによって、探り動作調整処理を実行させる。つづく図８Ｂには、図８Ａの「調整実行」ボタンが押下され、探り動作調整処理が１回実行された後の探り動作調整画面の一例を示している。図８Ｂに示すように、処理実行後の探り動作調整画面においてもガイダンス画面が表示され、教示者の次なる操作を支援する。

【0121】

一例として、図８Ｂには、「モニタを確認して、警告であれば、ＰＰから適切に穴に入るように探り周期を再調整してください。エラーであれば処理をキャンセルしてください。」とガイダンス表示された例を示している。

【0122】

そして、たとえば、処理実行後の探り動作調整画面の左側下段の領域には、「探り周期」等の調整結果が表示される。図８Ｂに示すガイダンス画面の指示に沿えば、状態モニタが「警告」であれば、教示者は、プログラミングペンダント４０を操作して、調整後の探り周期を入力することにより、ロボット３０に対して探り動作の再教示を行うことができる。

【0123】

そして、教示者がプログラミングペンダント４０の「開始」ボタンを押下すると、ロボット３０が再び探り動作を開始する。その後、教示者は、探り動作調整画面の左側下段に配置された「調整実行」ボタンを押下することによって、探り動作調整処理を実行させる。

【0124】

そして、教示者は、図８Ｂに示すように状態モニタの「正常」が点灯していれば、各波形モニタや計測結果を確認して「終了」ボタンを押下し、調整結果をＰＣ２０に保存させる。また、状態モニタが「エラー」であれば、「キャンセル」ボタンを押下して探り動作調整処理をキャンセルする。

【0125】

つづいて、挿入動作の場合について説明する。図９Ａに示すように、挿入動作調整画面は、基本的に接触動作調整画面（図７Ａおよび図７Ｂ）と同様の画面レイアウトで構成される。

【0126】

すなわち、ガイダンス画面には、たとえば、図９Ａに示すように、「１．位置Ｐ３へ移動させてから設定完了ボタンを押してください。」や「２．穴底に挿入され、挿入量が計測されるのを確認してください。」といった操作手順を示すガイダンスメッセージが表示される。また、ガイダンス画面には、かかるガイダンスメッセージに応じたガイド図があわせて表示される。

【0127】

これにより、教示者の熟練度に関わりなく、教示者が、誤りの少ない、精度の高い教示を行えるよう支援することができる。そして、教示者は、かかるガイダンス画面の内容に従い、挿入動作に関する動作条件パラメータ１２ｂの調整に必要な操作を行う。

【0128】

たとえば、教示者は、左側下段の操作画面の入力項目から、「閾値１」や「閾値２」、「挿入量」、位置Ｐ３の「指定値」等を入力することとなる。ここで、入力される「閾値１」や「閾値２」も教示者によって入力される指定値の一種である。なお、教示者の入力操作前においては、操作画面の入力項目には、動作条件パラメータ１２ｂに含まれる既定値や前工程から引き継がれた現在値が表示される。

【0129】

そして、教示者は、プログラミングペンダント４０（ＰＰ）を操作し、「閾値１」や「閾値２」、「挿入量」、位置Ｐ３の「指定値」等を入力してロボット３０へ挿入動作の教示を行う。さらに、教示者がプログラミングペンダント４０の「開始」ボタンを押下すると、ロボット３０が挿入動作を開始する。

【0130】

ロボット３０による挿入動作時に力センサ３３によって計測された計測値及びロボット３０（各サーボモータの位置センサ）からの位置のフィードバック値は、制御装置１０へ送られ、力条件ファイル１２ａに記録される。かかる計測値及びロボット３０（各サーボモータの位置センサ）からの位置のフィードバック値は、ＰＣ２０の動作条件調整部２１ｂによる挿入動作調整処理に用いられる。

【0131】

その後、教示者は、挿入動作調整画面の左側下段に配置された「調整実行」ボタンを押下することによって、挿入動作調整処理を実行させる。つづく図９Ｂには、図９Ａの「調整実行」ボタンが押下され、挿入動作調整処理が１回実行された後の挿入動作調整画面の一例を示している。図９Ｂに示すように、処理実行後の挿入動作調整画面においてもガイダンス画面が表示され、教示者の次なる操作を支援する。

【0132】

一例として、図９Ｂには、「モニタを確認して、警告であれば、ＰＰから挿入量が閾値１、２の範囲内に収まるように閾値１、２を調整してください。エラーであれば処理をキャンセルしてください。」とガイダンス表示された例を示している。また、たとえば、ガイダンス画面の下方における調整結果を表示する領域には、挿入量の計測値、「指定値」、調整処理後の「閾値１」および「閾値２」が表示される。

【0133】

図９Ｂに示すガイダンス画面の指示に沿えば、状態モニタが「警告」であれば、教示者は、プログラミングペンダント４０を操作して、「閾値１」や「閾値２」を再入力することにより、ロボット３０に対して挿入動作の再教示を行うことができる。

【0134】

そして、教示者がプログラミングペンダント４０の「開始」ボタンを操作すると、ロボット３０が再び挿入動作を開始する。その後、教示者は、挿入動作調整画面の左側下段に配置された「調整実行」ボタンを押下することによって、挿入動作調整処理を実行させる。

【0135】

そして、教示者は、図９Ｂに示すように状態モニタの「正常」が点灯していれば、各波形モニタや計測結果を確認して「終了」ボタンを押下し、調整結果をＰＣ２０に保存させる。また、状態モニタが「エラー」であれば、「キャンセル」ボタンを押下して挿入動作調整処理をキャンセルする。

【0136】

次に、実施形態に係るＰＣ２０が実行する処理手順について、図１０を用いて説明する。図１０は、実施形態に係るＰＣ２０が実行する処理手順を示すフローチャートである。ＰＣ２０は、制御装置１０に接続され、教示者によって力条件調整処理または動作条件調整処理を行う操作を受け付けた場合に、図１０に示すフローチャートに示す処理を実行する。

【0137】

具体的には、ＰＣ２０は、図１０に示すように、表示部２４によって教示操作画面を表示させる（ステップＳ１０１）。このとき、ＰＣ２０は、教示者による操作に応じて、力条件調整画面、接触動作調整画面、探り動作調整画面、挿入動作調整画面のうち、いずれかの教示操作画面を表示させる。

【0138】

続いて、ＰＣ２０は、教示者によってパラメータが入力されたか否かを判定する（ステップＳ１０２）。ここで、ＰＣ２０は、パラメータが入力されない場合（ステップＳ１０２，Ｎｏ）、パラメータが入力されるまで、ステップＳ１０２の判定処理を繰り返す。そして、ＰＣ２０は、パラメータが入力されると（ステップＳ１０２，Ｙｅｓ）、制御装置１０からロボット３０の動作に伴うフィードバック値を取得する（ステップＳ１０３）。

【0139】

続いて、ＰＣ２０は、調整実行操作があるか否かを判定する（ステップＳ１０４）。ここで、ＰＣ２０は、調整実行操作がない場合（ステップＳ１０４，Ｎｏ）、調整実行操作があるまで、ステップＳ１０４の判定処理を繰り返す。そして、ＰＣ２０は、調整実行操作があった場合（ステップＳ１０４，Ｙｅｓ）、パラメータの調整を行って表示部２４に調整結果を表示させる（ステップＳ１０５）。

【0140】

続いて、ＰＣ２０は、教示操作画面の状態モニタが「正常」であるか否かを判定し（ステップＳ１０６）、状態モニタが「正常」であった場合（ステップＳ１０６，Ｙｅｓ）、終了操作があるか否かを判定する（ステップＳ１０７）。ここで、ＰＣ２０は、終了操作がない場合（ステップＳ１０７，Ｎｏ）、終了操作があるまで、ステップＳ１０７の判定処理を繰り返す。そして、ＰＣ２０は、終了操作があった場合（ステップＳ１０７，Ｙｅｓ）、調整結果情報２２ｂを記憶して（ステップＳ１０８）、処理を終了する。

【0141】

一方、ステップＳ１０６において、状態モニタが「正常」でなかった場合（ステップＳ１０６，Ｎｏ）、ＰＣ２０は、状態モニタが「警告」であるか否かを判定する（ステップＳ１０９）。そして、ＰＣ２０は、状態モニタが「警告」であった場合（ステップＳ１０９，Ｙｅｓ）、処理をステップＳ１０２へ移す。

【0142】

一方、状態モニタが「警告」でなかった場合（ステップＳ１０９，Ｎｏ）、ＰＣ２０は、状態モニタが「エラー」であると判断し、キャンセル操作があるか否かを判定する（ステップＳ１１０）。ここで、ＰＣ２０は、キャンセル操作がない場合（ステップＳ１１０，Ｎｏ）、キャンセル操作があるまで、ステップＳ１１０の判定処理を繰り返す。そして、ＰＣ２０は、キャンセル操作があった場合（ステップＳ１１０，Ｙｅｓ）、処理を終了する。

【0143】

上述してきたように、実施形態に係るロボットシステムにおいてロボット教示補助装置として機能するＰＣは、操作部と、調整部と、画面生成部とを備える。かかるＰＣの操作部は、センサの計測値に基づいてロボットの動作態様を修正することを含む動作命令を定義するための指定値の入力操作を受け付ける。

【0144】

そして、ＰＣの調整部は、入力された指定値、および、センサの計測値に基づいて、ロボットの動作態様を修正するパラメータを調整する。さらに、ＰＣの画面生成部は、ロボットへ動作態様を教示する教示装置へのパラメータの入力に関するガイダンス情報を含む教示操作画面を生成する。

【0145】

したがって、実施形態に係るロボットシステムによれば、教示者は、教示操作画面のガイダンス情報に従ってプログラミングペンダントを操作することにより、熟練度に関わりなく、簡易な操作で効率的かつ高精度な教示を行うことができる。

【0146】

なお、上述した実施形態では、力条件調整部、動作条件調整部がＰＣに設けられる場合について説明したが、力条件調整部、動作条件調整部は、制御装置に設けられてもよい。かかる場合、ＰＣは、制御装置から調整後の各種パラメータを取得し、取得した調整後のパラメータとガイダンス情報とを含む教示操作画面を表示させる構成とする。

【0147】

かかる構成によっても、教示者は、教示操作画面のガイダンス情報に従ってプログラミングペンダントを操作することにより、熟練度に関わりなく、簡易な操作で効率的かつ高精度な教示を行うことができる。

【0148】

また、上述した実施形態では、操作部と表示部とを別体として構成したが、たとえば、マルチタッチ対応のタッチパネル等で操作部と表示部とを一体化する構成としてもよい。また、上述した実施形態では、ロボットが、腕を有するいわゆる人型ロボットである場合を例に挙げて説明したが、ロボットが人型でなくともよい。

【0149】

さらなる効果や変形例は、当業者によって容易に導き出すことができる。このため、本発明のより広範な態様は、以上のように表しかつ記述した特定の詳細および代表的な実施形態に限定されるものではない。したがって、添付の特許請求の範囲およびその均等物によって定義される総括的な発明の概念の精神または範囲から逸脱することなく、様々な変更が可能である。

【符号の説明】

【0150】

１ ロボットシステム
１０ 制御装置
１１ 制御部
１１ａ ジョブ生成部
１１ｂ 動作指示部
１２ 記憶部
１２ａ 力条件ファイル
１２ｂ 動作条件パラメータ
１２ｃ ジョブ情報
２０ ＰＣ
２１ 制御部
２１ａ 力条件調整部（第１の調整部）
２１ｂ 動作条件調整部（第２の調整部）
２１ｃ 画面生成部
２２ 記憶部
２２ａ ガイダンス情報
２２ｂ 調整結果情報
２３ 操作部
２４ 表示部
３０ ロボット
３１ アーム
３２ ハンド
３３ 力センサ
４０ プログラミングペンダント
Ｗ、Ｗ１、Ｗ２ ワーク

【図1】

【図2】

【図3A】

【図3B】

【図3C】

【図4A】

【図4B】

【図4C】

【図4D】

【図5A】

【図5B】

【図6A】

【図6B】

【図6C】

【図7A】

【図7B】

【図8A】

【図8B】

【図9A】

【図9B】

【図10】