特許 7572452 生産システム及び制御装置

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

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

(11)【特許番号】

(24)【登録日】2024-10-15

(45)【発行日】2024-10-23

(54)【発明の名称】生産システム及び制御装置

(51)【国際特許分類】

   B25J 13/00 20060101AFI20241016BHJP

【ＦＩ】

B25J13/00 A

【請求項の数】 4

(21)【出願番号】P 2022566857

(86)(22)【出願日】2021-11-24

(86)【国際出願番号】 JP2021042932

(87)【国際公開番号】W WO2022118704

(87)【国際公開日】2022-06-09

【審査請求日】2023-07-11

(31)【優先権主張番号】P 2020199361

(32)【優先日】2020-12-01

(33)【優先権主張国・地域又は機関】JP

(73)【特許権者】

【識別番号】390008235

【氏名又は名称】ファナック株式会社

(74)【代理人】

【識別番号】100106002

【弁理士】

【氏名又は名称】正林 真之

(74)【代理人】

【識別番号】100165157

【弁理士】

【氏名又は名称】芝 哲央

(74)【代理人】

【識別番号】100160794

【弁理士】

【氏名又は名称】星野 寛明

(72)【発明者】

【氏名】宮▲崎▼ 航

【審査官】尾形 元

(56)【参考文献】

【文献】特開昭６２－２０３７８９（ＪＰ，Ａ）

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

【文献】実開平２－３１２１９（ＪＰ，Ｕ）

【文献】特開２０００－２５６６４（ＪＰ，Ａ）

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

Ｂ２５Ｊ １３／００

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

【請求項1】

ワークを搬送するワーク搬送装置と、
ロボットと、
前記ロボットを移動させるロボット移動装置と、を備え、
前記ワーク搬送装置によって前記ワークが搬送されている時に、前記ロボット移動装置によって前記ロボットを移動させ、前記ロボットが前記ワークに追従しながら作業を行う生産システムであって、
前記ロボットが前記ワークに追従して移動している間に、前記ロボットに対する前記ワークの位置が、前記ロボットが前記ワークに対して作業可能な動作可能範囲を超えたか否かを判断する判断部と、
前記判断部によって、前記ロボットに対する前記ワークの位置が前記動作可能範囲を超えたと判断された場合に、前記ロボットに対する前記ワークの位置が前記動作可能範囲内に入るように、前記ワーク搬送装置及び前記ロボット移動装置の少なくともいずれか一方の駆動を制御して位置補正を行う位置補正部と、を有し、
前記動作可能範囲は、第１動作可能範囲と、前記第１動作可能範囲よりも範囲の広い第２動作可能範囲と、の少なくとも２つの範囲を有し、
前記位置補正部は、判断部によって前記ロボットに対する前記ワークの位置が、前記第１動作可能範囲を超えたと判断された場合の位置補正の補正量よりも、前記第２動作可能範囲を超えたと判断された場合の位置補正の補正量を大きくする、生産システム。

【請求項2】

前記位置補正部は、前記ワーク搬送装置及び前記ロボット移動装置の少なくともいずれか一方を、予め指定された距離移動させることによって位置補正を行う、請求項１に記載の生産システム。

【請求項3】

前記位置補正部は、前記ワーク搬送装置及び前記ロボット移動装置の少なくともいずれか一方の速度を変更することによって位置補正を行う、請求項１に記載の生産システム。

【請求項4】

ワーク搬送装置によって搬送されるワークに、ロボット移動装置によって移動するロボットを追従させながら行う作業の動作を制御する制御装置であって、
前記ロボットが前記ワークに追従して移動している間に、前記ロボットに対する前記ワークの位置が、前記ロボットが前記ワークに対して作業可能な動作可能範囲を超えたか否かを判断する判断部と、
前記判断部によって、前記ロボットに対する前記ワークの位置が前記動作可能範囲を超えたと判断された場合に、前記ロボットに対する前記ワークの位置が前記動作可能範囲内に入るように、前記ワーク搬送装置及び前記ロボット移動装置の少なくともいずれか一方の駆動を制御して位置補正を行う位置補正部と、を有し、
前記動作可能範囲は、第１動作可能範囲と、前記第１動作可能範囲よりも範囲の広い第２動作可能範囲と、の少なくとも２つの範囲を有し、
前記位置補正部は、判断部によって前記ロボットに対する前記ワークの位置が、前記第１動作可能範囲を超えたと判断された場合の位置補正の補正量よりも、前記第２動作可能範囲を超えたと判断された場合の位置補正の補正量を大きくする、制御装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、生産システムに関する。

【背景技術】

【0002】

従来、ワークを搬送するワーク搬送装置と、ロボットと、ワーク搬送装置に沿ってロボットを移動させるロボット移動装置と、を備える生産システムが知られている（例えば、特許文献１参照）。このような生産システムでは、ワーク搬送装置によってワークが搬送されている時に、ロボット移動装置が、ワークの搬送に同期して、ワークと同じ速度でロボットを移動させる。ロボットは、ワークに追従しながらワークに対して所定の作業を行う。

【先行技術文献】

【特許文献】

【0003】

【文献】特開平８－７２７６４号公報

【発明の概要】

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

【0004】

ロボットは、ワークに対して作業可能な所定の動作可能範囲を有する。そのため、ロボット移動装置は、搬送中のワークにロボットを追従させる際に、ロボットに対するワークの位置が、ロボットの動作可能範囲を超えることのないようにロボットを移動させる必要がある。

【0005】

ワークの搬送速度は、所定のサイクルで計測される。ロボット移動装置は、そのワークの搬送速度の計測値に基づいて、ワークの搬送速度に対応する速度でロボットを移動させる。そのため、通常の動作時において、ロボットに対するワークの位置が、ロボットの動作可能範囲を超えることはない。

【0006】

しかしながら、何らかの突発的なトラブルの発生によって、ワークの搬送速度の計測値がロボット移動装置側に送信されない場合、または、ワークの搬送速度が、計測サイクルよりも短い期間内で急激に変化する場合等に、ロボット移動装置は、ロボットをワークに適正に追従させることができなくなり、ロボットに対するワークの位置がロボットの動作可能範囲を超えてしまう場合がある。

【0007】

したがって、ロボットに対するワークの位置が、常にロボットの動作可能範囲を超えることのないように、ロボットをワークに追従して移動させることができる生産システムが望まれる。

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

【0008】

本開示の一態様は、ワークを搬送するワーク搬送装置と、ロボットと、前記ロボットを移動させるロボット移動装置と、を備え、前記ワーク搬送装置によって前記ワークが搬送されている時に、前記ロボット移動装置によって前記ロボットを移動させ、前記ロボットが前記ワークに追従しながら作業を行う生産システムであって、前記ロボットが前記ワークに追従して移動している間に、前記ロボットに対する前記ワークの位置が、前記ロボットが前記ワークに対して作業可能な動作可能範囲を超えた否かを判断する判断部と、前記判断部によって、前記ロボットに対する前記ワークの位置が前記ロボットの前記動作可能範囲を超えたと判断された場合に、前記ロボットに対する前記ワークの位置が前記ロボットの前記動作可能範囲内に入るように、前記ワーク搬送装置及び前記ロボット移動装置の少なくともいずれか一方の駆動を制御して位置補正を行う位置補正部と、を有する、生産システムである。

【発明の効果】

【0009】

一態様によれば、ロボットに対するワークの位置が、常にロボットの動作可能範囲を超えることのないように、ロボットをワークに追従して移動させることができる生産システムを提供することができる。

【図面の簡単な説明】

【0010】

【図1】生産システムの概要を示す図である。

【図2】生産システムの構成を示すブロック図である。

【図3】生産システムのシステム制御装置の構成を示すブロック図である。

【図4】ロボットがワークに追従して作業を行う様子を説明する図である。

【図5】ワークに対するロボットの動作可能範囲の一実施形態を説明する図である。

【図6】生産システムの動作の一実施形態を説明するフローチャートである。

【図7】ロボットに対するワークの位置がロボットの動作可能範囲内に入るように位置補正を行う様子を説明する図である。

【図8】ワークに対するロボットの動作可能範囲の他の実施形態を説明する図である。

【図9】生産システムの動作の他の実施形態を説明するフローチャートである。

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

【0011】

以下、本開示の実施形態について図面を参照して説明する。図１～図３において、生産システム１は、ワークＷを搬送するワーク搬送装置２と、ロボット３と、ロボット３を移動させるロボット移動装置４と、を備える。ワークＷは、ロボット３の作業対象物である。ワーク搬送装置２及びロボット移動装置４は、生産システム１における生産ラインを構成する。

【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】

以上のように、本実施形態に係る生産システム１は、ワークＷを搬送するワーク搬送装置２と、ロボット３と、ロボット３を移動させるロボット移動装置４と、を備え、ワーク搬送装置２によってワークＷが搬送されている時に、ロボット移動装置４によってロボット３を移動させ、ロボット３がワークＷに追従しながら作業を行う生産システム１である。ロボット３がワークＷに追従して移動している間に、ロボット３に対するワークＷの位置が、ロボット３がワークＷに対して作業可能な動作可能範囲を超えた否かを判断する判断部１３と、判断部１３によって、ロボット３に対するワークＷの位置が動作可能範囲を超えたと判断された場合に、ロボット３に対するワークＷの位置が動作可能範囲内に入るように、ワーク搬送装置２及びロボット移動装置４の少なくともいずれか一方の駆動を制御して位置補正を行う位置補正部１４と、を有する。これによって、ロボット３に対するワークＷの位置が、常にロボット３の動作可能範囲を超えることのないように、ロボット３をワークＷに追従して移動させることができる。したがって、生産システム１におけるワークＷの加工精度及び生産性が向上する。

【0039】

位置補正部１４が、ワーク搬送装置２及びロボット移動装置４の少なくともいずれか一方を、予め指定された距離移動させることによって位置補正を行う場合には、ワークＷ及びロボット３の少なくともいずれか一方の移動によって、簡単に位置補正することができる。

【0040】

位置補正部１４が、ワーク搬送装置２及びロボット移動装置４の少なくともいずれか一方の速度を変更することによって位置補正を行う場合には、ワークＷ及びロボット３の少なくともいずれか一方の移動によって、速やかに位置補正することができる。

【0041】

判断部１３によって判断されるロボット３の動作可能範囲は、図５に示した１つの範囲に制限されず、図８に示すように、第１動作可能範囲と、第１動作可能範囲よりも範囲の広い第２動作可能範囲と、の少なくとも２つの範囲を有していてもよい。この場合では、生産システム１において、前記動作可能範囲は、第１動作可能範囲と、前記第１動作可能範囲よりも範囲の広い第２動作可能範囲と、の少なくとも２つの範囲を有し、前記位置補正部１４は、前記判断部１３によって、前記ロボット３に対する前記ワークＷの位置が前記第１動作可能範囲を超えたと判断された場合に、前記ロボット３に対する前記ワークＷの位置が前記第１動作可能範囲内に入るように、前記ワーク搬送装置２及び前記ロボット移動装置４の少なくともいずれか一方の駆動を制御して第１位置補正を行い、前記判断部１３によって、前記ロボット３に対する前記ワークＷの位置が前記第２動作可能範囲を超えたと判断された場合に、前記ロボット３に対する前記ワークＷの位置が前記第１動作可能範囲内に入るように、前記ワーク搬送装置２及び前記ロボット移動装置４の少なくともいずれか一方の駆動を制御して、第１位置補正よりも補正量が大きい第２位置補正を行うことができる。

【0042】

第１動作可能範囲は、ロボット３がワークＷに対して、安定して、余裕を持って作業を行うことができる範囲である。例えば、ワークＷが、図８に示す位置Ｗ１０、Ｗ２１及びＷ３１に配置されている場合、ロボット３はワークＷに対して、安定して、余裕を持って作業を行うことができる。第２動作可能範囲は、ロボット３がワークＷに対して作業を行うことができるが、第１動作可能範囲よりもロボット３の作業効率が低下する等のおそれがある範囲である。ワークＷが第２動作可能範囲を超える場合、たとえば、ロボット３はストロークリミット等によって、ワークＷに対して適正な作業を行うことが困難又は不可能になる場合がある。動作可能範囲は、２つの動作可能範囲に設定されるものに限らず、３つ以上の動作可能範囲が設定されてもよい。

【0043】

ロボット３に対するワークＷの位置が、図８に示すロボット３よりもＤｗ１方向に進んだ位置Ｗ２２に配置されている場合、ワークＷは、ロボット３の第１動作可能範囲を超えているため、位置補正部１４は、ワークＷがロボット３の第１動作可能範囲内に配置されるように、上記の（１）～（４）のいずれかの制御によって第１位置補正を行う。

【0044】

一方、ロボット３に対するワークＷの位置が、図８に示すロボット３よりもＤｗ２方向に後退した位置Ｗ３２に配置されている場合も、ワークＷは、ロボット３の第１動作可能範囲を超えているため、位置補正部１４は、ワークＷがロボット３の第１動作可能範囲内に配置されるように、上記の（５）～（８）のいずれかの制御によって第１位置補正を行う。

【0045】

また、ロボット３に対するワークＷの位置が、図８に示すロボット３よりもＤｗ１方向にさらに進んだ位置Ｗ４１に配置されている場合、ワークＷは、ロボット３の第２動作可能範囲を超えているため、位置補正部１４は、ワークＷがロボット３の第１動作可能範囲内に配置されるように、上記の（１）～（４）のいずれかの制御によって第２位置補正を行う。

【0046】

さらに、ロボット３に対するワークＷの位置が、図８に示すロボット３よりもＤｗ２方向にさらに後退した位置Ｗ５１に配置されている場合、ワークＷは、ロボット３の第２動作可能範囲を超えているため、位置補正部１４は、ワークＷがロボット３の第１動作可能範囲内に配置されるように、上記の（５）～（８）のいずれかの制御によって第２位置補正を行う。

【0047】

第２位置補正は、第１位置補正よりも補正量が大きい。具体的には、位置補正のパラメータが距離である場合は、第２位置補正による補正距離は、第１位置補正による補正距離よりも大きい値である。位置補正のパラメータが速度である場合には、第２位置補正による補正速度の変化量は、第１位置補正による補正速度の変化量よりも大きい値である。

【0048】

次に、図９のフローチャートに基づいて、ロボット３の動作可能範囲が第１動作可能範囲及び第２動作可能範囲の２つの範囲に設定された生産システム１の具体的な動作について説明する。

【0049】

ロボット３は、ロボット移動装置４上の所定の作業開始初期位置に配置されている。生産システム１の稼働後、システム制御装置１０は、ワーク搬送装置駆動部１１を制御してワーク搬送装置２を駆動させ、予め設定された一定の搬送速度でワークＷをＤｗ１方向に前進させる。システム制御装置１０は、ワーク位置検出部５によってワークＷがロボット３の作業領域に入ったかどうかを監視する。システム制御装置１０は、ワークＷがロボット３の作業領域に入るまで待機する（ステップＳ１１、ステップＳ１２；ＮＯ）。

【0050】

システム制御装置１０は、ワークＷがロボット３の作業領域内に入ったことを検出すると（ステップＳ１２；ＹＥＳ）、ロボット移動装置駆動部１２を制御してロボット移動装置４を駆動させる。これによって、システム制御装置１０は、予め設定された一定の移動速度でロボット３をＤｒ１方向に前進させてワークＷに追従して移動させる（ステップＳ１３）。

【0051】

システム制御装置１０は、ロボット３の移動開始とともにロボット制御装置３０に作業開始指令を出力する。これによって、ロボット制御装置３０は、所定の作業プログラムに従ってロボット３を駆動させる。ロボット制御装置３０は、ロボット３のハンド部３２に取り付けられたカメラ３３で撮像された画像に基づいて、ビジュアルフィードバックによってアーム部３１及びハンド部３２を駆動させ、ワークＷに追従しながらワークＷに対して所定の作業を実行する（ステップＳ１４）。

【0052】

ワークＷに追従したロボット３の移動中に、システム制御装置１０は、判断部１３において、ワーク位置検出部５及びロボット位置検出部６から入力されるワーク位置及びロボット位置に基づいて、ロボット３に対するワークＷの位置が、ロボット３がワークＷに対して作業可能な第１動作可能範囲を超えたどうかを判断する（ステップＳ１５）。ロボット３に対するワークＷの位置が第１動作可能範囲を超えていないと判断された場合（ステップＳ１５；ＮＯ）には、システム制御装置１０は、ワークＷに対するロボット３の作業が完了したかどうかを判断する（ステップＳ１８）。作業完了していない場合（ステップＳ１８；ＮＯ）は、システム制御装置１０は、処理をステップＳ１５からの処理に戻し、作業完了した場合（ステップＳ１８；ＹＥＳに）は、当該ワークＷに対するロボット３の作業を終了する。

【0053】

上記ステップＳ１５において、ロボット３に対するワークＷの位置が第１動作可能範囲を超えたと判断された場合（ステップＳ１５；ＹＥＳ）は、次に、システム制御装置１０は、判断部１３において、ロボット３に対するワークＷの位置が、ロボット３がワークＷに対して作業可能な第２動作可能範囲を超えたかどうかを判断する（ステップＳ１６）。

【0054】

上記ステップＳ１６において、ロボット３に対するワークＷの位置が第２動作可能範囲を超えていないと判断された場合（ステップＳ１６；ＮＯ）には、位置補正部１４において、ロボット３に対するワークＷの位置が第１動作可能範囲内に入るように、ワーク搬送装置２又はロボット移動装置４の少なくともいずれか一方の駆動を制御して第１位置補正を行う（ステップＳ１７）。図９に示すフローチャートでは、位置補正部１４は、ロボット移動装置駆動部１２を制御して、ロボット移動装置４の移動距離又は速度を変更することによって、第１位置補正を行っている。

【0055】

上記ステップＳ１６において、ロボット３に対するワークＷの位置が第２動作可能範囲を超えたと判断された場合（ステップＳ１６；ＹＥＳ）には、位置補正部１４において、ロボット３に対するワークＷの位置が第１動作可能範囲内に入るように、ワーク搬送装置２又はロボット移動装置４の少なくともいずれか一方の駆動を制御して、第１位置補正よりも補正量の大きい第２位置補正を行う（ステップＳ１９）。図９に示すフローチャートでは、位置補正部１４は、ロボット移動装置駆動部１２を制御して、ロボット移動装置４の移動距離又は速度を変更することによって、第２位置補正を行っている。

【0056】

システム制御装置１０は、ステップＳ１７において第１位置補正を行った後、及びステップＳ１９において第２位置補正を行った後、ステップＳ１８の処理に移行し、作業完了かどうかを判断する。

【0057】

このように、判断部１３によって判断される動作可能範囲が、第１動作可能範囲と、第１動作可能範囲よりも範囲の広い第２動作可能範囲と、の少なくとも２つの範囲を有することによって、ロボット３は、ワークＷに対して常により良い姿勢で作業を行うことができる。したがって、生産システム１におけるワークＷの加工精度及び生産性がさらに向上する。

【符号の説明】

【0058】

１ 生産システム
２ ワーク搬送装置
３ ロボット
４ ロボット移動装置
１３ 判断部
１４ 位置補正部
Ｗ ワーク

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】