知財求人 - 知財ポータルサイト「IP Force」
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2023088293
(43)【公開日】2023-06-26
(54)【発明の名称】オンライン自動インターロック戦略
(51)【国際特許分類】
B25J 19/06 20060101AFI20230619BHJP
【ＦＩ】
B25J19/06
【審査請求】未請求
【請求項の数】24
【出願形態】ＯＬ
【外国語出願】
(21)【出願番号】P 2022196775
(22)【出願日】2022-12-09
(31)【優先権主張番号】17/644,123
(32)【優先日】2021-12-14
(33)【優先権主張国・地域又は機関】US
(71)【出願人】
【識別番号】390008235
【氏名又は名称】ファナック株式会社
(74)【代理人】
【識別番号】100099759
【弁理士】
【氏名又は名称】青木 篤
(74)【代理人】
【識別番号】100123582
【弁理士】
【氏名又は名称】三橋 真二
(74)【代理人】
【識別番号】100112357
【弁理士】
【氏名又は名称】廣瀬 繁樹
(74)【代理人】
【識別番号】100130133
【弁理士】
【氏名又は名称】曽根 太樹
(72)【発明者】
【氏名】リン シェン－チュン
(72)【発明者】
【氏名】加藤 哲朗
(72)【発明者】
【氏名】チー－コン ツァイ
【テーマコード（参考）】
3C707
【Ｆターム（参考）】
3C707AS01
3C707AS06
3C707AS11
3C707AS13
3C707BS09
3C707KS16
3C707KS17
3C707LV02
3C707MS08
3C707MT06
(57)【要約】
【課題】マルチロボットシステムのデッドロック回避動作の計画技術を提供する。
【解決手段】この技術は、次に現れるロボット動作区分の掃引容積のオンライン計算を含み、掃引容積を使用して１つ又は複数の重複領域を計算し、全てのロボット制御装置に発行する。掃引容積の計算は、ジャンプ及びオフセットなどの適応状態を含む、実際の次に現れる工具経路に基づくものである。ロボット制御装置は、時間ステップごとに、重複領域に進入するか否かと、別のロボットが既に領域内に存在するか否かとを確認する。ロボットが、占有される領域に自身が進入しようとしていると判定すると、ロボットはその領域が空になるまで位置を保持する。ロボットは、他のロボットの認知のために領域の出入りを発行する。デッドロックの状態を自動的に解消するための優先順位を確立し、連続処理操作を実施するロボットの動作区分の完了を優先するために、追加の論理が追加される。
【選択図】図６
【解決手段】この技術は、次に現れるロボット動作区分の掃引容積のオンライン計算を含み、掃引容積を使用して１つ又は複数の重複領域を計算し、全てのロボット制御装置に発行する。掃引容積の計算は、ジャンプ及びオフセットなどの適応状態を含む、実際の次に現れる工具経路に基づくものである。ロボット制御装置は、時間ステップごとに、重複領域に進入するか否かと、別のロボットが既に領域内に存在するか否かとを確認する。ロボットが、占有される領域に自身が進入しようとしていると判定すると、ロボットはその領域が空になるまで位置を保持する。ロボットは、他のロボットの認知のために領域の出入りを発行する。デッドロックの状態を自動的に解消するための優先順位を確立し、連続処理操作を実施するロボットの動作区分の完了を優先するために、追加の論理が追加される。
【選択図】図６
【特許請求の範囲】
【請求項1】
共通の作業空間において動作する２台以上のロボットを含むマルチロボットシステムにおいてデッドロックを防止するためのオンラインの方法であって、各ロボットはプロセッサ及びメモリを含む制御装置によって制御されており、前記方法は、
それぞれの前記ロボットの前記制御装置の動作計画装置モジュールによって、１つ又は複数の次に現れる動作区分の掃引容積を計算するステップと、
前記掃引容積を作業空間管理装置モジュールに発行するステップと、
前記作業空間管理装置モジュールによって、任意の２つ以上の前記ロボットからの任意の２つ以上の前記掃引容積の間の重複の空間容積として、重複領域を計算するステップと、
それぞれの前記重複領域と状況データとを、それぞれの前記重複領域に関与するそれぞれの前記ロボットの前記制御装置に発行するステップと、
ロボットの移動の次の増分を計算した後に、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記重複領域と前記状況データとを検査するステップと、
前記次の増分によって前記ロボットが占有された重複領域に進入しない場合に、ロボット移動の次のステップを実行するステップと、
前記次の増分によって前記ロボットが占有された重複領域に進入する場合に、前記ロボットを現在の位置に保持するステップと、
重複領域に進入するか重複領域から退出する場合に、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記作業空間管理装置モジュールに通知するステップと、を含む、方法。
それぞれの前記ロボットの前記制御装置の動作計画装置モジュールによって、１つ又は複数の次に現れる動作区分の掃引容積を計算するステップと、
前記掃引容積を作業空間管理装置モジュールに発行するステップと、
前記作業空間管理装置モジュールによって、任意の２つ以上の前記ロボットからの任意の２つ以上の前記掃引容積の間の重複の空間容積として、重複領域を計算するステップと、
それぞれの前記重複領域と状況データとを、それぞれの前記重複領域に関与するそれぞれの前記ロボットの前記制御装置に発行するステップと、
ロボットの移動の次の増分を計算した後に、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記重複領域と前記状況データとを検査するステップと、
前記次の増分によって前記ロボットが占有された重複領域に進入しない場合に、ロボット移動の次のステップを実行するステップと、
前記次の増分によって前記ロボットが占有された重複領域に進入する場合に、前記ロボットを現在の位置に保持するステップと、
重複領域に進入するか重複領域から退出する場合に、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記作業空間管理装置モジュールに通知するステップと、を含む、方法。
【請求項2】
前記作業空間管理装置モジュールは、前記制御装置のうちの１つで作動するか、それぞれの前記ロボットの前記制御装置と通信するコンピュータにおいて作動する、請求項１に記載の方法。
【請求項3】
１つ又は複数の次に現れる動作区分の掃引容積を計算するステップと、前記掃引容積を発行するステップとは、ロボット操作の期間中に連続的に実施される、請求項１に記載の方法。
【請求項4】
１つ又は複数の次に現れる動作区分の掃引容積を計算するステップと、前記掃引容積を発行するステップとは、前記動作区分における任意の適応コマンドが解決されたと判定された後にのみ実施され、前記適応コマンドは、ジャンプ及び位置登録オフセットのうちの１つ又は複数を含む、請求項１に記載の方法。
【請求項5】
前記掃引容積の前記動作区分のうちの１つが完了したときに、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記作業空間管理装置モジュールに通知するステップをさらに含む、請求項１に記載の方法。
【請求項6】
それぞれの前記重複領域の前記状況データは、重複の前記空間容積と、前記重複領域に含まれるそれぞれの前記掃引容積の動作区分番号と、前記重複領域に関与する前記ロボットのリストと、現在に前記重複領域に存在する任意のロボットの識別情報と、を含む、請求項１に記載の方法。
【請求項7】
それぞれの前記重複領域及び状況データを発行するステップは、各重複領域が最初に作成されたときにそれぞれの重複領域を発行するステップと、前記状況データの任意の要素が変化したときに各重複領域を再発行するステップと、各重複領域が存在しなくなったときに各重複領域の取り消しを発行するステップと、を含む、請求項１に記載の方法。
【請求項8】
それぞれの前記重複領域についての前記重複の空間容積は、前記掃引容積を表すボクセルを使用して計算される、請求項１に記載の方法。
【請求項9】
前記次の増分によって前記ロボットが占有された重複領域に進入する場合に、前記ロボットが既に占有された前記重複領域に存在しているか否かを判定し、存在している場合は、前の動作区分の掃引容積について、前記ロボットが占有された前記重複領域に存在していたか否かを判定するステップをさらに含む、請求項１に記載の方法。
【請求項10】
前記ロボットが前の前記動作区分の掃引容積について占有された前記重複領域に存在していた場合に、前記ロボットを現在の位置に保持し、前記ロボットが前記前の動作区分の掃引容積について占有された前記重複領域に存在していなかった場合に、前の増分に戻るステップをさらに含む、請求項９に記載の方法。
【請求項11】
前記制御装置は、吹き付け塗装、レーザ溶接又はアーク溶接、あるいは材料のビードの分配を含む連続的なプロセス操作を実施する前記ロボットのいずれかに移動の優先権を提供するように構成される、請求項１に記載の方法。
【請求項12】
連続的な前記プロセス操作を実施する前記ロボットの前記制御装置の前記動作計画装置モジュールは、連続的な前記プロセス操作の全体の掃引容積を計算して発行し、次に、連続的な前記プロセス操作の全体の前記掃引容積に関与する重複領域が占有されていない場合に連続的な前記プロセス操作を開始する、請求項１１に記載の方法。
【請求項13】
共通の作業空間において動作する２台以上のロボットを含むマルチロボットシステムにおいてデッドロックを防止するためのオンラインの方法であって、各ロボットはプロセッサ及びメモリを含む制御装置によって制御されており、前記方法は、
それぞれの前記ロボットの前記制御装置の動作計画装置モジュールによって、１つ又は複数の次に現れる動作区分の掃引容積を計算するステップであって、前記掃引容積を計算するステップは、前記動作区分の任意の適応コマンドが解決されたと判定された後にのみ、ロボットの動作中に連続的に実施され、前記適応コマンドは、ジャンプ及び位置登録オフセットのうちの１つ又は複数を含む、ステップと、
前記掃引容積を作業空間管理装置モジュールに発行するステップと、
前記作業空間管理装置モジュールによって、前記ロボットのうちの任意の２台以上からの前記掃引容積のうちの任意の２つ以上の間の重複の空間容積として、重複領域を計算するステップと、
それぞれの前記重複領域と状況データとを、それぞれの前記重複領域に関与するそれぞれの前記ロボットの前記制御装置に発行するステップであって、それぞれの前記重複領域の前記状況データは、前記重複の空間容積と、前記重複領域に含まれるそれぞれの前記掃引容積の動作区分番号と、前記重複領域に関与する前記ロボットのリストと、前記重複領域に現在に存在する任意のロボットの識別情報と、を含む、ステップと、
ロボットの移動の次のステップを計算した後に、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記重複領域と前記状況データとを検査するステップと、
次のステップによって前記ロボットが占有された重複領域に進入しない場合に、ロボットの移動の次のステップを実行するステップと、
次のステップによって前記ロボットが占有された重複領域に進入する場合に、ロボットを現在の位置に保持するステップと、
重複領域に進入するか重複領域から退出するときに、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記作業空間管理装置モジュールに通知するステップと、
前記掃引容積の動作区分の１つが完了したときに、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記作業空間管理装置モジュールに通知するステップと、を含む、方法。
それぞれの前記ロボットの前記制御装置の動作計画装置モジュールによって、１つ又は複数の次に現れる動作区分の掃引容積を計算するステップであって、前記掃引容積を計算するステップは、前記動作区分の任意の適応コマンドが解決されたと判定された後にのみ、ロボットの動作中に連続的に実施され、前記適応コマンドは、ジャンプ及び位置登録オフセットのうちの１つ又は複数を含む、ステップと、
前記掃引容積を作業空間管理装置モジュールに発行するステップと、
前記作業空間管理装置モジュールによって、前記ロボットのうちの任意の２台以上からの前記掃引容積のうちの任意の２つ以上の間の重複の空間容積として、重複領域を計算するステップと、
それぞれの前記重複領域と状況データとを、それぞれの前記重複領域に関与するそれぞれの前記ロボットの前記制御装置に発行するステップであって、それぞれの前記重複領域の前記状況データは、前記重複の空間容積と、前記重複領域に含まれるそれぞれの前記掃引容積の動作区分番号と、前記重複領域に関与する前記ロボットのリストと、前記重複領域に現在に存在する任意のロボットの識別情報と、を含む、ステップと、
ロボットの移動の次のステップを計算した後に、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記重複領域と前記状況データとを検査するステップと、
次のステップによって前記ロボットが占有された重複領域に進入しない場合に、ロボットの移動の次のステップを実行するステップと、
次のステップによって前記ロボットが占有された重複領域に進入する場合に、ロボットを現在の位置に保持するステップと、
重複領域に進入するか重複領域から退出するときに、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記作業空間管理装置モジュールに通知するステップと、
前記掃引容積の動作区分の１つが完了したときに、それぞれの前記ロボットの前記制御装置の前記動作計画装置モジュールによって、前記作業空間管理装置モジュールに通知するステップと、を含む、方法。
【請求項14】
オンラインのデッドロックを防止するマルチロボットシステムであって、前記システムは、
共通の作業空間にて動作する２台以上のロボットと、
２台以上の前記ロボットを制御する１つ又は複数の制御装置であって、各制御装置はプロセッサ及びメモリを備える制御装置と、
それぞれの前記ロボットの前記制御装置で作動する動作計画装置ソフトウェアモジュールと、
それぞれの前記ロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールと通信する作業空間管理装置ソフトウェアモジュールと、を備えるシステムであって、
それぞれの前記ロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールは、
１つ又は複数の次に現れる動作区分の掃引容積を計算し、前記掃引容積を作業空間管理装置モジュールに発行するように構成され、
前記作業空間管理装置ソフトウェアモジュールは、
任意の２台以上の前記ロボットから任意の２つ以上の前記掃引容積の間の重複の空間容積として重複領域を計算し、
それぞれの前記重複領域及び状況データを、それぞれの前記重複領域に関与するそれぞれの前記ロボットの前記制御装置に発行するように構成され、
それぞれの前記ロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールは、
ロボット移動の次の増分を計算した後に、前記重複領域と前記状況データとを検査し、
次の増分によって前記ロボットが占有された重複領域に進入しない場合に、前記ロボット移動の次の増分を実行し、
次の増分によって前記ロボットが占有された重複領域に進入する場合に、前記ロボットを現在の位置に保持し、
前記重複領域に出入りしたときに、前記作業空間管理装置ソフトウェアモジュールに通知するようにさらに構成される、システム。
共通の作業空間にて動作する２台以上のロボットと、
２台以上の前記ロボットを制御する１つ又は複数の制御装置であって、各制御装置はプロセッサ及びメモリを備える制御装置と、
それぞれの前記ロボットの前記制御装置で作動する動作計画装置ソフトウェアモジュールと、
それぞれの前記ロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールと通信する作業空間管理装置ソフトウェアモジュールと、を備えるシステムであって、
それぞれの前記ロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールは、
１つ又は複数の次に現れる動作区分の掃引容積を計算し、前記掃引容積を作業空間管理装置モジュールに発行するように構成され、
前記作業空間管理装置ソフトウェアモジュールは、
任意の２台以上の前記ロボットから任意の２つ以上の前記掃引容積の間の重複の空間容積として重複領域を計算し、
それぞれの前記重複領域及び状況データを、それぞれの前記重複領域に関与するそれぞれの前記ロボットの前記制御装置に発行するように構成され、
それぞれの前記ロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールは、
ロボット移動の次の増分を計算した後に、前記重複領域と前記状況データとを検査し、
次の増分によって前記ロボットが占有された重複領域に進入しない場合に、前記ロボット移動の次の増分を実行し、
次の増分によって前記ロボットが占有された重複領域に進入する場合に、前記ロボットを現在の位置に保持し、
前記重複領域に出入りしたときに、前記作業空間管理装置ソフトウェアモジュールに通知するようにさらに構成される、システム。
【請求項15】
前記作業空間管理装置ソフトウェアモジュールは、前記制御装置のうちの１つで作動するか、それぞれの前記制御装置と通信するコンピュータにおいて作動する、請求項１４に記載のシステム。
【請求項16】
前記動作計画装置ソフトウェアモジュールは、ロボット動作中に連続的に１つ又は複数の次に現れる動作区分の前記掃引容積を計算して発行する、請求項１４に記載のシステム。
【請求項17】
前記動作計画装置ソフトウェアモジュールは、１つ又は複数の次に現れる動作区分の掃引容積を計算し、前記動作区分の任意の適応コマンドが解決されたと判定された後にのみ、前記掃引容積を発行し、前記適応コマンドは、ジャンプ及び位置登録オフセットのうちの１つ又は複数を含む、請求項１４に記載のシステム。
【請求項18】
前記動作計画装置ソフトウェアモジュールは、前記掃引容積の動作区分のうちの１つが完了したときに、前記作業空間管理装置ソフトウェアモジュールに通知するようにさらに構成される、請求項１４に記載のシステム。
【請求項19】
それぞれの前記重複領域の前記状況データは、重複の前記空間容積と、前記重複領域に含まれるそれぞれの前記掃引容積の動作区分番号と、前記重複領域に関与する前記ロボットのリストと、前記重複領域に現在に存在する任意のロボットの識別情報と、を含む、請求項１４に記載のシステム。
【請求項20】
前記作業空間管理装置ソフトウェアモジュールは、それぞれの前記重複領域及び前記状況データを、各重複領域が最初に作成されたときに発行し、前記状況データの任意の要素が変化したときに各重複領域及び前記状況データを再発行し、各重複領域が存在しなくなったときに各重複領域の取り消しを発行する、請求項１４に記載のシステム。
【請求項21】
前記動作計画装置ソフトウェアモジュールは、次の増分によって前記ロボットが占有された重複領域に進入する場合に、ロボットが占有された前記重複領域に既に存在しているか否かを判定し、存在している場合には、前記ロボットが前の動作区分の掃引容積について占有された前記重複領域に存在していたか否かを判定するようにさらに構成される、請求項１４に記載のシステム。
【請求項22】
前記動作計画装置ソフトウェアモジュールは、前記ロボットが前の動作区分の掃引容積について占有された前記重複領域に存在していた場合に、前記ロボットを現在の位置に保持し、前記ロボットが前の動作区分の掃引容積について占有された前記重複領域に存在していなかった場合に、前記ロボットを前の増分に後退させるようにさらに構成される、請求項２１に記載のシステム。
【請求項23】
連続的なプロセス操作を開始する準備ができているロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールは、連続的な前記プロセス操作の全ての動作区分に対して掃引容積を計算して発行し、次に、全体の連続的な前記プロセス操作の前記掃引容積に関与する重複領域が占有されていない場合に、連続的な前記プロセス操作を開始する、請求項１４に記載のシステム。
【請求項24】
ロボットの移動の次の増分を計算した後の前記重複領域と前記状況データとを検査するステップと、前記重複領域を検査するステップに続いて実施される行動は、それぞれの前記ロボットの前記制御装置の前記動作計画装置ソフトウェアモジュールによって実行される動作プログラムのインターロックとして実施される、請求項１４に記載のシステム。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、概して産業用ロボットの動作制御の分野に-関し、さらに詳細には、次に現れるロボット動作区分の掃引容積を使用して１つ又は複数の重複領域を計算し、関連するロボットのいずれかによる各重複領域の占有を監視し、いずれかのロボットが重複領域に進入すると、関連する他のいずれかのロボットが重複領域に進入することを、ロボットが退避するまで防止するマルチロボットシステムのデッドロック回避動作の計画技術に関する。
【背景技術】
【0002】
産業用ロボットを使用して、幅広い製造、組み立て及び材料移動操作を実施することが周知である。多くのロボット作業空間環境では、２台以上のロボットが同時に動作して、スポット溶接、吹き付け塗装又はコンベア上のピックアンドプレースなどの操作を実施している。２台以上のロボットが作業空間にて共に作業している場合、衝突を防ぐためにその動作を計画し、制御する必要がある。マルチロボットシステムにおけるロボット同士の衝突回避を含む衝突回避動作の計画技術が、当技術分野で知られている。
【0003】
衝突回避に加えて、マルチロボットシステムにはデッドロックの状態の発生の防止を試みる必要がある。例えば、２台のロボットのシステムにおけるデッドロックとは、各ロボットが他のロボットの経路を阻止し、その結果、どちらのロボットも衝突を引き起こすことなく、その計画された動作経路に沿って前進することができない場合である。デッドロックが発生すると、ロボットのうちの少なくとも１台が後方に移動するか、その計画された経路からルートを変更して、衝突のない動作を再開することができるようにする必要がある。デッドロックの状態は、ロボットの生産性を低下させるだけでなく、塗装又は溶接などの操作が望ましくない方法で中断された場合にワークが台無しになる可能性があるため、可能な限り回避する必要がある。干渉検査だけでは、デッドロックを防ぐことはできない。
【0004】
手動の方法及び自動化された方法を含むデッドロックを回避するための技術が、当技術分野で知られている。潜在的なデッドロックの状態を手動で識別し、インターロックをロボット動作プログラムに追加してデッドロックを防止することは、非常に面倒で時間のかかる方法である。このため、動作プログラムの実行前に掃引容積及び重複領域をオフラインで計算し、実行前に動作プログラムに重複領域の進入／退出事項を挿入する方法を含む、自動化されたデッドロック回避技術が開発された。この技術は、手動の方法よりも時間がかからず、特定のロボット動作プログラムでデッドロックを防ぐのに効果的である。しかし、掃引容積及び重複領域のオフライン計算では、特定の種類の動作の事項（工具先端点ジャンプなど）を伴う動作プログラムにおけるデッドロック防止と、位置登録又は他の技術を介して実行中に工具先端点の位置がオンラインで取得されるときと、を適切に処理することができない。
【0005】
上記の状況に照らして、設定が容易で、ロボット実行中にオンラインで計算される適応動作制御区分を含むマルチロボットシステムにおけるデッドロックを防止する、改善されたデッドロック防止技術が必要である。
【発明の概要】
【0006】
本開示の教示に従って、マルチロボットシステムのためのデッドロック回避動作の計画技術を開示する。この技術は、次に現れるロボット動作区分の掃引容積のオンライン計算を含み、個々のロボットの掃引容積を使用して、全てのロボット制御装置に発行される１つ又は複数の重複領域を計算する。掃引容積の計算は、ジャンプ及びオフセットなどの適応状態を含み、実際の次に現れる工具経路に基づくものである。各ロボット時間ステップでは、ロボット制御装置は、重複領域に進入することになるか否かを確認し、進入することになる場合は、別のロボットが既に領域内にあるか否かを確認する。既に占有されている領域にロボットが進入しようとしていると判定すると、ロボットは、その位置を、他のロボットがその領域を空けるまで保持する。ロボットは、他のロボットの認知のために、領域への進入事項および退出事項を発行する。初期のデッドロックの状態を自動的に解消し、塗装又は溶接などのプロセス操作を実施しているロボットの動作区分の完了を優先するための優先順位を確立するための追加論理を追加する。
【0007】
現在に開示している装置及び方法の追加の特徴は、添付の図面と併せて、以下の説明及び添付の特許請求の範囲から明らかになるであろう。
【図面の簡単な説明】
【0008】
【図3】図３は、当技術分野で知られている技術による、工具経路の重複領域を分析し、ロボット動作プログラムにインターロックチェックポイントを挿入することによってデッドロックを防止するための手動技術の２次元図である。
【発明を実施するための形態】
【0009】
ロボット動作計画におけるデッドロック回避を対象とする本開示の実施形態の以下の考察は、本質的に単なる例示であり、開示した装置及び技術又はその用途又は使用を限定することを意図するものでは決してない。
【0010】
さまざまな製造、組み立て及び材料移動操作に産業用ロボットを使用することが周知である。２台以上のロボットが作業空間で共に作業している場合、その動作を計画し制御して、衝突を防ぎ、デッドロックを回避する必要がある。
【0011】
図１は、車体ワーク１２０の近くで作業する２台の産業用ロボット（１００，１１０）の図である。ロボット１００及び１１０の動作を、当技術分野で知られているように、ロボット制御装置によって制御する。ロボット１００は制御装置１０２を有し、ロボット１１０は制御装置１１２を有する。ロボット１００及び１１０の動作は、衝突を防止するために調整される必要があるため、制御装置１０２及び１１２は互いに通信している。さらに、このほか、制御装置１０２及び１１２と通信する別個のコンピュータ１３０を設けてもよい。ここで、このコンピュータ１３０は、ロボットが動作する作業セル又は作業空間の全体的な活動を制御するプログラマブルロジックコントローラ（ＰＬＣ）又は他のタイプの計算装置であることがあり得る。例えば、材料を移動する用途では、コンピュータ１３０は、コンベヤ上の入荷部品の利用可能性及び場所に関連してロボットの動作を調整することがあり得る。
【0012】
図１の作業空間では、ロボット１００及び１１０は、ワーク１２０のさまざまな場所にてスポット溶接作業を実施している。スポット溶接は、車体の内部の場所を含み、ロボット１００及び１１０がドア開口部の内側に到達することを必要とする。この用途では、車体ワーク１２０自体が、ロボット１００及び１１０の動作に対する障害物である。さらに、ロボット１００と１１０の動作が重複する場合がある。これは、ロボット１００と１１０が互いに障害物となる可能性があることを意味する。ロボット１００及び１１０の操作には、計画された全ての動作に対して実施される干渉検査の計算が必要である。
【0013】
マルチロボットシステムにおけるロボット同士の衝突回避を含む衝突回避の動作計画技術が、当技術分野で知られている。衝突回避に加えて、マルチロボットシステムはデッドロックの状態の発生の防止を試みなければならない。デッドロックでは、ロボットが互いの経路を阻止し、その結果、衝突を発生させずに、計画された動作経路に沿ってそれ以上ロボットを動かすことができない。デッドロックが発生した場合、ロボットのうちの少なくとも１台が後方に移動するか、経路を変更して衝突のない動作を再開することができるようにする必要がある。デッドロックの状態は可能な限り回避する必要がある。干渉検査だけでは、デッドロックを防ぐことはできない。
【0014】
図２は、２台のロボットのシステムにおけるデッドロックの状態の単純化した２次元（２Ｄ）図である。ロボット２００及びロボット２２０を、基部、ロボットアーム及び工具又はエンドエフェクタを有する単純なロボットとして上面（平面）図で示す。ロボット２００は、経路２１２に沿って矢印２１４で示す方向に移動する工具２１０を有し、ロボット２２０は、経路２３２に沿って矢印２３４で示す方向に移動する工具２３０を有する。ロボット２００もロボット２２０も、衝突を引き起こさずにその経路に沿ってその工具をさらに動かすことができないため、デッドロックの状態が図２に存在する。本質的に、ロボット２００とロボット２２０の両方が経路２１２と経路２３２との間の領域である重複領域２４０に進入した時点で、デッドロックは避けられないものであった。当業者であれば理解するように、一方のロボット（例えば、ロボット２２０）は、他方のロボット（ロボット２００）が重複領域２４０の外に留まる限り、重複領域２４０に進入し、その工具をその経路に沿って動かし続けることができる。
【0015】
両方のロボットが重複領域２４０に進入した時点で、デッドロックの状態が存在し、唯一の解決策は、ロボットの１つが進路を逆にする（後退する）か、工具経路を変更することである。これは明らかに望ましい状況ではない。手動の方法及び自動化された方法を含む、デッドロックを防止するか回避するための技術が、当技術分野で知られている。
【0016】
図３は、当技術分野で知られている技術による、工具経路重複領域を分析し、ロボット動作プログラムにインターロックのチェックポイントを挿入することによってデッドロックを防止する手動技術の２次元図である。ロボット３００及びロボット３１０のそれぞれは、マルチリンクロボットアーム及び工具を備え、図２に関して上記で考察した方法で、上面図にて簡略化された形態で示されている。ロボット３００は、工具経路３０２をたどる工具を有し、ロボット３１０は、工具経路３１２をたどる工具を有する。重複領域３２０が、工具経路３０２と工具経路３１２との間の交差空間に存在する。デッドロックを回避する既知の方法とは、インターロック又はチェックポイントをロボット３００及び３１０の動作プログラムに追加することである。ロボットが、動作プログラムにおいてインターロックに到達すると、先に進む前に他のロボットの状況を検査する。
【0017】
チェックポイントを手動で追加する技術の１つを図３に示す。点１を、ロボット３１０に最も近い工具経路３０２に沿った点として識別する。点４を、ロボット３００に最も近い工具経路３１２に沿った点として識別する。次に、点１からロボット３１０の基部までの線に直交する線などの線「ａ」を引く。次に、インターロック点２及び３をロボット３１０の動作プログラムに追加する。同じように、点４からロボット３００の基部までの線に直交する線「ｂ」を引く。ロボット３００の動作プログラムにインターロック点５及び６を追加する。
【0018】
ロボット３１０がその工具を工具経路３１２に沿って時計回り方向に移動させる場合、工具がインターロック点２に到達すると、ロボット３１０は先に進む前にロボット３００の状況を検査する。ロボット３１０は、ロボット３００が重複領域３２０から離れていることがわかっている場合にのみ、その工具経路３１２に沿って進む。ロボット３１０がインターロック点２を通過すると、ロボット３１０は重複領域３２０に実質的に進入したことを報告し、その結果、ロボット３００は離れたまま維持することを認識する。ロボット３１０が工具経路３１２に沿って移動し、インターロック点３に到達すると、ロボット３１０が重複領域３２０を退出したことを報告し、その結果、ロボット３００は進入してもよい。ロボット３００は、インターロック点５を使用して、重複領域３２０に進入する前に確認し、その後、進入を報告し、インターロック点６を使用して、重複領域３２０から退出することを報告する。
【0019】
図３の簡略化された２Ｄの図でも、インターロック点をロボット動作プログラムに手動で追加するには、余分な作業が必要であることがわかる。この技術はこのほか、ロボットが、重複領域３２０から実際に離れた状態を維持するために、必要以上の位置に保持することになるため、インターロック点を定義する際に控えめな単純化が使用されることにより、非効率性を生み出す。
【0020】
図２及び図３は、見やすい状態を維持するために２次元で説明されている。実際のロボットの動作では、各ロボットが占有する空間と、空間の重複領域とは複雑な３次元（３Ｄ）形状である。しかし、重複領域の複数のロボット占有を防止するという概念は、図２及び図３に説明される方法と同じ方法で３Ｄ空間に適用される。これについては以下で考察する。
【0021】
図４は、デッドロック回避ロボット動作計画の必要性を示す掃引容積の重複領域を含む、図１の２台のロボットの掃引容積の図である。図４は、図１とは反対の視点から見たロボット１００及び１１０を示す。ロボット１００及び１１０は、図４の定位置にて概説されている。掃引容積１０８及び１１８は、任意の適切な技術を使用して計算される。掃引容積１０８は、ロボット１００の動作プログラムのある時点で占有される容積であり、掃引容積１１８は、ロボット１１０の動作プログラムのある時点で占有される容積である。典型的には、ロボット掃引容積の計算は、各ロボットの各構成要素の３Ｄ幾何学モデル（ＣＡＤモデルなど）から開始し、ロボットが、その動作プログラムのステップを進むにつれて累積される範囲は徐々に追加される。占有容積を表すためにボクセル（立方体又はレンガ形状の体積要素）を使用する技術および他の技術を含むロボット掃引容積を計算する技術が当技術分野で知られている。
【0022】
重複容積４１０は、掃引容積１０８と掃引容積１１８の両方の中にある（両方に共通する）空間である。重複容積４１０は必ずしも衝突が発生することを示しているわけではないが、ロボット１００及び１１０は、異なる時間にそれぞれの掃引容積の重複部分を占有している可能性があるため、重複容積４１０の存在は、衝突回避干渉検査がロボットの動作中に実施されなければならないことを示し、デッドロックの状態が発生する可能性があり、デッドロックの回避もロボット動作プログラミングに含める必要があることを示す。
【0023】
図４は、実際のロボットの掃引容積及び重複領域に関与する３Ｄ幾何学の複雑さと、図３に示す手動の方法をそのような複雑な３Ｄ幾何学に適用することの難しさを示している。このため、動作プログラムの実行に先立って掃引容積と重複領域をオフラインで計算し、実行前に動作プログラムに重複領域の進入／退出インターロックを挿入する方法を含む自動化されたデッドロック回避技術が開発された。この技術は、図３の手動の方法よりも時間がかからず、特定のロボット動作プログラムのデッドロックを防ぐのに効果的である。しかし、掃引容積と重複領域の（ロボット動作前の）オフライン計算は、工具先端点のジャンプなどの特定のタイプの動作事項を伴って適応動作プログラムのデッドロック防止と、位置登録又は他の技術を介して実行中に工具先端点の位置がオンラインにて取得されるときと、を適切に処理することができない。
【0024】
本開示は、ロボット動作中に完全にオンラインで実施されるデッドロック防止技術を提供する。この技術は、リアルタイムで解決されるジャンプ及び位置登録オフセットなどの適応事項が工具経路に影響を及ぼす動作プログラムに対しても、掃引容積と重複領域を正確に計算する。
【0025】
図５は、本開示の一実施形態におけるデッドロック防止のためのオンラインインターロックの定義を含むマルチロボットシステム５００の上位のブロック図である。システム５００は、共通の作業空間で動作する少なくとも２台のロボットを含む。図５に示す例は、参照番号５１０によって識別されるロボット１、参照番号５２０によって識別されるロボットＮ、及び参照番号５３０によって識別されるロボット「ｉ」を含む「Ｎ」台のロボットを含む。ロボット「ｉ」は、ロボット５３０と呼ばれることになり、システム５００内の全てのロボットの代表を表す。ロボット５１０／５２０／５３０のそれぞれは、図１に示すように、ロボット自体及びロボット制御装置を含む。このほか、単一のロボット制御装置が複数のロボットを制御してもよい。
【0026】
作業空間管理装置モジュール５４０は、ロボット５１０／５２０／５３０のそれぞれの制御装置と通信するソフトウェアモジュールである。作業空間管理装置モジュール５４０は、ロボットのうちの１つの制御装置で作動することも、図１に示すコンピュータ１３０などの別個のコンピュータ上で作動することもあり得る。作業空間管理装置モジュール５４０は、現在開示している技術に従って、重複領域と、リアルタイムの領域のロボット占有状態との追跡を維持する。
【0027】
ロボット５３０及び作業空間管理装置モジュール５４０の行動及び相互作用について、図５に関して高水準で考察し、以下でさらに詳細に説明する。それぞれのロボット５１０／５２０／５３０は、同じ方法で作業空間管理装置モジュール５４０と相互作用することを理解されたい。ロボット５３０の制御装置は、上位の動作計画装置及び下位の動作補間器機能を含む、ボックス５３２に示す動作計画機能を実施する。ボックス５３２で概説するように、上位の計画装置は、ロボット５３０の利用可能で次に現れる動作区分から掃引容積を生成する。動作区分とは、「点Ｐ７７まで直線に移動せよ」など、ロボット動作プログラム内のコマンドである。当業者に知られているように、多くの異なるタイプのロボット動作コマンドが動作プログラミングに利用可能である。ジャンプ及び位置登録などの適応動作プログラミング特徴により、動作プログラム全体を事前に計算することができない場合がよくある。しかし、ある時点で、位置登録に値が入力され、ジャンプ（跳躍）などの他の適応特徴が解決され、いくつかの次に現れる動作区分が明確になる。例えば、次の２つの動作区分が確定している場合、上位の計画装置は、そのような次の２つの動作区分の掃引容積を計算することになる。
【0028】
本開示の技術は、個々のロボット動作区分の掃引容積の計算と、２つ以上の掃引容積の共通部分である重複領域の計算とを含む。掃引容積及び重複領域を計算するための任意の適切な方法を使用し得ることを理解されたい。
【0029】
上位の計画装置は、計算された掃引容積を作業空間管理装置モジュール５４０に送信するか発行する。作業空間管理装置モジュール５４０は、システム内の全てのロボット５１０～５３０の掃引容積間に発生する重複領域を計算する。ある時点では、ロボットが作業空間の離れた部分で作業しているため、掃引容積間に重複領域がない場合がある。他の時点では、ロボットの異なる対を含む領域など、ロボットの掃引容積間に２つ以上の重複領域が存在する場合がある。作業空間管理装置モジュール５４０は、有効な重複領域を、各重複領域に関与する全てのロボットに発行する。各重複領域の３Ｄ幾何学的形状を発行するとともに、作業空間管理装置モジュール５４０は、各領域に関与するロボットの識別情報と、各重複領域を現在占有している任意のロボットの識別情報とを継続的に発行する。
【0030】
ロボット５３０に戻ると、下位の補間器は、現在の動作区分の次に現れる時間ステップごとに実際のロボット動作（関節コマンド）を計算する。ロボットを移動させる前に下位の補間器は、作業空間について、間近の動作によってロボットが作業空間管理装置モジュール５４０によって発行された重複領域に進入するか否かを判定する。間近の動作によってロボットが重複領域に進入する場合に、ロボット制御装置は、別のロボットが既に重複領域を占有しているか否かを判定する。別のロボットが既に重複領域を占有している場合に、制御装置はロボットを動かさない。即ち、制御装置は、重複領域を同時に占有している２台のロボットによるデッドロックの状態を回避するように、ロボットを現在の位置に保持する。別のロボットが未だ重複領域を占有していない場合、制御装置は、下位の補間器によって計算された時間ステップ関節コマンドに従ってロボットを動かす。重複領域に進入すると、補間器モジュールは、このほかに上記で考察したように占有の追跡を維持している作業空間管理装置モジュール５４０に進入したことを発行する。補間器モジュールはこのほか、重複領域の退出事項を作業空間管理装置モジュール５４０に発行する。
【0031】
上記のプロセスは、ロボットがそれぞれのタスク（例えば、溶接、吹き付け塗装など）を実施している間、ロボットの操作全体にわたって継続する。各ロボットは、利用可能な次に現れる動作区分の掃引容積を計算する。作業空間管理装置モジュール５４０は、ロボットの掃引容積から重複領域を計算し、重複領域の占有を追跡し、領域とその状況を発行する。各ロボットは、動作の各時間ステップ（又は補間点）の前に重複領域の状況を検査して、占有されている重複領域に進入しないことを確実なものにする。開示した技術の追加の特徴及び能力を以下で考察する。
【0032】
図６は、本開示の一実施形態における図５に示す作業空間管理装置モジュール５４０の特徴を示すブロック図である。図６は、作業空間管理装置への入力と、作業空間管理装置による計算及び結果として得られるデータと、作業空間管理装置からの出力と、を示している。
【0033】
ボックス６１０は、作業空間管理装置がシステム内のロボット（例えば、図５のロボット５１０／５２０／５３０）の上位の計画装置モジュールから受信した入力を示す。これまでに考察したように、各ロボットは、利用可能で確定している各動作区分の掃引容積を発行する。ボックス６１０では、図５と同じように、ロボット「ｉ」には１からＮまでの番号が付けられている。例えば、第１の動作区分から開始して、第１のロボットは、「Seg１-１」というラベルの付いた掃引容積６１２を発行する。「Seg１-１」は、ロボット１からのものであり、動作区分番号１であることを示す。ロボット１は、ロボット１からのものであり動作区分番号「X」であることを示す「Seg１-X」としてラベル付けされた掃引容積６１４まで掃引容積を発行し続ける。同じように、Ｎ台のロボットのそれぞれは、動作区分が利用可能になると、それぞれの動作区分ごとに、ロボット番号と動作区分番号とでラベル付けされた掃引容積を発行する。各ロボットは、このほか、以前に発行された掃引容積（「Seg１-１」又は６１２など）の１つが完了すると、作業空間管理装置にメッセージを送信する。各ロボットの上位の計画装置が掃引容積データを送信するために使用するプロセスを図７に示す。
【0034】
好ましい一実施形態では、各掃引容積は、１つの動作区分のロボット動作を含む。吹き付け塗装、レーザ／アーク溶接又は材料分配などの連続的なプロセスを実施するロボットに特に適した別の実施形態では、動作区分の全部を中断することなく完了する必要があるため、ロボットが連続プロセスに含まれる全ての動作区分のロボットの動作を定義する単一の掃引容積を発行する。この実施形態について、以下でさらに考察する。
【0035】
ロボットからの利用可能な掃引容積（ボックス６１０）をボックス６２０において作業空間管理装置に提供する。ここで、掃引容積間の重複領域を計算する。ここでも、ロボット制御装置による掃引容積の発行は、ロボットの操作中にリアルタイムで継続されることが強調される。各ロボット制御装置は、動作区分が利用可能になると（確定されると）、その掃引容積を個別に発行する。図４に示すように、各重複領域は、２つ以上の掃引容積の共通部分によって定義される。重複領域は、典型的には、不規則な形状の３Ｄ容積であり、ボクセル（立方体又はレンガ状の体積要素）によって定義されても、他の３Ｄ立体又は表面幾何学定義技術によって定義されてもよい。
【0036】
ボックス６２０からの重複領域は、作業空間管理装置によって管理される重複領域プール６３０に提供される。重複領域プール６３０は、番号１からＭまでの範囲の重複領域を含むように示されている。代表的な重複領域「ｍ」（６３２）では、各重複領域でどの情報が管理されるかを示す。情報には、重複容積の３Ｄ定義と、重複領域に関与する各ロボットからの区分番号と、関連するロボット（重複領域に関与する区分を有するロボット）のリストと、現在重複領域にあるロボット（存在する場合）のリストとが含まれる。
【0037】
ボックス６４０は、作業空間管理装置によりシステム内のロボットの下位の補間器モジュールから受信された入力を示す。既に占有されている重複領域にロボットが進入しないことを確実なものにするという下位の補間器の役割に加えて、補間器は、この他に、ロボットが特定の重複領域にいつ出入りしたかを示すメッセージを発行する。メッセージ６４２は、ロボット「ｉ」が重複領域「ｍ」に進入した（または退出した）ことを示している。各ロボットの下位の補間器が掃引容積データを送信するために使用するプロセスを図８に示す。
【0038】
メッセージ６４２は、ボックス６５０において作業空間管理装置によって使用されて、重複領域プール６３０内の重複領域データを更新する。ボックス６５０にて作業空間管理装置が「領域から退出した」というメッセージを受信した場合、作業空間管理装置は、重複領域「ｍ」の領域内ロボットリストからロボット「ｉ」を除去する。同じように、ボックス６５０にて「領域に進入した」というメッセージを作業空間管理装置が受信した場合、作業空間管理装置はロボット「ｉ」を重複領域「ｍ」の領域内ロボットリストに追加する。
【0039】
ボックス６６０では、重複領域プール６３０内の重複領域が追加されるか、削除されるか、状況変更されるといつでも、影響を受ける重複領域は、影響を受けるロボットに発行（出力）される。例えば、重複領域「ｍ」の領域発行メッセージ６６２を考慮すると、ここで、領域「ｍ」は、関連するロボット（ｉ、ｊ及びｋ）への重複容積と、それぞれの動作区分番号と共に以前に発行されたものである。領域発行メッセージ６６２は、ロボット「ｉ」を領域内ロボットリストに追加する。このリストは、以下で考察するように、全ての関連するロボットにとって重要な情報である。他の領域発行メッセージの例においては、ロボット「ｉ」が領域「ｍ」を退出した（このため、領域内ロボットリストが空である）ことを示す後のメッセージと、ロボットから受信した最新の掃引容積に基づいて存在しなくなった領域「ｍ」を示すさらに後のメッセージと、が含まれる。
【0040】
図７は、本開示の一実施形態における図５に示すようなマルチロボットシステムにおけるそれぞれのロボットに対して上位の計画装置モジュールによって使用される方法のフローチャート図７００である。方法は、開始ブロック７０２から、決定ひし形７０４に進み、新たな動作区分が利用可能か否かが判定される。新たな動作区分は、ロボットが発行した掃引容積に以前は含まれていなかった動作区分である。ここで、新たな動作区分は完全に定義されている（例えば、工具先端点のジャンプが解消され、位置登録データが利用可能になっている）。これまでに考察したように、リアルタイムのロボット実行中に、適応動作プログラムにおいて動作区分を徐々に処理する能力は、現在開示している技術の重要な特徴である。
【0041】
新たな動作区分が利用可能である場合、ボックス７０６では高速補間が実施されて、動作区分に対するロボット動作を提供する。高速補間は、例えば、開始点及び終了点と、中間の補間点がある場合には少数の補間点を使用して、全ての関節動作の滑らかさの最適化計算を実施することなく、全体の動作区分を計算してもよい。ボックス７０８では、ボックス７０６において計算された動作区分の掃引容積が生成される。ボックス７１０では、ボックス７０８からの掃引容積は、作業空間管理装置に送信され、図６に示すようにボックス６１０で受信される。
【0042】
ボックス７１０において掃引容積が送信された後、あるいは決定ひし形７０４にて利用可能な新たな動作区分がない場合、決定ひし形７１２に到達する。決定ひし形７１２では、いずれかの動作区分が完了したか否かが判定される。完了した場合、ボックス７１４では、上位の計画装置は、重複領域プール内の任意／全部の重複領域から、完了した動作区分の掃引容積を除去する必要があると指示するメッセージを作業空間管理装置に送信する。掃引容積の除去によって影響を受ける（変更されるか削除される）任意の重複領域を、再発行することになる。上位の計画装置のプロセスは、任意の掃引容積除去通知が送信された後、終端７１６にて終了する。
【0043】
図８は、本開示の一実施形態における図５に示すようなマルチロボットシステム内のそれぞれのロボットに対して、下位の補間器モジュールが使用する方法のフローチャート図８００である。ボックス８０２では、次の移動補間点を計算する。当技術分野で知られているように、補間点は、動作区分に沿った複数の場所にてロボットの動作システムによって計算する。各補間点は、制御装置からロボットに送信される関節動作コマンドによって定義されるロボットの次の動作を規定する。ボックス８０４では、ロボット制御装置の下位の補間器は、作業空間管理装置によって発行された重複領域を受信する。このような領域は、図６に示されており、これまでに考察した領域発行メッセージ６６２である。
【0044】
決定ひし形８０６では、（下位の補間器によって補間された）現在の動作区分が作業空間管理装置によって発行された重複領域に関与しているか否かが判定される。関与していない場合、下位の補間器は、ボックス８０８において計算された補間点に移動するようにロボットに指示する。現在の動作区分が重複領域に関与している場合、決定ひし形８１０では、任意の他のロボットが現在重複領域にあるか否かが判定される。この情報は、作業空間管理装置からの領域発行メッセージの領域内ロボットリストから入手可能である。他のロボットが重複領域に現在は存在していない場合、下位の補間器はボックス８０８にてロボットに移動するように指示する。
【0045】
現在において任意の他のロボットが重複領域に存在する場合、決定ひし形８１２では、次の移動（計算された補間点）によってロボットが重複領域に進入するか否かが判定される。進入する場合に、デッドロックの状態が発生することを防ぐために、ボックス８１４にて下位の補間器がロボットに位置を保持するように指示する。次の移動（計算された補間点）によりロボットが重複領域に進入しない場合、下位の補間器はボックス８０８にてロボットに移動するように指示する。これまでに考察した要素８０６～８１４はいずれも、ロボット動作プログラム内のインターロックとして実装することができデッドロックを回避するために、必要に応じてロボットが位置を保持するようにする、る。
【0046】
ボックス８０８にて移動が実施されると、プロセスは進行し、重複領域に進入したか、退出したかを判定する。決定ひし形８１６では、完了したばかりの移動によってロボットが重複領域に進入した場合、ボックス８１８では、下位の補間器が「領域に進入した」というメッセージを作業空間管理装置に発行する。これは図６に示したものであり、ボックス６５０において下位の補間器からの進入／退出領域メッセージ６４２が作業空間管理装置によって受信され、作業空間管理装置は、その情報を使用して、関連する重複領域に対して領域内ロボットリストを更新した。決定ひし形８２０では、完了したばかりの移動によってロボットが重複領域から退出した場合、ボックス８２２では、下位の補間器が「領域から退出した」というメッセージを作業空間管理装置に発行し、そこでもメッセージは図６に示すように処理される。
【0047】
上記の考察を要約するために、図５は、システム内の作業空間管理装置とロボットとの上位の相互作用を示している。図６は、ロボット制御装置からの入力とロボット制御装置への出力を含む作業空間管理装置の詳細を示している。図７及び図８は、作業空間管理装置からの入力及び作業空間管理装置への出力を含むロボット制御装置の上位の計画装置モジュール及び下位の補間器モジュールがそれぞれ使用する方法を示す。
【0048】
前述及び以下の考察を通じて、下位の補間器によって評価される「次の移動」は、必ずしも単一のステップ又は補間点ではなく、次に現れるロボットの動作の任意の増分（例えば、関節動作の次の３つの補間点）であってもよい。
【0049】
図９Ａから図９Ｇは、本開示の実施形態における３台のロボットのシステムの重複領域及び事象の時系列の図である。図９Ａ～図９Ｇは、マルチロボットシステムにて重複領域が時間の経過とともにどのように変化し（即ち、出現し、形状変化し、消失し）、それに応じて管理されるかを明確に示す。図９Ａ～図９Ｇは、視覚的な明瞭さを維持するために２次元で示される。しかし、図４に示すように、掃引容積と重複領域は実際には本質的に３次元であることを理解されたい。
【0050】
図９Ａでは、ロボットＲ１が「Seg１-１」とラベル付けされた掃引容積９０２を発行し、ロボットＲ２が「Seg２-１」とラベル付けされた掃引容積９０４を発行し、ロボットＲ３は「Seg３-１」とラベル付けされた掃引容積９０６を発行する。掃引容積Seg１-１、Seg２-１及びSeg３-１は、図９Ａの上部／左部にて簡略化された幾何学的形態で示され、図９Ａの下部／右部にて（Ｓ１-１などの簡略化された表記法を使用して）ブロック図形式で示される。ここで、これらの掃引容積は、それぞれのロボットによって作業空間管理装置（ＷＳＭＧＲ）に発行され、作業空間管理装置は、最新の掃引容積データを使用して、重複領域プール９２０内の重複領域を更新する。重複領域「領域１」は、参照番号９３０によって幾何学的に示すように、掃引容積Seg１－１とSeg２－１の共通部分によって形成される。関連するロボット及び関与する動作区分を含む領域１に関するデータは、重複領域プール９２０に示されている。領域内のロボットリストは図９Ａ～図９Ｇには示されていないが、このデータは、重複領域プール９２０内の各領域に関連しているために容易に理解される。
【0051】
図９Ｂでは、ロボットＲ１は、幾何学的描写及びブロック図に示すように、「Seg１-２」とラベル付けされた新たな掃引容積９０８を発行する。ロボットＲ１からのSeg１-２の追加により、ロボットＲ１とＲ２の動作の間の重複領域が大きくなる。このため、作業空間管理装置によって再計算された重複領域１（９３０）は、図示のようにサイズが大きくなっている。領域１が既に存在して変更されているために、新たな重複領域は作成されないことに留意されたい。この事象（Ｒ１が新たな掃引容積Seg１-２を発行する）に基づいて、作業空間管理装置は、重複領域プール９２０に示すように、領域の幾何学定義が変更され、関与する動作区分リストが変更されたために、重複領域１を再発行する。さらに、Seg１-１とSeg１-２の重複は、この２つの掃引容積が両方ともロボットＲ１からのものであるため、重複領域を作成しないことに留意されたい。
【0052】
図９Ｃでは、ロボットＲ３は、幾何学的描写及びブロック図に示すように、「Seg３-２」とラベル付けされた掃引容積９１０を発行する。ロボットＲ３からのSeg３-２の追加により、ロボットＲ１とＲ３の動作の間に新たな重複領域「領域２」が作成される。領域２は、幾何学的描写（９３２）と重複領域プール９２０のブロック図に示される。既存の領域１は、領域２の作成による影響を受けない。この事象（Ｒ３が掃引容積Seg３-２を発行する）に基づいて、作業空間管理装置は、領域２を、その幾何学的定義、関連するロボットのリスト、関与する動作区分と共に発行するであろうが、重複領域１については、この領域に関連するものが変更されないため、再発行しないであろう。
【0053】
図９Ｄでは、ロボットＲ２は、幾何学的描写及びブロック図に示すように、「Seg２-２」とラベル付けされた掃引容積９１２を発行する。図示のように、ロボットＲ２からのSeg２-２を追加することにより、領域２（９３２）の幾何学的形状が大幅に異なるものになる。ここで、領域２には、この他に幾何学的描写及び重複領域プール９２０のブロック図に示すように、関連するロボット及び関与する動作区分の改訂されたリストが含まれる。既存の領域１は、領域２への変更の影響を受けない。この事象（Ｒ２が掃引容積Seg２-２を発行する）に基づいて、作業空間管理装置は、修正された幾何学定義、関連するロボットの修正されたリスト、及び更新された関与する動作区分と共に、領域２を再発行するであろう。また、領域１については、この領域に関連する変更がないため、再発行されないであろう。
【0054】
図９Ｅでは、ロボットＲ１は、幾何学的描写及びブロック図に示されるように、掃引容積「Seg１-１」（９０２）の完了を発行する。図示のように、ロボットＲ１によるSeg１-１の完了により、領域１（９３０）の幾何学的形状が大幅に異なるものになる。領域１は、幾何学的描写及び重複領域プール９２０のブロック図に示されるように、関与する動作区分の改訂リストが含まれる。既存の領域２は、領域１への変更の影響を受けない。この事象（Ｒ１が掃引容積Seg１-１の終了を発行する）に基づいて、作業空間管理装置は、その修正された幾何学定義と、関与する動作区分の修正されたリストと共に、領域１を再発行するであろう。領域２については、この領域に関連するものは何も変更されていないため、再発行されないであろう。
【0055】
図９Ｆでは、ロボットＲ２は、幾何学的描写及びブロック図に示すように、掃引容積Seg２－１（９０４）の完了を発行し、ロボットＲ３は、掃引容積Seg３－１（９０６）の完了を発行する。ロボットＲ２によるSeg２-１の完了により、幾何学的描写及び重複領域プール９２０のブロック図に示すように、領域１（９３０）が削除される。既存の領域２は、掃引容積Seg２-１の完了又は掃引容積Seg３-１の完了によって影響を受けない。この事項（掃引容積Seg２-１及びSeg３-１の終了）に基づいて、作業空間管理装置は、領域１の削除を発行するであろう。領域２については、この領域に関連するものは何も変更されていないため、再発行されないであろう。
【0056】
図９Ｇでは、それぞれのロボットＲ１／Ｒ２／Ｒ３が、図９Ｆ（Seg１-２、Seg２-２及びSeg３-２）において残っているそれぞれの掃引容積の終了を発行し、それぞれのロボットＲ１／Ｒ２／Ｒ３が、新たな掃引容積（Seg１-３、Seg２-３及びSeg３-３）を発行する。幾何学的描写及びブロック図に示すように、領域２は、その関与する全掃引容積が完了すると消失し、新たに発行された掃引容積間に重複がないため、新たな重複領域が作成されない。このため、作業空間管理装置は領域２の削除を発行するであろう。
【0057】
図９Ａ～図９Ｆに示されるプロセスは、ロボットの動作プログラムが完了するまで、ロボットによる新たな掃引容積の発行と、作業空間管理装置によって処理される重複領域の出現、消失、及び変更を継続するであろう。作業空間管理装置は、所与の時間ステップでの複数のロボットからの新たな掃引容積の発行、任意の時間ステップにて１つのロボットからの複数の掃引容積の発行などを任意の組み合わせで処理することができる。この全ステップの間、ロボットは、重複領域情報を使用して、占有される重複領域に進入することを回避し、それによって、デッドロックの状態の発生を防止する。
【0058】
作業空間管理装置と、ロボット制御装置からの入力及びロボット制御装置への出力とを含む図５～図８のフローチャート及びブロック図に示され、図９Ａ～図９Ｆの重複領域の時系列に描かれた上記で開示したオンラインインターロック挿入技術では、適応動作事項が原因で事前に解析することができないロボット動作プログラムのデッドロックの状態を良好に回避することが実証された。この技術は、必要に応じてロボットが位置を保持し、占有された重複領域に進入しないようにすることに効果的である。この技術は、計算によるロボットの動作の速度低下を引き起こすことなく、リアルタイムで計算することができて効率的である。
【0059】
しかし、特定の状態においては、１台のロボットが新たな動作区分の掃引容積を発行し、別のロボットが、更新された重複領域の空間の一部を既に占有している場合に、重複領域が変更されるため、上記で開示した技術を使用すると、デッドロックの状態が未だ発生する可能性がある。この状況とその解決策については、以下で考察する。
【0060】
図１０Ａ／１０Ｂ／１０Ｃは、いずれのロボットも占有された重複領域に移動していないにもかかわらず、デッドロックの状態が発生する２台のロボットのシステムの漸進的な図である。ロボット１０００及びロボット１０１０は、図２に関して、これまでに考察したのと同じ方法で、基部、ロボットアーム及び工具又はエンドエフェクタを有する単純なロボットとして上面（平面）図にて示されている。ロボット１０００は、経路１００２に沿って（直線的に右から左へ）移動する工具を有することに対し、ロボット１０１０は、経路１０１２に沿って（ブーメラン形状で左から右へ）移動する工具を有する。ロボット１０００及び１０１０はそれぞれ、次に現れる動作区分の掃引容積を発行しており、作業空間管理装置は、図示のように重複領域１０２０を計算している。
【0061】
図１０Ａでは、ロボット１０００／１０１０のいずれも未だ移動しておらず、ロボット１０００及び１０１０の両方が重複領域１０２０の外に留まっている。図１０Ｂでは、ロボット１０００及び１０１０の両方がそれぞれの経路に沿って移動している。ロボット１０１０は、現在、重複領域１０２０の内側にある。ロボット１０００は重複領域１０２０の外に留まり、次の移動がロボット１０００を占有された重複領域に進入させることから、経路に沿ってさらに移動することはできない。
【0062】
図１０Ｃでは、ロボット１０００／１０１０のいずれも、図１０Ｂからさらに移動していない。しかし、ロボット１０１０は、重複領域１０２０Ａとして示す新たな位置に重複領域１０２０を移動させた新たな動作区分の掃引容積を発行した。ロボット１０００は占有された重複領域に移動しなかったが、ここではロボット１０１０と共に重複領域１０２０Ａ内にいることがわかる。ロボット１０００／１０１０のどちらも、衝突を引き起こさずにそれぞれの経路に沿ってさらに移動することができないため、ここではデッドロックの状態が存在する。
【0063】
図１１は、本開示の一実施形態における図１０Ａから図１０Ｃに示すようなマルチロボットシステムの各ロボットの制御装置の下位の補間器モジュールによって使用される方法のフローチャート図１１００である。図１１の下位の補間方法は、図１１にて追加された要素１１１０～１１１６（影付き）を除いて、これまでに考察した図８の下位の補間方法と同じである。図８の全部の要素ステップは、それぞれの元の番号を保持すため、ここではこれ以上考察することはしない。
【0064】
決定ひし形８１０の後に、新たな決定ひし形１１１０が追加される。別のロボットが重複領域に存在する（決定ひし形８１０における「はい」）場合に、決定ひし形１１１０では、ロボット自体（下位の補間器方法が実施されるロボット）も重複領域にあるか否かを判定する。この状況は、図１０Ｃに示すように、他のロボットが新たな動作区分の掃引容積を発行したために重複領域幾何学が変更された場合に、発生することがあり得る。
【0065】
決定ひし形１１１０においてロボットが重複領域に存在する場合、ボックス１１１２では、前の掃引容積によって定義された重複領域が検査される。決定ひし形１１１４では、ロボットは、前の掃引容積からの重複領域に存在していたか否かを判定する。重複領域にない場合、ボックス１１１６において、ロボットは「再生」されるか、その動作経路に沿って１ステップ後方に移動する。この行動は、ロボットが前の掃引容積から重複領域にない場合には、更新された重複領域の発行が領域の二重占有を引き起こしたに違いないことを意味するために実施される。図１０Ａ～図１０Ｃの例では、ボックス１１１６における再生により、ロボット１０００は、図１０Ａに示される位置に戻り、ロボット１０１０は、次に動作経路の終端まで移動することができ、その後に、ロボット１０００はその動作経路全体に沿って移動することがあり得る。
【0066】
決定ひし形１１１４において、ロボットが前の掃引容積からの重複領域にあったと判定した場合、ボックス８１４では、ロボットは再生されずにその位置を保持する。この状況では、重複領域に関与する（同じ論理を使用する）他のロボットは自身が再生可能であることを認識する場合があり、これにより前述の考察したデッドロック状況が解消されるであろう。
【0067】
図１０Ａ～１０Ｃに示すデッドロック状況は、ロボット１０００が脆弱な位置にすでに移動した後に、ロボット１０１０が新たな動作区分の掃引容積を発行したために生じた。これまでに考察したように、動作区分のこの種の遅延発行は、適応特徴（例えば、ジャンプ、位置登録）を有するロボットの動作プログラムにて発生することがある。図１１の方法は、動作区分のこの種の遅延発行のために発生するデッドロック状況を自動的に解消するための技術を提供する。ここで、自動デッドロック解消により、１台のロボットがわずかに後退するだけでロボットの動作が維持される。自動デッドロック解消により、マルチロボットシステムの完全な停止と、これまでに必要であった操作者介入の必要性とが回避される。
【0068】
一部のマルチロボットシステムには、吹き付け塗装又はレーザ／アーク溶接などの連続的なプロセス操作を実施する１つ又は複数のロボットが含まれる。このような継続的なプロセス操作は、操作の品質が低下することになるため、いったん開始すると中断することができない。この状況には、上記のデッドロック防止方法及びシステムにさらに論理を追加することによって適応することができる。特に、デッドロックの状態を回避する必要がある場合に、他のロボットが位置を保持する役割を果たすように、開始された連続的なプロセス操作を優先することができる。これを図１２～図１４に示す。
【0069】
図１２は、本開示の一実施形態におけるマルチロボットシステムの連続的なプロセス操作を実施する各ロボットの制御装置の動作計画装置によって使用される方法のフローチャート図である。図１２の方法の目的は、プロセス操作全体の掃引容積を計算することである。ボックス１２０２では、開始事項及び終了事項を見つけるために、プロセス動作が分析される。例えば、典型的な動作プログラムには、プロセスを起動するコマンド「Ｗｅｌｄ Ｏｎ」又は「Ｐａｉｎｔ Ｏｎ」と、プロセスを停止する類似のコマンドが含まれるかもしれない。動作プログラムの開始事項と終了事項とが識別されると、ボックス１２０４では、典型的には複数の動作区分を含むプロセス操作の動作全体の掃引容積が計算される。ジャンプなどの適応動作事項は、典型的には、プロセス操作内には現れないため、計算された掃引容積は正確である必要がある。ボックス１２０６では、プロセス操作の計算された掃引容積は、ロボット制御装置のメモリに保存される。
【0070】
図１３は、本開示の一実施形態におけるマルチロボットシステムにて連続的なプロセス操作を実施する各ロボットの制御装置の上位の計画装置によって使用される方法のフローチャート図である。ロボットの動作プログラムの実行中にプロセス開始指令を受けると、ボックス１３０２では、（図１２にて計算され保存された）プロセス掃引容積がロボットの上位の計画装置によって発行される。決定ひし形１３０４では、任意の他のロボットがプロセス掃引容積に関与する任意の重複領域内に存在するか否かが判定される。重複領域に存在する場合に、ロボットは、他のロボットが重複領域を空けるまで、決定ひし形１３０４にてループし続ける。ボックス１３０６では、重複領域が空になると、ロボットはプロセスを開始する（例えば、吹き付け塗装を開始する）。ボックス１３０８では、ロボットは、「領域に進入した」というメッセージを作業空間管理装置に発行する。プロセス掃引容積が発行され、関連する重複領域にロボットが現在進入している状態では、システム内の他のロボットが重複領域から離れたままになり、ロボットはデッドロックのリスクなしにプロセス操作を完了することができる。
【0071】
プロセス終了指令を受けると、ボックス１３１０にて、ロボットは作業空間管理装置にプロセス掃引容積が完了し、除去することができることを通知する。ボックス１３１２では、ロボットはプロセスを終了する（例えば、吹き付け塗装を停止する）。ボックス１３１４では、ロボットは「領域から退出した」というメッセージを作業空間管理装置に発行する。プロセス掃引容積が除去され、関連する重複領域からロボットが現在退出している状態では、システムの全ロボットは、前述のデッドロック回避方法（オンラインの掃引容積検査と再生）を使用して再開される。
【0072】
図１４は、本開示の一実施形態におけるマルチロボットシステムにおいて連続的なプロセス操作を実施する各ロボットの制御装置内の下位の補間器によって使用される方法のフローチャート図である。ロボットの次の移動のために補間点が計算されると、決定ひし形１４０２において、現在の動作区分にプロセス操作があるか否かが判定される。プロセス操作がある場合、決定ひし形１４０４にて、下位の補間器は、（同じロボット制御装置の）上位の計画装置を検査して、プロセスの動作全体の掃引容積が発行されて、プロセスを開始してもよいか否かを判定する。即ち、図１３のボックス１３０６に到達した場合、決定ひし形１４０４において、上位の計画装置は下位の補間器にプロセスを開始してもよいことを伝え、ボックス１４０６において下位の補間器はロボットに次の補間点に移動するように伝える。プロセス操作が開始されると、ロボットは、プロセスが終了するまで、次の各補間点に移動するための許可を自身に提供し続けることになる。
【0073】
決定ひし形１４０４において、上位の計画装置が下位の補間器に、プロセスを開始してはいけない（例えば、プロセス掃引容積が未だ発行されていないか、結果として生じる重複領域が別のロボットによって占有されている）ことを伝える場合に、下位の補間器は、ボックス１４０６にて位置を保持するようにロボットに伝える。ロボットは、上位の計画装置から、プロセス掃引容積に移動する許可を受け取るまで、位置を保持し続けることになる。
【0074】
決定ひし形１４０２において、現在の動作区分に連続的なプロセス操作がないと判定された場合、ボックス１４１０において、オンライン掃引容積の発行、重複領域の検査及び再生の方法（上記で考察した図１１）が使用される。
【0075】
図１２～図１４の方法に示す連続的なプロセス操作に対応するために必要な変更は最小限であり、重複領域プールのデータモデルを変更する必要がないことは注目に値する。他のロボットの認知のために、進行中の処理の通知を発行する必要はない。プロセス全体の掃引容積を発行し、前述の方法で領域の進入／退出メッセージを発行すればよい。
【0076】
上記で開示した全ての方法及びシステムでは、説明したロボット制御装置の上位の計画装置及び下位の補間器の機能は、一実施形態例として理解されるべきものである。異なるロボット制御装置の設計では、このように上位の計画装置モジュールと下位の補間器モジュールとの間で計算、特徴及び機能が分担されない場合がある。ロボット制御装置が動作区分の掃引容積の発行と移動前の検査を実施して、占有された重複領域への進入を回避する限り、開示した技術は、デッドロック状況を効果的に防止したり、及び／又は解消したりするであろう。
【0077】
これまでの考察を通じて、さまざまなコンピュータと制御装置を説明し、暗示している。このようなコンピュータ及び制御装置のソフトウェアアプリケーション及びモジュールは、プロセッサ及びメモリモジュールを有する１つ又は複数の計算装置で実行されることを理解されたい。特に、これは、図１に関して上記で考察したように、ロボット制御装置１０２及び１１２と任意に付加される作業セル制御装置１３０のそれぞれは、プロセッサを含む。具体的には、ロボット制御装置及び作業セル制御装置内のプロセッサは、これまでの開示全体にわたって説明した方法で、動作区分の掃引容積の発行と、重複領域の計算及び発行と、占有された重複領域への進入を回避するための事前移動の検査とを実施するように構成される。さらに、用途に最も適した適応であるように、作業セル内のロボットごとに個別の制御装置を設けても、１つの制御装置を使用して複数のロボットの動作を制御してもよいことを理解されたい。いずれの場合においても、これまでに説明した上位の計画装置及び下位の補間器の機能を含む、それぞれのロボットごとに動作を計算する動作計画装置モジュールがある。
【0078】
上記で概説したように、ロボット動作計画におけるデッドロック回避のための開示技術は、デッドロック防止の堅牢性及び信頼性を改善する。開示技術では、重複領域を回避するために手動で定義されたインターロックの事前の取り組みと固有の不正確さとを回避し、自動の重複領域回避インターロックを、実際のオンラインのロボット操作中にのみ計算されるジャンプ及び位置登録などの適応機能を含む動作プログラムにも追加することを可能にする。
【0079】
ロボット動作計画におけるデッドロック回避の多くの例示的な態様及び実施形態について上記で考察したが、当業者であれば、その修正、置換、追加及び部分的な組み合わせを認識するであろう。このため、以下の添付の特許請求の範囲及び以下に導入される特許請求の範囲は、その真の精神及び範囲内にあるようなあらゆる修正、置換、追加及び部分的な組み合わせを含むと解釈されることを意図するものである。
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9A】
【図9B】
【図9C】
【図9D】
【図9E】
【図9F】
【図9G】
【図10A-10C】
【図11】
【図12-14】
【手続補正書】
【提出日】2023-05-11
【手続補正1】
【補正対象書類名】図面
【補正対象項目名】全図
【補正方法】変更
【補正の内容】
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9A】
【図9B】
【図9C】
【図9D】
【図9E】
【図9F】
【図9G】
【図10A-10C】
【図11】
【図12】
【図13】
【図14】
【外国語明細書】