(57)【特許請求の範囲】
【請求項１】
作業内容を制御可能なロボットハンドの複数の作業対象物が搭載されたトレイが、前記ロボットハンドによって作業が行われるべき位置に載置された状態で、前記作業対象物のすべてが含まれ且つそれぞれの全体が写るように撮像する撮像工程と、
この撮像工程で撮像された画像データから前記作業対象物それぞれを検出するとともに、検出された前記作業対象物それぞれの正常位置に対する位置誤差が許容範囲内か否かを判定する画像処理工程と、
前記作業対象物それぞれに対して、前記画像処理工程で前記位置誤差が前記許容範囲内と判定されていれば通常作業を実行するとともに、前記位置誤差が前記許容範囲内ではないと判定されていれば前記通常作業を実行しない、という処理を順に行う作業実行工程と
を含むことを特徴とするロボット制御方法。
【請求項２】
請求項１に記載のロボット制御方法において、
前記作業実行工程で前記通常作業を実行中に異常が発生した場合には、前記撮像工程および前記画像処理工程を再び順に行うことを特徴とするロボット制御方法。
【請求項３】
請求項２に記載のロボット制御方法において、
前記異常とは、前記ロボットハンドが前記作業対象物を把持する際の不具合であることを特徴とするロボット制御方法。
【請求項４】
作業内容を制御可能なロボットハンドを有するロボットと、
前記ロボットハンドの複数の作業対象物が搭載されたトレイが、前記ロボットハンドによって作業が行われるべき位置に載置された状態で、前記作業対象物のすべてが含まれ且つそれぞれの全体が写るように撮像する撮像部と、
この撮像部で撮像された画像データから前記作業対象物それぞれを検出するとともに、検出された前記作業対象物それぞれの正常位置に対する位置誤差が許容範囲内か否かを判定する画像処理部と、
前記作業対象物それぞれに対して、前記画像処理部で前記位置誤差が前記許容範囲内と判定されていれば通常作業を実行するとともに、前記位置誤差が前記許容範囲内ではないと判定されていれば前記通常作業を実行しない、という処理を順に行うように前記ロボットハンドの作業の実行を制御する作業実行制御部と
を備えることを特徴とするロボット制御システム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ロボット制御方法およびロボット制御システムに関し、特に、いわゆる「チョコ停」の未然防止や「チョコ停」からの自動復帰を可能とするロボット制御システムおよびロボット制御方法に関する。
【背景技術】
【０００２】
産業用ロボットは、一般に、旋回可能かつ上下動可能なロボットアームと、ロボットアームの先端に設けられ、ワーク（部品）を把持するためのチャック部を有するロボットハンドと、ロボットアームおよびロボットハンドを所定の制御プログラムにしたがって駆動制御する制御部とを備えている。また、自動組立装置は、ワークテーブル面上のそれぞれ所定位置に配置された、多数の部品を収容する複数の部品供給トレイと、部品の組立を行うための組立用治具とを有している。
【０００３】
自動組立装置の運転時には、ロボットアームを駆動して、ロボットハンドを所定の部品供給トレイの位置まで移動させ、先端のチャック部で部品を把持する。この状態から、ロボットアームを駆動して、ロボットハンドを組立用治具の位置まで移動させ、チャック部に把持されていた部品を組立用治具に組み付ける。以下、同様の動作を繰り返すことにより、所望の機器が自動的に組み立てられることになる。
【０００４】
このような産業用ロボットを含む自動組立装置においては、自動運転を開始する前に、ロボットに対して動作基準座標や動作手順等を教示するティーチングという作業が必要になる。従来のティーチング作業では、パソコン上のコンピュータシミュレーションなどにより、概略の座標位置を求めた後、作業者が、ティーチングペンダントやティーチングボックスを用いて実際にロボットハンドをマニュアル操作することにより、正確な座標位置の設定を行うようにしている（例えば、特許文献１および特許文献２参照）。
【０００５】
上述したティーチング作業では、細かな座標位置の設定が非常に煩雑であって所要時間も長くなるという問題点があったため、ティーチング作業の簡略化およびティーチング時間の短縮を可能とする技術も提案されている（例えば、特許文献３参照）。
【０００６】
この特許文献３で提案されているロボット制御システムは、ロボットアームと、ロボットアームの先端に設けられ、ワーク把持用チャック部を有するロボットハンドとを含むロボットと、前記ロボットに対してティーチング入力を行うための操作部と、少なくともワークを撮影できるカメラ部と、前記操作部にティーチング入力された所定の座標位置を前記カメラ部で撮影された画像に基づいて補正して、補正された座標位置に移動するように前記ロボットを駆動制御する制御部と、を備えることを特徴とするものである。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特開２０００−３５４９１９号公報
【特許文献２】特開２００６−０４３８４４号公報
【特許文献３】特開２００９−０００７８２号公報
【発明の概要】
【発明が解決しようとする課題】
【０００８】
しかしながら、上述のような従来技術においてティーチングペンダントなどによるティーチング作業を行う際、少なくとも初回はロボットハンドの位置や向きを複雑に変更させることを繰り返す必要がある。そのため、ティーチング作業はやはり非常に煩雑であって所要時間も長かった。
【０００９】
最近では、ロボット導入台数の増加および製品の多種多様化に伴い、必要とされるティーチング工数が急増している。一方で、製造現場では慢性的に人員が不足しており、特にティーチング作業の熟練者が極めて不足している。また、製造現場で実際に使用されているロボットにティーチングを行うときには、そのロボットが設置されている製造ラインなどが停止することになるので、その製造ラインの稼働率が低下してしまう。
【００１０】
また、ロボットの個体差による誤差、ロボットハンドや部品供給トレイ、組立用治具などの各種モジュールの設置時に生じる誤差、チャック部や組立用治具自体の個体差による誤差があるため、ロボット等を設置し直すごとにティーチングを行わなければならず、ティーチング作業に長時間を要していた。
【００１１】
とくに、小さな機器の組立装置の場合には、操作者が装置の中に頭を突っ込んで無理な態勢でティーチング作業を行わなければならない場合もあり、操作者にとって、とても安全かつフレンドリーな作業環境とはいえないものであった。
【００１２】
さらに、ロボットの自動組立を継続して行うと、ロボットアーム自身の位置ずれやロボットハンドの位置ずれが発生して累積し、あるいはワークの位置ずれにより、自動運転中に組立を継続して行えないというトラブルが発生して、ロボットが停止するといういわゆる「チョコ停」（すなわち、機械の故障ではなく、一時的なトラブルに起因した機械の停止状態）が発生していた。
【００１３】
上記の特許文献３では、この「チョコ停」を未然防止するための技術が提案されている。しかし、気温・湿度などの季節変化による材質変化や，部品自体の形状異常，設備の劣化など、防ぐことが困難な要因もあり，どうしても「チョコ停」発生のリスクは残る。
【００１４】
従来技術のこのような課題に鑑み、本発明の第１の目的は、主として部品供給トレイなどに搭載された作業対象部品などの位置ずれに起因する「チョコ停」の未然防止を可能とするロボット制御方法およびロボット制御システムを提供することである。
【００１５】
また、本発明の第２の目的は、未然防止だけでは防ぎきれない「チョコ停」が発生した場合であっても、可能であれば自動的に復帰動作を行うことでロボットやロボット制御システム全体を極力停止させることがないロボット制御方法およびロボット制御システムを提供することである。
【課題を解決するための手段】
【００１６】
上記の第１の目的を達成するため、本発明のロボット制御方法は、作業内容を制御可能なロボットハンドの複数の作業対象物が搭載されたトレイが、前記ロボットハンドによって作業が行われるべき位置に載置された状態で、前記作業対象物のすべてが含まれ且つそれぞれの全体が写るように撮像する撮像工程と、この撮像工程で撮像された画像データから前記作業対象物それぞれを検出するとともに、検出された前記作業対象物それぞれの正常位置に対する位置誤差が許容範囲内か否かを判定する画像処理工程と、前記作業対象物それぞれに対して、前記画像処理工程で前記位置誤差が前記許容範囲内と判定されていれば通常作業を実行するとともに、前記位置誤差が前記許容範囲内ではないと判定されていれば前記通常作業を実行しない、という処理を順に行う作業実行工程とを含むことを特徴とする。
【００１７】
ここで、作業とは、例えば部品の自動組立などが挙げられるが、これには限られない。作業対象物とは、例えば、電気部品や機械部品などの各種部品が挙げられるが、これには限られない。
【００１８】
このような構成のロボット制御方法によれば、トレイ上に載置された複数の作業対象物の一部に位置ずれが発生していても、そのような位置ずれが発生している作業対象物に対してはロボットハンドによる通常作業を実行しない。これにより、作業対象物の位置ずれに起因するいわゆる「チョコ停」の未然防止が可能となって、ロボットやロボット制御システム全体の稼働率が向上する。
【００１９】
また、本発明のロボット制御方法において、前記作業実行工程で前記通常作業を実行中に異常が発生した場合には、前記撮像工程および前記画像処理工程を再び順に行うようにしてもよい。前記異常とは、例えば、前記ロボットハンドが前記作業対象物を把持する際の不具合（エラー）などが挙げられるが、これには限られない。
【００２０】
このような構成のロボット制御方法によれば、異常状態から回復できて同様のエラーの再発を防止できる可能性がある。これにより、偶発的な要因などによる「チョコ停」の未然防止も可能となり、ロボットやロボット制御システム全体の稼働率がさらに向上する。
【００２１】
あるいは、上記の第１の目的を達成するため、本発明のロボット制御方法は、作業内容を制御可能なロボットハンドを有するロボットと、前記ロボットハンドの複数の作業対象物が搭載されたトレイが、前記ロボットハンドによって作業が行われるべき位置に載置された状態で、前記作業対象物のすべてが含まれ且つそれぞれの全体が写るように撮像する撮像部と、この撮像部で撮像された画像データから前記作業対象物それぞれを検出するとともに、検出された前記作業対象物それぞれの正常位置に対する位置誤差が許容範囲内か否かを判定する画像処理部と、前記作業対象物それぞれに対して、前記画像処理部で前記位置誤差が前記許容範囲内と判定されていれば通常作業を実行するとともに、前記位置誤差が前記許容範囲内ではないと判定されていれば前記通常作業を実行しない、という処理を順に行うように前記ロボットハンドの作業の実行を制御する作業実行制御部とを備えることを特徴とする。
【００２２】
このような構成のロボット制御システムによれば、トレイ上に載置された複数の作業対象物の一部に位置ずれが発生していても、そのような位置ずれが発生している作業対象物に対してはロボットハンドによる通常作業を実行しない。これにより、作業対象物の位置ずれに起因するいわゆる「チョコ停」の未然防止が可能となって、ロボットやロボット制御システム全体の稼働率が向上する。
【発明の効果】
【００２７】
本発明のロボット制御方法およびロボット制御システムによれば、トレイ上に載置された複数の作業対象物の一部に位置ずれが発生していても、そのような位置ずれが発生している作業対象物に対してはロボットハンドによる通常作業を実行しない。これにより、作業対象物の位置ずれに起因するいわゆる「チョコ停」の未然防止が可能となって、ロボットやロボット制御システム全体の稼働率が向上する。
【００２８】
あるいは、本発明のロボット制御方法およびロボット制御システムによれば、各種の未然防止策だけでは防ぎきれない「チョコ停」が発生した場合であっても、可能であれば自動的に復帰動作を行う。これにより、作業者やメインテナンス要因が介在することなく、ロボットを長時間にわたって連続稼働させることができ、ロボット制御システム全体の稼働率もより一層向上する。
【図面の簡単な説明】
【００２９】
【図１】本発明の第１実施形態に係るロボット制御システム１の平面概略図である。
【図２】ロボット制御システム１で制御されるロボット３の側面斜視図である。
【図３】ロボット３が有するロボットアーム３０の先端に設けられるロボットハンド３１の拡大斜視図である。
【図４】ロボット制御システム１のティーチングに使用されるティーチングペンダント１０の正面拡大図である。
【図５】ロボット制御システム１の制御部１００のブロック構成図である。
【図６】小型カメラ３４によって撮像されてすべての作業対象部品Ｐが写っている画像が、パソコン１１０の画面に表示された一例を示す図である。
【図７】「チョコ停」の発生箇所およびその周辺を撮像した現画像データが、パソコン１１０の画面に表示された一例を示す図である。
【発明を実施するための形態】
【００３０】
以下、本発明の実施形態を、図面を参照して説明する。
【００３１】
＜＜＜第１実施形態＞＞＞
＜ロボット制御システム１の構成＞
図１は本発明の第１実施形態に係るロボット制御システム１の平面概略図である。図２はこのロボット制御システム１で制御されるロボット３の側面斜視図である。図３はこのロボット３が有するロボットアーム３０の先端に設けられるロボットハンド３１の拡大斜視図である。図４はロボット制御システム１のティーチングに使用されるティーチングペンダント１０の正面拡大図である。
【００３２】
図１に示すように、ロボット制御システム１は、ワークテーブル２上に離隔配置された２つの組立用ロボット３、４を備えている。ロボット３、４はいずれも多関節ロボットであって、複数のロボットアーム３０、４０をそれぞれ有している。先端側のロボットアーム３０、４０の先端には、ロボットハンド３１、４１がそれぞれ設けられている。
【００３３】
ワークテーブル２上の一側部には、それぞれ多数の部品（ワーク）（図示せず）を収容する複数の部品供給トレイ５、６が整列して配置されている。これらの部品供給トレイ５、６は、図示しない搬入装置によって、ワークテーブル２上に搬入されるようになっている。ワークテーブル面２上において、略中央位置には、各ロボット３、４により部品の組立作業が行われる組立用治具７が取り付けられている。ワークテーブル２の下方には、それぞれロボット３、４を駆動制御するためのコントローラＡ、Ｂが設けられている。また、ワークテーブル２の一側方には、ロボットアーム３０、４０の可動範囲全体を撮影するための可搬型カメラ８が配置されている。可搬型カメラ８は、広角レンズを有し、ズーム機能およびパン機能を有しているものが好ましい。
【００３４】
ロボット３は、図２に示すように、先端側のロボットアーム３０の先端に着脱自在なロボットハンド３１を有している。ロボットハンド３１には、複数のワーク把持用チャック部３２が設けられている。
【００３５】
チャック部３２は、図３に示すように、支持台３３に支持されている。支持台３３には、チャック部３２を駆動する駆動機構が内蔵されている。ロボットハンド３１は、ベース板３１Ａを有している。図示された４つの支持台３３のうちの一つが、ベース板３１Ａ上において図示矢印方向に移動可能に設けられており、この移動可能な支持台３３の側面には、チャック部３２の先端を撮影するための小型カメラ（例えば、ビジョンカメラまたはＣＣＤカメラ）３４が取り付けられている。
【００３６】
なお、ロボット４のロボットハンド４１についても同様の構成を有しているため、ここでは、説明を省略する。
【００３７】
また、このロボット制御システム１は、図４に示すようなティーチングペンダント（操作部）１０を有している。ティーチングペンダント１０は、ロボットハンド３１のカメラ３４で撮影された画像を表示するためのＬＣＤ（液晶）ディスプレイ１１と、操作者が握るための左右のグリップ１２、１３と、非常停止スイッチ１４とを備えている。
【００３８】
ディスプレイ１１は、タッチパネル式のディスプレイである。また、ディスプレイ１１の左右両側には、起動、停止、ティーチングなどのロボット操作用の押しボタンスイッチ１１ａが複数個設けられている。グリップ１２の裏面には、ティーチング時や試運転時などの非定常作業時に操作者が危険を回避するための３ポジション方式のイネーブルスイッチ１５（図５参照）が設けられている。
【００３９】
次に、ロボット制御システム１の制御部について図５を用いて説明する。この図５はロボット制御システム１の制御部１００のブロック構成図である。
【００４０】
制御部１００は記憶部とコンピュータを含んでいる。記憶部は以下に説明するロボット制御方法を実行するためのコンピュータプログラムが記憶され、コンピュータは当該プログラムを実行する。詳細には制御部１００は、ロボット３のコントローラＡと、ロボット４のコントローラＢと、パソコン１１０とを含んで構成されている。コントローラＡ、Ｂは互いに通信可能に構成されている。
【００４１】
コントローラＡの入力側には、ティーチングペンダント１０がワイヤレスで接続されている。ティーチングペンダント１０には、上述したように、タッチパネル式のディスプレイ１１、非常停止スイッチ１４およびイネーブルスイッチ１５が接続されている。また、コントローラＡの入力側には、小型カメラ３４および可搬型カメラ８が接続されている。
【００４２】
コントローラＡの出力側には、ロボットアーム３０およびロボットハンド３１を駆動するためのモータｍａ1〜ｍａnが接続されている。また、コントローラＡの出力側には、自動運転中の「チョコ停」の発生時に仕掛品をワークテーブル２上から撤去するための撤去装置１０５が接続されている。この撤去装置１０５は、ロボットハンド３１に設けられており、好ましくは、ロボットハンド３１におけるいずれかのチャック部３２が撤去装置１０５として機能している。なお、ワークテーブル２上に向けて圧搾空気を噴出させるためのエアーノズルを撤去装置１０５に設けるようにしてもよいし、このエアーノズルをロボットハンド３１に設けるようにしてもよい。
【００４３】
コントローラＡの出力側には、さらにパソコン１１０が接続されている。パソコン１１０は、ティーチング時のシミュレーションを行うだけでなく、可搬型カメラ８で撮影した自動運転中の映像をモニターするのに用いられている。パソコン１１０は、コントローラＡに無線ＬＡＮで接続されている。なお、自動運転中の映像は、ティーチングペンダント１０に表示するようにしてもよい。
【００４４】
一方、コントローラＢの入力側には、同様にロボット４において、ロボットハンド４１のチャック部の支持台に設けられた小型カメラ４４が接続されている。また、コントローラＢの出力側には、ロボットアーム４０およびロボットハンド４１を駆動するためのモータｍｂ1〜ｍｂnと、撤去装置１０５と同様の撤去装置１０６とが接続されている。
【００４５】
＜ロボット制御システム１の処理の流れ＞
第１実施形態に係るロボット制御システム１で、ロボット３によって行われる処理の流れは概ね次の通りである。
【００４６】
（１）部品供給トレイ５上に搭載された作業対象部品を小型カメラ３４で撮像
まず、複数の作業対象部品Ｐが搭載された部品供給トレイ５が、ロボットハンド３１によって作業が行われるべき所定位置に置かれた状態で、ロボットハンド３１を移動して、ロボットハンド３１に取り付けられた小型カメラ３４が、部品供給トレイ５の中心の真上に来るようにする。
【００４７】
そして、そこから小型カメラ３４が真下を見下ろすようにしてすべての作業対象部品Ｐが含まれるように撮影する。このようにすれば、撮像データにおいて各作業対象部品Ｐの周辺のものが歪んだり欠けたりすることもなく、画像処理による各作業対象部品Ｐの検出がしやすくなって位置精度も高まる。撮像した画像データから検出可能な作業対象部品Ｐの位置精度をできるだけ高めるには、すべての作業対象部品Ｐが含まれる限りでなるべく大きめの倍率となるような近い距離から撮像することが好ましい。
【００４８】
このようにして撮像されてすべての作業対象部品Ｐが写っている画像が、パソコン１１０の画面に表示された一例を図６に示す。この表示例では、３０個の同一の作業対象部品Ｐが部品供給トレイ５で５行×６列に等間隔で配置されている。
【００４９】
なお、以下の説明で、これらの作業対象部品Ｐのいずれかを特定する必要がある場合には、参照符号Ｐに番号（１〜３０）を付加して区別を行うことにする。番号は、図６に示すように、左端の列の一番上を１として、その列の下方へ順に２、３、４、５とし、次はその右の列の一番上を６とし、その列の下方へ順に７、８、９、１０というふうに定める。例えば、左上の作業対象部品はＰ１、その右の作業対象部品はＰ６、右下の作業対象部品はＰ３０ということになる。
【００５０】
（２）撮像された画像から作業対象部品の位置誤差を算出
小型カメラ３４によって撮像された画像をパソコン１１０によって画像処理することによって、その画像データから各作業対象部品Ｐを検出する。そして、検出された各作業対象部品Ｐの実際の正確な位置を算出するとともに、それぞれの正常位置データとの比較によって各作業対象部品Ｐの位置誤差を算出する。
【００５１】
算出された位置誤差が許容範囲内（例えば、所定値よりも小さいなど）であれば、その作業対象部品Ｐの位置ずれは生じていないと判定する。一方、算出された位置誤差が許容範囲を超えていれば、その作業対象部品Ｐには位置ずれが生じていると判定する。各作業対象部品Ｐについての判定結果は保存しておき、次の（３）で参照できるようにする。
【００５２】
図６に示した例では、例えば、左上の作業対象部品Ｐ１には位置ずれは生じていないが、その右の作業対象部品Ｐ６には位置ずれが生じていることがわかる。
【００５３】
（３）各作業対象部品Ｐに対する作業を順に実行
次に、部品供給トレイ５上に搭載された各作業対象部品Ｐに対して、ロボットハンド３１による通常作業を順に実行する。
【００５４】
ただし、この通常作業の実行に先立って上記の（２）で保存された判定結果を参照し、位置ずれが生じていると判定されていた作業対象部品Ｐに対しては通常作業を実行せずにスキップする。そして、次の作業対象部品Ｐについての処理へ移行する。つまり、ロボットハンド３１による通常作業は、位置ずれが生じていないと判定されていた作業対象部品Ｐのみに対して順次実行されることになる。
【００５５】
なお、通常作業の実行の際、例えば、部品供給トレイ５上に搭載された作業対象部品Ｐをロボットハンド３１で把持しようとしたときにエラーが発生するなど、なんらかの偶発的な要因によって異常があったときには、上記の（１）における作業対象部品Ｐの撮像に問題があったり、（２）における各作業対象部品Ｐの位置誤差の算出が正確ではなかったりといった可能性が考えられる。そのような場合は、ロボットハンド３１による通常作業を一旦中止するなどしてから、上記の（１）および（２）を順に再び行うことが好ましい。異常状態から回復できて同様のエラーの再発を防止できる可能性があるからである。
【００５６】
以上で説明した第１実施形態によれば、部品供給トレイ５上に載置された複数の作業対象部品Ｐの一部に位置ずれが発生していても、そのような位置ずれが発生している作業対象部品Ｐに対してはロボットハンド３１による通常作業を実行しない。これにより、作業対象部品Ｐの位置ずれに起因するいわゆる「チョコ停」の未然防止が可能となって、ロボット３やロボット制御システム１全体の稼働率が向上する。
【００５７】
また、上記（１）及び（２）の処理を、トレイ５上の作業対象部品をロボットハンド３１で把持などの処理する度に直前に行ってもよいが、上記説明したように部品供給トレイ５がワークテーブル２上の所定の場所に配置した時点でトレイ５上の全ての作業対象部品を一括で行うことにより、組立工程全体を処理するタクトタイムが影響を受けて長くなることを防止できる。特に、上記の（２）のような画像処理には一定の時間を要することもあり得るが、通常の場合は、ロボットハンド３１によって作業が行われるべき所定位置に部品供給トレイ５が置かれた後に１回だけ実行されるに過ぎない。ロボットハンド３１が各作業対象部品Ｐを把持などの処理する度に画像処理を行うわけではないので、組立工程がスムーズに行われるとともに全体のタクトタイムが影響を受けて大幅に長くなることも防止できる。
【００５８】
なお、通常作業の実行の際になんらかの異常があったときには、上記の（１）および（２）を順に再び行うようにすれば、異常状態から回復できて同様のエラーの再発を防止できる可能性がある。これにより、偶発的な要因などによる「チョコ停」の未然防止も可能となり、ロボット３やロボット制御システム１全体の稼働率がさらに向上する。
【００５９】
なお、ロボット３のロボットハンド３１に設けられた小型カメラ３４を用いたが、これに代えて可搬型カメラ８を用いてもよい。この場合、可搬型カメラ８は部品供給トレイ５を見下ろすように撮影できるように設置されることが望ましい。
【００６０】
＜＜＜第２実施形態＞＞＞
上述の第１実施形態や従来技術に限らず、「チョコ停」を未然防止するための各種対策を施したとしても、「チョコ停」の発生を完全に防止できるわけではない。例えば、気温・湿度などの季節変化による材質変化や，部品自体の形状異常，設備の劣化など、防ぐことが困難な要因もあり，どうしても「チョコ停」発生のリスクは残るからである。
【００６１】
そこで、各種の未然防止策だけでは防ぎきれない「チョコ停」が発生した場合であっても、可能であれば自動的に復帰動作を行うように構成したロボット制御方法およびロボット制御システムを第２実施形態として、第１実施形態と相違する点を中心に、以下で説明する。
【００６２】
この第２実施形態では、可搬型カメラ８は、図１に示されているような位置よりは、むしろ、天井付近からロボット制御システム１全体を見下ろせるように配置するとともに、ズーム機能やパン機能も適宜使用することが好ましい。また、この可搬型カメラ８で撮像される画像が、パソコン１１０の画面に表示されるようにしておく。なお、可搬型カメラ８とは異なる専用のカメラなどを使用してもかまわないし、ロボット３のロボットハンド３１に設けられた小型カメラ３４を用いてもよい。この場合、後述の（１）で検出された発生箇所およびその周辺を含んで小型カメラ３４が撮像できるように、ロボットハンド３１を動かす。
【００６３】
なお、まずは、次の（ａ）〜（ｃ）のような事前学習（事前準備）をするとともに、その結果をパソコン１１０にデータベースなどとして記録（保存）しておく必要がある。
【００６４】
＜事前学習＞
（ａ）各工程における対象エリアの本来あるべき姿の事前学習
ロボット制御システム１によって制御されるロボット３やロボット４の各種作業の各工程において、その工程が行われている対象エリアの本来あるべき姿を、可搬型カメラ８によって撮像し、その画像データをパソコン１１０（のハードディスクなど）に保存するとともに検索などが容易にできるような登録を行っておく。つまり、各工程の正常時画像データの保存および登録をしておくことになる。
【００６５】
（ｂ）復帰対象とする異常状態の事前学習
「チョコ停」には様々な要因が存在し得るが、自動復帰が可能な異常状態もあれば、自動復帰が原理的に不可能で作業者による復旧作業が不可欠な異常状態もある。そこで、自動復帰可能な異常状態について、復帰対象として事前学習させるとともにパソコン１１０に登録しておく。
【００６６】
自動復帰可能な異常状態としては、例えば、次のようなものが挙げられる。
【００６７】
・ロボットハンド３１が仕掛品を把持したまま
・組立工程が施されていない部品が残存
・仕掛品が散乱
（ｃ）復帰対象とする異常状態からの復帰動作の事前学習
自動復帰が可能な異常状態によっては、唯一の復帰動作しか存在しないものもあれば、複数の復帰動作が想定できるものもある。そこで、復帰対象とする異常状態のぞれぞれについて、いずれかを選択可能な１つ以上の復帰動作を事前学習させるとともにパソコン１１０に登録しておく。また、複数の復帰動作が選択可能な場合は、どのような基準で選択すべきかについても併せて登録しておくことが好ましい。
【００６８】
＜「チョコ停」からの自動復帰処理の流れ＞
第２実施形態による「チョコ停」からの自動復帰は、専ら次の（１）〜（６）の各ステップによって行われる。
【００６９】
（１）「チョコ停」の発生箇所の検出
ロボット３やロボット４による組立などの工程中に「チョコ停」が発生した場合、その工程が行われていた発生箇所を、ロボット３、４の動作工程や各種センサーなどのエラー情報などに基づいて検出する。「チョコ停」が発生した工程・場所は、ロボット制御システム１の工程の進捗度合、異常検知の結果およびタイミングなどから大凡の見当がつくからである。
【００７０】
（２）「チョコ停」の発生箇所およびその周辺の撮像
上記の（１）で検出された発生箇所およびその周辺が含まれるように、可搬型カメラ８によって撮像し、「チョコ停」発生後における発生箇所の現在の画像データ（現画像データ）を取得する。
【００７１】
このようにして撮像された現画像データは、作業者などが容易に視認できるように、パソコン１１０の画面に表示するようにしてもよい。
【００７２】
（３）異常エリア検索
上記の（２）で撮像された現画像データと、上記の（ａ）で事前学習して登録されている正常時画像データの中から選択した対応する画像データとの比較を行う。比較の結果、相対的に大きな差がある部分が存在するか否かを検索し、そのような部分が存在すれば異常エリアとして検出する。
【００７３】
例えば、特定の部品などが破損していて正常品の形状と大きく異なっていれば、その特定部品の位置が検出されることになる。
【００７４】
（４）異常エリア識別
上記の（３）で検出された異常エリアにおける異常が、上記の（ｂ）で事前学習して登録されている自動復帰可能な異常状態のいずれに該当するかを識別する。
【００７５】
例えば、上記の（３）で特定部品の位置が検出されていたとすると、その異常部品の状態を識別することになる。
【００７６】
（５）復帰動作の決定
上記の（４）で該当すると識別された異常状態に応じた復帰動作を、上記の（ｃ）で事前学習して登録されている対応する１つ以上の復帰動作のうちの最適なものに決定する。
【００７７】
（６）異常エリア計測
上記の（３）で検出された異常エリアにおいて、上記の（４）で該当すると識別された異常状態についての計測を行う。
【００７８】
例えば、上記の（３）で特定部品の位置が検出されていたとすると、その異常部品の状態について、正確な座標位置や姿勢などを計測することになる。
【００７９】
（７）復帰動作の実行
上記の（６）で計測された結果に基づいて、上記の（５）で決定された最適な復帰動作を実行する。これにより、上記の（３）で検出された異常エリアにおける異常状態が解消されることになる。
【００８０】
その後、上記の（２）に戻り、以降の各ステップを異常エリアがなくなるまで順に繰り返す。このようにして、「チョコ停」を発生させた要因がすべて解消されると、ロボット３やロボット４の各種作業を再開することができる。
【００８１】
＜「チョコ停」からの自動復帰処理の具体例＞
例えば、部品供給トレイ５からの作業対象部品Ｐの把持に失敗したことで「チョコ停」が発生し，その作業対象部品Ｐが落ちて裏返し状態になっている状況を想定する。また、復帰動作として、ロボットハンド３１には作業対象部品Ｐを吸着するためのバキューム装置を取り付けていることにする。
【００８２】
このような場合に、上記の（２）で撮像された現画像データがパソコン１１０の画面に表示された一例を図７に示す。なお、この図７では、部品の裏側をハッチングで模式的に示しており、詳細な形状などの図示は省略している。
【００８３】
この表示例では、部品供給トレイ５に設けられた５行×６列の等間隔の窪みのうち、左端列の５箇所全部とその右列の上側２箇所を除いたところに、合計２３個の同一の作業対象部品Ｐがそれぞれ搭載されている。しかし、左から２列目の中央の作業対象部品Ｐは裏返っており、位置ずれもやや生じている。
【００８４】
この裏返っている作業対象部品Ｐの位置は、上記の（３）の異常エリア検索によって検出される。上記の（４）の異常エリア識別によって、作業対象部品Ｐが裏返っている異常状態に該当することが識別される。こうして識別された異常状態に応じた復帰動作は、上記の（５）の復帰動作の決定によって、最も適切な「バキューム撤去」に決定される。上記の（６）の異常エリア計測により、裏返っている作業対象部品Ｐの正確な座標位置や姿勢が計測される。この計測結果に基づき、上記の（７）の復帰動作の実行として、裏返っている作業対象部品Ｐをバキューム装置で吸着してから、ロボットハンド３１を少し移動させて、作業対象部品Ｐを不良部品収納容器へ捨てる。
【００８５】
このようにして、偶発的に作業対象部品Ｐが裏返ったことで「チョコ停」を発生させた要因が取り除かれ、異常状態が解消されるので、ロボットハンド３１による作業の再開が可能となる。
【００８６】
なお、作業の再開を行うとき、望ましくは、第１実施形態を実行して、位置ずれが発生している作業対象部品Ｐに対してはロボットハンド３１による通常作業を実行しない。これにより、作業対象部品Ｐの位置ずれに起因するいわゆる「チョコ停」の未然防止が可能となって、ロボット３やロボット制御システム１全体の稼働率が向上する。
【００８７】
以上で説明した第２実施形態によれば、各種の未然防止策だけでは防ぎきれない「チョコ停」が発生した場合であっても、可能であれば自動的に復帰動作を行う。これにより、作業者やメインテナンス要因が介在することなく、ロボット３やロボット４を長時間にわたって連続稼働させることができ、ロボット制御システム１全体の稼働率もより一層向上する。
【００８８】
本発明は、その主旨または主要な特徴から逸脱することなく、他のいろいろな形で実施することができる。そのため、上述の実施形態や実施例はあらゆる点で単なる例示にすぎず、限定的に解釈してはならない。本発明の範囲は特許請求の範囲によって示すものであって、明細書本文にはなんら拘束されない。さらに、特許請求の範囲の均等範囲に属する変形や変更は、全て本発明の範囲内のものである。
【符号の説明】
【００８９】
１      ロボット制御システム
２      ワークテーブル
３      ロボット
３０    ロボットアーム
３１    ロボットハンド
３２    チャック部
３３    支持台
３４    小型カメラ
４      ロボット
４０    ロボットアーム
４１    ロボットハンド
４４    小型カメラ
５      部品供給トレイ
６      部品供給トレイ
７      組立用治具
８      可搬型カメラ
１０    ティーチングペンダント
１１    タッチパネル式ディスプレイ
１２    グリップ
１３    グリップ
１４    非常停止ボタン
１５    イネーブルスイッチ
１００  制御部
１０５  撤去装置
１０６  撤去装置
１１０  パソコン
Ａ、Ｂ  コントローラ
Ｐ      作業対象部品
Ｐｎ    次作業対象部品
Ｗ      ワーク
【図１】
0005468367.tif 000002
【図２】
0005468367.tif 000003
【図３】
0005468367.tif 000004
【図４】
0005468367.tif 000005
【図５】
0005468367.tif 000006
【図６】
0005468367.tif 000007
【図７】
0005468367.tif 000008