協調搬送方法および協調搬送装置
【課題】搬送重量あたりの機器コストを低減でき、重量物の搬送に有利な協調搬送方法および協調搬送装置を提供する。
【解決手段】
複数台の移動式クレーンロボット１０Ａ（リーダ１１およびフォロワ１２）により搬送物体１を共吊りしながら目的地まで搬送する。搬送物体１とフォロワ１２のワイヤ６との接続点にマーカ１３を設置し、マーカ１３を上方から撮像する撮像装置８をフォロワ１２に設置する。リーダ１１に目的地までの動作指令を与え、撮像装置８の画像からフォロワ１２の座標系におけるマーカ１３の位置を検知して位置情報を生成し、この位置情報に基づいてリーダ１１の動作を推定し、推定したリーダ１１の動作に基づいてフォロワ１２の動作を制御する。
【解決手段】
複数台の移動式クレーンロボット１０Ａ（リーダ１１およびフォロワ１２）により搬送物体１を共吊りしながら目的地まで搬送する。搬送物体１とフォロワ１２のワイヤ６との接続点にマーカ１３を設置し、マーカ１３を上方から撮像する撮像装置８をフォロワ１２に設置する。リーダ１１に目的地までの動作指令を与え、撮像装置８の画像からフォロワ１２の座標系におけるマーカ１３の位置を検知して位置情報を生成し、この位置情報に基づいてリーダ１１の動作を推定し、推定したリーダ１１の動作に基づいてフォロワ１２の動作を制御する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、重量物、長物などを複数台の移動式クレーンロボットにより搬送させる協調搬送方法および協調搬送装置に関するものである。
【背景技術】
【０００２】
近年、工事現場や工場、倉庫などで生産の自動化への要求が高まっており、無人搬送車や天井クレーン、ロボットにより物体の搬送を行っている。しかし、様々な物体を搬送するためには、ロボットの能力には限界があり、ロボットの搬送能力を超える大型な物体などは当該ロボットでは搬送できず、別の新たなロボットを投入しなければならない。
これに対し、小型のロボットを複数台投入して人間のように協調して搬送させることで、１台では搬送できなかった物体も搬送することが可能となり、また、様々な大きさの物体に応じてロボットの台数を変更することにより柔軟に対応できることから、このような現場での作業の効率化が期待されている。
【０００３】
従来、この種の協調搬送については、主にマニピュレータやフォークリフトを備えた移動ロボットにより実現されている。
例えば、下記非特許文献１では、複数台のロボットからリーダとなる１台のロボットを選択し、フォロワと称する残りのロボットは何らかのセンサによってリーダの動作を推定し、搬送物体を目的地まで協調搬送する方法について一つの提案がなされている。
また、下記特許文献１では、２輪独立駆動方式のロボットの協調搬送において、駆動輪の２車輪の中点から車輪の進行方向に所定距離を隔てた位置で、その垂直軸周り回転自在に搬送物体を支持し、その支持点の移動速度、搬送物体に掛かる内力を制御して協調搬送する方法について一つの提案がなされている。
【０００４】
【非特許文献１】小菅一弘、大住智宏、千葉晋彦：日本ロボット学会誌、ｖｏｌ．１６、Ｎｏ．１、ｐｐ．８７〜９５、１９９８
【特許文献１】特開２０００−４２９５８号公報
【発明の開示】
【発明が解決しようとする課題】
【０００５】
上記のように、従来技術による協調搬送は、主にマニピュレータやフォークリフトを備えた移動ロボットにより実現されている。
しかしながら、搬送作業に限定した場合、マニピュレータやフォークリフトによる搬送では、搬送重量あたりの機器コストが高く、重量物の搬送には適していないという問題がある。
【０００６】
本発明は、このような事情に鑑みてなされたものであり、搬送重量あたりの機器コストを低減でき、重量物の搬送に有利な協調搬送方法および協調搬送装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
上記の課題を解決するため、本発明の協調搬送方法および協調搬送装置は、以下の手段を採用する。
すなわち、本発明にかかる協調搬送方法は、搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された移動式クレーンロボットを複数台用い、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する、ことを特徴とする。
【０００８】
このように、搬送物体を複数台の移動型クレーンロボットにより協調搬送するので、従来のマニピュレータなどを用いた協調搬送よりも搬送重量あたりの機器コストが低減でき、重量物の搬送に対して有利である。
【０００９】
また、本発明にかかる協調搬送方法では、前記複数の移動式クレーンロボットのうち一台を目的地までの動作指令が与えられるリーダとし、他の残りの移動式クレーンロボットを前記リーダの動作を推定しながら移動するフォロワとし、搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置を前記フォロワに設置し、前記リーダに目的地までの動作指令を与え、前記撮像装置の画像からフォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成し、該位置情報に基づいて前記リーダの動作を推定し、推定した前記リーダの動作に基づいて前記フォロワの動作を制御する、ことを特徴とする。なお、ここで、上記「動作指令」には、コンピュータによる動作指令のみならず、人間の運転又は通信手段を介した操作（リモートコントロール）による動作指令も含まれる。
【００１０】
このように、リーダに目的地までの動作指令を与えて動作すると、フォロワは、搬送物体、ワイヤまたはこれらの所定部位の位置の変化からリーダの動作を推定し、リーダの動作から各自の目標位置を決定し動作するので、複数台のロボットに動作指令を与える必要がなく、また、リーダ・フォロワ間、フォロワ同士の通信も必要としない。
このため、全てのロボットに動作指令（目標軌道）を与える場合に比べて、目的地の変更の際にリーダの動作指令のみを変更すればよく、フォロワの制御に関しては変更が不要という利点がある。また、リーダとなる移動式クレーンロボットを人間の操作（運転又はリモートコントロール）により動作させても、協調搬送が可能である。
【００１１】
また、本発明にかかる協調搬送方法では、推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする。
【００１２】
このように、フォロワは、リーダとフォロワの相対位置を初期状態におけるリーダとフォロワの相対位置に保持するように動作するので、移動物体の搬送中において、各移動式クレーンロボットが搬送物体に接近して衝突したり、各ロボットの距離が離れすぎて搬送物体の重さにより倒れたりすることがなく、確実に搬送物体を目的地まで搬送することができる。
【００１３】
また、本発明にかかる協調搬送方法では、前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について前記搬送物体の振れによる誤差を修正する、ことを特徴とする。
【００１４】
このように、撮像装置により撮像した画像に基づいて検知した位置について、搬送物体の振れによる誤差を修正するので、リーダの動作（位置、向き）を正確に推定することができる。このため、各フォロワはリーダとの相対位置を一定に保ちながら、安定して搬送物体を搬送することができる。
【００１５】
また、本発明にかかる協調搬送装置は、搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された複数台の移動式クレーンロボットからなり、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する協調搬送装置であって、該複数台の移動式クレーンロボットのうち一台は、目的地までの動作指令が与えられるリーダであり、他の残りの移動式クレーンロボットは、前記リーダの動作を推定しながら移動するフォロワであり、該フォロワは、前記搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置と、該撮像装置の画像から当該フォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成する位置検知部と、前記位置情報に基づいて前記リーダの動作を推定する動作推定部と、推定されたリーダの動作に基づいて当該フォロワの動作を制御する動作制御部と、を有する、ことを特徴とする。
【００１６】
また、本発明にかかる協調搬送装置では、前記動作制御部は、推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする。
【００１７】
また、本発明にかかる協調搬送装置では、前記フォロワは、前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について搬送物体の振れによる誤差を修正する誤差修正部をさらに有する、ことを特徴とする。
【００１８】
上記の協調搬送装置により、本発明の協調搬送方法を実施することができる。
【発明の効果】
【００１９】
本発明によれば、搬送重量あたりの機器コストを低減でき、重量物の搬送に有利である、という優れた効果が得られる。
【発明を実施するための最良の形態】
【００２０】
以下、本発明の好ましい実施形態を添付図面に基づいて詳細に説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。
【００２１】
図１は、本発明の実施形態にかかる協調搬送装置１０の概要を示す図である。
図１に示すように、この協調搬送装置１０は、搬送物体１を吊り下げ可能なクレーン４を備え且つ移動可能に構成された複数台の移動式クレーンロボット１０Ａからなる。各移動式クレーンロボット１０Ａは、前進、後進、左右方向への旋回を行って自在に地上を走行し移動することができ、これら複数台の移動式クレーンロボット１０Ａにより搬送物体１を共吊りしながら目的地まで協調して搬送する。
本実施形態において移動式クレーンロボット１０Ａは２台であるが、搬送物体１の重量、大きさ、移動式クレーンロボット１０Ａの搬送能力などにより、３台以上で協調搬送するようにしてもよい。
【００２２】
上記の複数の移動式クレーンロボット１０Ａのうち一台を目的地までの動作指令が与えられるリーダとし、他の残りの移動式クレーンロボット１０Ａをリーダの動作を推定しながら移動するフォロワとする。本実施形態では、図１の左側のロボット１０Ａがリーダ１１であり、右側のロボット１０Ａがフォロワ１２である。
【００２３】
移動式クレーンロボット１０Ａは、リーダ１１、フォロワ１２ともに、地上を走行可能な移動台車３と、移動台車３上に設けられたクレーン４とを備える。クレーン４は、支柱５と、支柱５に取り付けられたワイヤ６を備え、ワイヤ６の先端部に設けられたフックなどにより搬送物体１を吊り下げるようになっている。本実施形態では、リーダ１１とフォロワ１２のクレーン４のワイヤ６は、ともに同一長さであり、上端部の取り付け高さも同一に設定されている。
ここで、リーダ１１とフォロワ１２が前後方向に関して同一位置でかつ平行に並んだ状態における、リーダ１１とフォロワ１２のワイヤ６の上端間の距離を車間距離ｄとし、この状態を初期状態とする。
【００２４】
リーダ１１は、目的地までの動作指令が与えられて動作するが、この動作指令は、予めプログラミングされたものでも、通信手段を介して他の制御装置から動作指令を受けるものでも、あるいは、人間の運転又は通信手段を介した操作（リモートコントロール）による動作指令であってもよい。
【００２５】
フォロワ１２である移動式クレーン４ロボット１０Ａは、さらに、搬送物体１とクレーン４のワイヤ６を上方から撮像する撮像装置８（例えば、ビデオカメラ）を備えている。また、この撮像装置８を支持するためのビーム９がクレーン４の支柱５に設けられている。この撮像装置８は、搬送物体１、搬送物体１を吊り下げた状態のクレーン４のワイヤ６のうち少なくともいずれかを上方から撮像し、これらの中から特定の部位を、後述する位置検知部２１（図３参照）における位置の検知対象とする。
本実施形態では、搬送物体１とフォロワ１２のクレーン４のワイヤ６との接続点に、撮像装置８によって識別可能なマーカ１３が設置されており、マーカ１３を位置の検知対象となる特定部位としている。
なお、マーカ１３を設置せずに、搬送物体１自体の全体又は一部の形状を特徴点としてパターンマッチングなどの画像処理により、特定部位の位置を検知するようにしてもよい。またマーカ１３は、搬送物体１とフォロワ１２のクレーン４のワイヤ６との接続点以外の部位に設置されてもよい。
【００２６】
図２は、リーダ１１、フォロワ１２および搬送物体１を上方から見た図であって、リーダ１１にある動作指令を与えてリーダ１１が動作し、搬送物体１が移動した状態を示すものである。また枠１５で囲んだ範囲は撮像装置８によって撮像される画像の範囲である。なお、破線は、初期状態におけるリーダ１１とそのワイヤ６、搬送物体１、フォロワ１２のワイヤ６を示している。
このように、リーダ１１が動作し、リーダ１１とフォロワ１２の相対位置が初期状態から変化することで、搬送物体１とワイヤ６の位置が変位し、マーカ１３の位置も変位する。ここで、フォロワ１２のワイヤ６の上端の位置を座標系のゼロ点としたときのマーカ１３の位置をｌｖ、φｖで表現する。
なお、このように撮像装置８によりマーカ１３の位置変位を追跡する必要があるので、リーダ１１が動作に伴ってマーカ１３の位置が移動しても撮像画像上にマーカ１３が収まるように、撮像装置８の画角や設置高さが設定される。
【００２７】
また、図１に示すように、フォロワ１２である移動式クレーンロボット１０Ａは、種々の情報処理、演算、制御を行う処理部２０を備えている。
図３は、フォロワ１２である移動式クレーンロボット１０Ａの処理部２０の構成を示す図である。処理部２０は、位置検知部２１と、誤差修正部２２と、動作推定部２３と、動作制御部２４と、を有している。
位置検知部２１は、撮像装置８から画像信号を受け、フォロワ１２の座標系における搬送物体１、ワイヤ６またはこれらの所定部位の位置を検知してその位置情報を生成する。本実施形態では、撮像装置８の画像から検知するのは、上記のマーカ１３の位置である。
【００２８】
誤差修正部２２は、移動式クレーンロボット１０Ａ（リーダ１１およびフォロワ１２）の動作による搬送物体１の振れを推定し、この推定値に基づいて、上記の検知した位置について搬送物体１の振れによる誤差を修正する。検知したマーカ１３の位置情報は搬送物体１の振れによる誤差も含んでいる。それによりリーダ１１が停止したにも関わらず搬送物体１が振れているとフォロワ１２は搬送物体１の振れを検知し、それによって動作してしまう。そこで、誤差修正部２２において、搬送物体１の振れによる誤差を修正する。
【００２９】
動作推定部２３は、搬送物体１の位置情報に基づいてリーダ１１の動作を推定する。この搬送物体１の位置情報は、誤差修正部２２により搬送物体１の振れによる誤差が修正された位置情報である。具体的には、上部から投影した２本のワイヤ６は搬送物体１に対称な向きと長さになるので、撮像装置８の画像に基づいて検知した搬送物体１の位置から、フォロワ１２の座標系におけるリーダ１１の位置と向きを推定することができる。
【００３０】
動作制御部２４は、推定されたリーダ１１の動作に基づいてフォロワ１２の動作を制御する。具体的には、動作制御部２４は、推定されたリーダ１１の動作に基づいて、リーダ１１とフォロワ１２の相対位置を初期状態におけるリーダ１１とフォロワ１２の相対位置に保持するように、フォロワ１２の動作を制御する。
【００３１】
このような処理部２０は、例えば、マイクロコンピュータで構成することができ、上記の位置検知部２１、誤差修正部２２、動作推定部２３および動作制御部２４は、そのようなマイクロコンピュータの機能の一部として実現することができる。
【００３２】
次に、本実施形態にかかる協調搬送装置１０の動作によって実現される協調搬送方法について説明する。
図４は、リーダ１１の動作の一例として右旋回しながら前進した場合の、リーダ１１、フォロワ１２および搬送物体１を上方から見たときのこれらの位置関係を示す図である。
初期状態からリーダ１１にある動作指令を与えて動作させた場合、リーダ１１とフォロワ１２の相対位置が変化することで、搬送物体１とワイヤ６の位置が変位し、マーカ１３の位置も変位する。フォロワ１２は、撮像装置８によりマーカ１３の動きを撮像しており、位置検知部２１によりフォロワ１２の座標系におけるマーカ１３の位置を検知する。
【００３３】
位置検知部２１により検知したマーカ１３の位置情報は搬送物体１の振れによる誤差も含んでいるので、誤差修正部２２により、以下の方法により誤差を修正する。
搬送物体１の振れはリーダ１１とフォロワ１２の加速度に依存するものであり、誤差修正部２２は、フォロワ１２の速度から搬送物体１の振れを以下の式（数１）から推定する。
【００３４】
【数１】
【００３５】
ここで、ｌはワイヤ６の長さであり、ｇは重力加速度である。求めた振れ角により以下の式（数２、数３）から、検知したマーカ１３の位置情報を修正する。
【００３６】
【数２】
【００３７】
【数３】
【００３８】
振れが生じなければ、図４のように二本のワイヤ６は搬送物体１に対称であるので、動作推定部２３はマーカ１３の位置情報から幾何学的にリーダ１１の位置と向きを推定し、動作制御部２４はリーダ１１とフォロワ１２の初期状態における相対位置を保持するための目標位置と向きを、以下の式（数４〜数６）により決定する。
【００３９】
【数４】
【００４０】
【数５】
【００４１】
【数６】
【００４２】
ここで、ｄ０は、リーダ１１及びフォロワ１２のワイヤ６と搬送物体１との接続点間の距離（搬送物体１の大きさ）である（図１参照）。
求めた目標位置、向きからフォロワ１２の速度を以下の式（数７）から求める。
【００４３】
【数７】
【００４４】
ここで、Ｋｖ、Ｋωは正の定数である。また、ｓ、ｔはリーダ１１の動作（直進、右旋回、左旋回）に関する係数であり、以下の式（数８、数９）の条件により求める。
【００４５】
【数８】
【００４６】
【数９】
【００４７】
上記の式（数８、数９）の条件によりリーダ１１の動作（直進、右旋回、左旋回）に対してフォロワ１２の並進速度、回転速度の符号を決定する。
このように、リーダ１１に目的地までの動作指令を与えて動作すると、フォロワ１２は、マーカ１３の位置の変化からリーダ１１の動作を推定し、リーダ１１の動作からフォロワ１２の目標位置を決定し動作するので、リーダ１１とフォロワ１２により搬送物体１を目的地まで協調搬送することができる。
【００４８】
次に、リーダ１１の軌道を右旋回、左旋回に走行した場合のシミュレーション結果について説明する。
図５はリーダ１１の軌道を右旋回した場合であり、図６はリーダ１１の軌道を左旋回した場合である。リーダ１１の速度は時間についての５次関数とし、最高速度を０．５ｍ／ｓとし、初期状態の車間をｄ＝０．８ｍとした。図５、図６において左側は、位置情報の修正を行わない場合であり、右側は搬送物体１の振れを推定し、位置情報を修正した場合である。
【００４９】
シミュレーション結果から、搬送物体１の位置情報のみでフォロワ１２がリーダ１１の動作を推定した場合はリーダ１１が停止しているにもかかわらずフォロワ１２は搬送物体１の振れを検知していまい、前後に動作し続けてしまう。またその動作によって搬送物体１の振れを助長してしまい、フォロワ１２の動作は発散してしまう。一方、振れを推定し検知した値を修正した場合は、リーダ１１の軌道に対してうまく初期状態の相対位置を保持するように動作しているのが分かる。
【００５０】
次に、本発明にかかる協調搬送方法および協調搬送装置１０の作用・効果について説明する。
本発明によれば、搬送物体１を移動型クレーンロボット１０Ａにより協調搬送するので、従来のマニピュレータなどを用いた協調搬送よりも搬送重量あたりの機器コストが低減できる。したがって、重量物の搬送に対して有利である。
【００５１】
また、リーダ１１に目的地までの動作指令を与えて動作すると、フォロワ１２は、搬送物体１、ワイヤ６またはこれらの所定部位の位置の変化からリーダ１１の動作を推定し、リーダ１１の動作から各自の目標位置を決定し動作するので、複数台のロボットに動作指令を与える必要がなく、また、リーダ１１・フォロワ１２間、フォロワ１２同士の通信も必要としない。
このため、全てのロボットに動作指令（目標軌道）を与える場合に比べて、目的地の変更の際にリーダ１１の動作指令のみを変更すればよく、フォロワ１２の制御に関しては変更が不要という利点がある。また、リーダ１１となる移動式クレーンロボット１０Ａを人間の操作（運転又はリモートコントロール）により動作させても、協調搬送が可能である。
【００５２】
また、フォロワ１２は、リーダ１１とフォロワ１２の相対位置を初期状態におけるリーダ１１とフォロワ１２の相対位置に保持するように動作するので、移動物体の搬送中において、各移動式クレーン４ロボット１０Ａが搬送物体１に接近して衝突したり、各ロボットの距離が離れすぎて搬送物体１の重さにより倒れたりすることがなく、確実に搬送物体１を目的地まで搬送することができる。
【００５３】
このように、撮像装置８により撮像した画像に基づいて検知した位置について、搬送物体１の振れによる誤差を修正するので、リーダ１１の動作（位置、向き）を正確に推定することができる。このため、各フォロワ１２はリーダ１１との相対位置を一定に保ちながら、安定して搬送物体１を搬送することができる。
【００５４】
なお、上記の実施形態ではフォロワ１２が１台の場合について説明したが、本発明はこれに限られず、フォロワ１２が２台以上の場合にも当然に適用可能である。すなわち、上記の実施形態では、フォロワ１２が一台の場合におけるリーダ１１の動作を推定するアルゴリズム（数１〜数９）について説明したが、フォロワ１２が２台以上の場合においても、上述した本発明の技術思想に基づいてアルゴリズムを構築することができる。
その他、本発明は上述した実施形態に限定されず、本発明の要旨を逸脱しない範囲で種々変更できることは勿論である。
【図面の簡単な説明】
【００５５】
【図１】本発明の実施形態にかかる協調搬送装置の概要図である。
【図２】リーダが動作したときのマーカ位置の変化を説明する図である。
【図３】フォロワの画像処理部の構成を示す図である。
【図４】リーダが右旋回したときのフォロワの動作説明図である。
【図５】リーダの軌道を右旋回しながら走行した場合のシミュレーション結果を示す図である。
【図６】リーダの軌道を左旋回しながら走行した場合のシミュレーション結果を示す図である。
【符号の説明】
【００５６】
１ 搬送物体
３ 移動台車
４ クレーン
５ 支柱
６ ワイヤ
８ 撮像装置
９ ビーム
１０ 協調搬送装置
１１ リーダ
１２ フォロワ
１３ マーカ
１５ 枠
２０ 処理部
２１ 位置検知部
２２ 誤差修正部
２３ 動作推定部
２４ 動作制御部
【技術分野】
【０００１】
本発明は、重量物、長物などを複数台の移動式クレーンロボットにより搬送させる協調搬送方法および協調搬送装置に関するものである。
【背景技術】
【０００２】
近年、工事現場や工場、倉庫などで生産の自動化への要求が高まっており、無人搬送車や天井クレーン、ロボットにより物体の搬送を行っている。しかし、様々な物体を搬送するためには、ロボットの能力には限界があり、ロボットの搬送能力を超える大型な物体などは当該ロボットでは搬送できず、別の新たなロボットを投入しなければならない。
これに対し、小型のロボットを複数台投入して人間のように協調して搬送させることで、１台では搬送できなかった物体も搬送することが可能となり、また、様々な大きさの物体に応じてロボットの台数を変更することにより柔軟に対応できることから、このような現場での作業の効率化が期待されている。
【０００３】
従来、この種の協調搬送については、主にマニピュレータやフォークリフトを備えた移動ロボットにより実現されている。
例えば、下記非特許文献１では、複数台のロボットからリーダとなる１台のロボットを選択し、フォロワと称する残りのロボットは何らかのセンサによってリーダの動作を推定し、搬送物体を目的地まで協調搬送する方法について一つの提案がなされている。
また、下記特許文献１では、２輪独立駆動方式のロボットの協調搬送において、駆動輪の２車輪の中点から車輪の進行方向に所定距離を隔てた位置で、その垂直軸周り回転自在に搬送物体を支持し、その支持点の移動速度、搬送物体に掛かる内力を制御して協調搬送する方法について一つの提案がなされている。
【０００４】
【非特許文献１】小菅一弘、大住智宏、千葉晋彦：日本ロボット学会誌、ｖｏｌ．１６、Ｎｏ．１、ｐｐ．８７〜９５、１９９８
【特許文献１】特開２０００−４２９５８号公報
【発明の開示】
【発明が解決しようとする課題】
【０００５】
上記のように、従来技術による協調搬送は、主にマニピュレータやフォークリフトを備えた移動ロボットにより実現されている。
しかしながら、搬送作業に限定した場合、マニピュレータやフォークリフトによる搬送では、搬送重量あたりの機器コストが高く、重量物の搬送には適していないという問題がある。
【０００６】
本発明は、このような事情に鑑みてなされたものであり、搬送重量あたりの機器コストを低減でき、重量物の搬送に有利な協調搬送方法および協調搬送装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
上記の課題を解決するため、本発明の協調搬送方法および協調搬送装置は、以下の手段を採用する。
すなわち、本発明にかかる協調搬送方法は、搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された移動式クレーンロボットを複数台用い、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する、ことを特徴とする。
【０００８】
このように、搬送物体を複数台の移動型クレーンロボットにより協調搬送するので、従来のマニピュレータなどを用いた協調搬送よりも搬送重量あたりの機器コストが低減でき、重量物の搬送に対して有利である。
【０００９】
また、本発明にかかる協調搬送方法では、前記複数の移動式クレーンロボットのうち一台を目的地までの動作指令が与えられるリーダとし、他の残りの移動式クレーンロボットを前記リーダの動作を推定しながら移動するフォロワとし、搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置を前記フォロワに設置し、前記リーダに目的地までの動作指令を与え、前記撮像装置の画像からフォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成し、該位置情報に基づいて前記リーダの動作を推定し、推定した前記リーダの動作に基づいて前記フォロワの動作を制御する、ことを特徴とする。なお、ここで、上記「動作指令」には、コンピュータによる動作指令のみならず、人間の運転又は通信手段を介した操作（リモートコントロール）による動作指令も含まれる。
【００１０】
このように、リーダに目的地までの動作指令を与えて動作すると、フォロワは、搬送物体、ワイヤまたはこれらの所定部位の位置の変化からリーダの動作を推定し、リーダの動作から各自の目標位置を決定し動作するので、複数台のロボットに動作指令を与える必要がなく、また、リーダ・フォロワ間、フォロワ同士の通信も必要としない。
このため、全てのロボットに動作指令（目標軌道）を与える場合に比べて、目的地の変更の際にリーダの動作指令のみを変更すればよく、フォロワの制御に関しては変更が不要という利点がある。また、リーダとなる移動式クレーンロボットを人間の操作（運転又はリモートコントロール）により動作させても、協調搬送が可能である。
【００１１】
また、本発明にかかる協調搬送方法では、推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする。
【００１２】
このように、フォロワは、リーダとフォロワの相対位置を初期状態におけるリーダとフォロワの相対位置に保持するように動作するので、移動物体の搬送中において、各移動式クレーンロボットが搬送物体に接近して衝突したり、各ロボットの距離が離れすぎて搬送物体の重さにより倒れたりすることがなく、確実に搬送物体を目的地まで搬送することができる。
【００１３】
また、本発明にかかる協調搬送方法では、前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について前記搬送物体の振れによる誤差を修正する、ことを特徴とする。
【００１４】
このように、撮像装置により撮像した画像に基づいて検知した位置について、搬送物体の振れによる誤差を修正するので、リーダの動作（位置、向き）を正確に推定することができる。このため、各フォロワはリーダとの相対位置を一定に保ちながら、安定して搬送物体を搬送することができる。
【００１５】
また、本発明にかかる協調搬送装置は、搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された複数台の移動式クレーンロボットからなり、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する協調搬送装置であって、該複数台の移動式クレーンロボットのうち一台は、目的地までの動作指令が与えられるリーダであり、他の残りの移動式クレーンロボットは、前記リーダの動作を推定しながら移動するフォロワであり、該フォロワは、前記搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置と、該撮像装置の画像から当該フォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成する位置検知部と、前記位置情報に基づいて前記リーダの動作を推定する動作推定部と、推定されたリーダの動作に基づいて当該フォロワの動作を制御する動作制御部と、を有する、ことを特徴とする。
【００１６】
また、本発明にかかる協調搬送装置では、前記動作制御部は、推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする。
【００１７】
また、本発明にかかる協調搬送装置では、前記フォロワは、前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について搬送物体の振れによる誤差を修正する誤差修正部をさらに有する、ことを特徴とする。
【００１８】
上記の協調搬送装置により、本発明の協調搬送方法を実施することができる。
【発明の効果】
【００１９】
本発明によれば、搬送重量あたりの機器コストを低減でき、重量物の搬送に有利である、という優れた効果が得られる。
【発明を実施するための最良の形態】
【００２０】
以下、本発明の好ましい実施形態を添付図面に基づいて詳細に説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。
【００２１】
図１は、本発明の実施形態にかかる協調搬送装置１０の概要を示す図である。
図１に示すように、この協調搬送装置１０は、搬送物体１を吊り下げ可能なクレーン４を備え且つ移動可能に構成された複数台の移動式クレーンロボット１０Ａからなる。各移動式クレーンロボット１０Ａは、前進、後進、左右方向への旋回を行って自在に地上を走行し移動することができ、これら複数台の移動式クレーンロボット１０Ａにより搬送物体１を共吊りしながら目的地まで協調して搬送する。
本実施形態において移動式クレーンロボット１０Ａは２台であるが、搬送物体１の重量、大きさ、移動式クレーンロボット１０Ａの搬送能力などにより、３台以上で協調搬送するようにしてもよい。
【００２２】
上記の複数の移動式クレーンロボット１０Ａのうち一台を目的地までの動作指令が与えられるリーダとし、他の残りの移動式クレーンロボット１０Ａをリーダの動作を推定しながら移動するフォロワとする。本実施形態では、図１の左側のロボット１０Ａがリーダ１１であり、右側のロボット１０Ａがフォロワ１２である。
【００２３】
移動式クレーンロボット１０Ａは、リーダ１１、フォロワ１２ともに、地上を走行可能な移動台車３と、移動台車３上に設けられたクレーン４とを備える。クレーン４は、支柱５と、支柱５に取り付けられたワイヤ６を備え、ワイヤ６の先端部に設けられたフックなどにより搬送物体１を吊り下げるようになっている。本実施形態では、リーダ１１とフォロワ１２のクレーン４のワイヤ６は、ともに同一長さであり、上端部の取り付け高さも同一に設定されている。
ここで、リーダ１１とフォロワ１２が前後方向に関して同一位置でかつ平行に並んだ状態における、リーダ１１とフォロワ１２のワイヤ６の上端間の距離を車間距離ｄとし、この状態を初期状態とする。
【００２４】
リーダ１１は、目的地までの動作指令が与えられて動作するが、この動作指令は、予めプログラミングされたものでも、通信手段を介して他の制御装置から動作指令を受けるものでも、あるいは、人間の運転又は通信手段を介した操作（リモートコントロール）による動作指令であってもよい。
【００２５】
フォロワ１２である移動式クレーン４ロボット１０Ａは、さらに、搬送物体１とクレーン４のワイヤ６を上方から撮像する撮像装置８（例えば、ビデオカメラ）を備えている。また、この撮像装置８を支持するためのビーム９がクレーン４の支柱５に設けられている。この撮像装置８は、搬送物体１、搬送物体１を吊り下げた状態のクレーン４のワイヤ６のうち少なくともいずれかを上方から撮像し、これらの中から特定の部位を、後述する位置検知部２１（図３参照）における位置の検知対象とする。
本実施形態では、搬送物体１とフォロワ１２のクレーン４のワイヤ６との接続点に、撮像装置８によって識別可能なマーカ１３が設置されており、マーカ１３を位置の検知対象となる特定部位としている。
なお、マーカ１３を設置せずに、搬送物体１自体の全体又は一部の形状を特徴点としてパターンマッチングなどの画像処理により、特定部位の位置を検知するようにしてもよい。またマーカ１３は、搬送物体１とフォロワ１２のクレーン４のワイヤ６との接続点以外の部位に設置されてもよい。
【００２６】
図２は、リーダ１１、フォロワ１２および搬送物体１を上方から見た図であって、リーダ１１にある動作指令を与えてリーダ１１が動作し、搬送物体１が移動した状態を示すものである。また枠１５で囲んだ範囲は撮像装置８によって撮像される画像の範囲である。なお、破線は、初期状態におけるリーダ１１とそのワイヤ６、搬送物体１、フォロワ１２のワイヤ６を示している。
このように、リーダ１１が動作し、リーダ１１とフォロワ１２の相対位置が初期状態から変化することで、搬送物体１とワイヤ６の位置が変位し、マーカ１３の位置も変位する。ここで、フォロワ１２のワイヤ６の上端の位置を座標系のゼロ点としたときのマーカ１３の位置をｌｖ、φｖで表現する。
なお、このように撮像装置８によりマーカ１３の位置変位を追跡する必要があるので、リーダ１１が動作に伴ってマーカ１３の位置が移動しても撮像画像上にマーカ１３が収まるように、撮像装置８の画角や設置高さが設定される。
【００２７】
また、図１に示すように、フォロワ１２である移動式クレーンロボット１０Ａは、種々の情報処理、演算、制御を行う処理部２０を備えている。
図３は、フォロワ１２である移動式クレーンロボット１０Ａの処理部２０の構成を示す図である。処理部２０は、位置検知部２１と、誤差修正部２２と、動作推定部２３と、動作制御部２４と、を有している。
位置検知部２１は、撮像装置８から画像信号を受け、フォロワ１２の座標系における搬送物体１、ワイヤ６またはこれらの所定部位の位置を検知してその位置情報を生成する。本実施形態では、撮像装置８の画像から検知するのは、上記のマーカ１３の位置である。
【００２８】
誤差修正部２２は、移動式クレーンロボット１０Ａ（リーダ１１およびフォロワ１２）の動作による搬送物体１の振れを推定し、この推定値に基づいて、上記の検知した位置について搬送物体１の振れによる誤差を修正する。検知したマーカ１３の位置情報は搬送物体１の振れによる誤差も含んでいる。それによりリーダ１１が停止したにも関わらず搬送物体１が振れているとフォロワ１２は搬送物体１の振れを検知し、それによって動作してしまう。そこで、誤差修正部２２において、搬送物体１の振れによる誤差を修正する。
【００２９】
動作推定部２３は、搬送物体１の位置情報に基づいてリーダ１１の動作を推定する。この搬送物体１の位置情報は、誤差修正部２２により搬送物体１の振れによる誤差が修正された位置情報である。具体的には、上部から投影した２本のワイヤ６は搬送物体１に対称な向きと長さになるので、撮像装置８の画像に基づいて検知した搬送物体１の位置から、フォロワ１２の座標系におけるリーダ１１の位置と向きを推定することができる。
【００３０】
動作制御部２４は、推定されたリーダ１１の動作に基づいてフォロワ１２の動作を制御する。具体的には、動作制御部２４は、推定されたリーダ１１の動作に基づいて、リーダ１１とフォロワ１２の相対位置を初期状態におけるリーダ１１とフォロワ１２の相対位置に保持するように、フォロワ１２の動作を制御する。
【００３１】
このような処理部２０は、例えば、マイクロコンピュータで構成することができ、上記の位置検知部２１、誤差修正部２２、動作推定部２３および動作制御部２４は、そのようなマイクロコンピュータの機能の一部として実現することができる。
【００３２】
次に、本実施形態にかかる協調搬送装置１０の動作によって実現される協調搬送方法について説明する。
図４は、リーダ１１の動作の一例として右旋回しながら前進した場合の、リーダ１１、フォロワ１２および搬送物体１を上方から見たときのこれらの位置関係を示す図である。
初期状態からリーダ１１にある動作指令を与えて動作させた場合、リーダ１１とフォロワ１２の相対位置が変化することで、搬送物体１とワイヤ６の位置が変位し、マーカ１３の位置も変位する。フォロワ１２は、撮像装置８によりマーカ１３の動きを撮像しており、位置検知部２１によりフォロワ１２の座標系におけるマーカ１３の位置を検知する。
【００３３】
位置検知部２１により検知したマーカ１３の位置情報は搬送物体１の振れによる誤差も含んでいるので、誤差修正部２２により、以下の方法により誤差を修正する。
搬送物体１の振れはリーダ１１とフォロワ１２の加速度に依存するものであり、誤差修正部２２は、フォロワ１２の速度から搬送物体１の振れを以下の式（数１）から推定する。
【００３４】
【数１】
【００３５】
ここで、ｌはワイヤ６の長さであり、ｇは重力加速度である。求めた振れ角により以下の式（数２、数３）から、検知したマーカ１３の位置情報を修正する。
【００３６】
【数２】
【００３７】
【数３】
【００３８】
振れが生じなければ、図４のように二本のワイヤ６は搬送物体１に対称であるので、動作推定部２３はマーカ１３の位置情報から幾何学的にリーダ１１の位置と向きを推定し、動作制御部２４はリーダ１１とフォロワ１２の初期状態における相対位置を保持するための目標位置と向きを、以下の式（数４〜数６）により決定する。
【００３９】
【数４】
【００４０】
【数５】
【００４１】
【数６】
【００４２】
ここで、ｄ０は、リーダ１１及びフォロワ１２のワイヤ６と搬送物体１との接続点間の距離（搬送物体１の大きさ）である（図１参照）。
求めた目標位置、向きからフォロワ１２の速度を以下の式（数７）から求める。
【００４３】
【数７】
【００４４】
ここで、Ｋｖ、Ｋωは正の定数である。また、ｓ、ｔはリーダ１１の動作（直進、右旋回、左旋回）に関する係数であり、以下の式（数８、数９）の条件により求める。
【００４５】
【数８】
【００４６】
【数９】
【００４７】
上記の式（数８、数９）の条件によりリーダ１１の動作（直進、右旋回、左旋回）に対してフォロワ１２の並進速度、回転速度の符号を決定する。
このように、リーダ１１に目的地までの動作指令を与えて動作すると、フォロワ１２は、マーカ１３の位置の変化からリーダ１１の動作を推定し、リーダ１１の動作からフォロワ１２の目標位置を決定し動作するので、リーダ１１とフォロワ１２により搬送物体１を目的地まで協調搬送することができる。
【００４８】
次に、リーダ１１の軌道を右旋回、左旋回に走行した場合のシミュレーション結果について説明する。
図５はリーダ１１の軌道を右旋回した場合であり、図６はリーダ１１の軌道を左旋回した場合である。リーダ１１の速度は時間についての５次関数とし、最高速度を０．５ｍ／ｓとし、初期状態の車間をｄ＝０．８ｍとした。図５、図６において左側は、位置情報の修正を行わない場合であり、右側は搬送物体１の振れを推定し、位置情報を修正した場合である。
【００４９】
シミュレーション結果から、搬送物体１の位置情報のみでフォロワ１２がリーダ１１の動作を推定した場合はリーダ１１が停止しているにもかかわらずフォロワ１２は搬送物体１の振れを検知していまい、前後に動作し続けてしまう。またその動作によって搬送物体１の振れを助長してしまい、フォロワ１２の動作は発散してしまう。一方、振れを推定し検知した値を修正した場合は、リーダ１１の軌道に対してうまく初期状態の相対位置を保持するように動作しているのが分かる。
【００５０】
次に、本発明にかかる協調搬送方法および協調搬送装置１０の作用・効果について説明する。
本発明によれば、搬送物体１を移動型クレーンロボット１０Ａにより協調搬送するので、従来のマニピュレータなどを用いた協調搬送よりも搬送重量あたりの機器コストが低減できる。したがって、重量物の搬送に対して有利である。
【００５１】
また、リーダ１１に目的地までの動作指令を与えて動作すると、フォロワ１２は、搬送物体１、ワイヤ６またはこれらの所定部位の位置の変化からリーダ１１の動作を推定し、リーダ１１の動作から各自の目標位置を決定し動作するので、複数台のロボットに動作指令を与える必要がなく、また、リーダ１１・フォロワ１２間、フォロワ１２同士の通信も必要としない。
このため、全てのロボットに動作指令（目標軌道）を与える場合に比べて、目的地の変更の際にリーダ１１の動作指令のみを変更すればよく、フォロワ１２の制御に関しては変更が不要という利点がある。また、リーダ１１となる移動式クレーンロボット１０Ａを人間の操作（運転又はリモートコントロール）により動作させても、協調搬送が可能である。
【００５２】
また、フォロワ１２は、リーダ１１とフォロワ１２の相対位置を初期状態におけるリーダ１１とフォロワ１２の相対位置に保持するように動作するので、移動物体の搬送中において、各移動式クレーン４ロボット１０Ａが搬送物体１に接近して衝突したり、各ロボットの距離が離れすぎて搬送物体１の重さにより倒れたりすることがなく、確実に搬送物体１を目的地まで搬送することができる。
【００５３】
このように、撮像装置８により撮像した画像に基づいて検知した位置について、搬送物体１の振れによる誤差を修正するので、リーダ１１の動作（位置、向き）を正確に推定することができる。このため、各フォロワ１２はリーダ１１との相対位置を一定に保ちながら、安定して搬送物体１を搬送することができる。
【００５４】
なお、上記の実施形態ではフォロワ１２が１台の場合について説明したが、本発明はこれに限られず、フォロワ１２が２台以上の場合にも当然に適用可能である。すなわち、上記の実施形態では、フォロワ１２が一台の場合におけるリーダ１１の動作を推定するアルゴリズム（数１〜数９）について説明したが、フォロワ１２が２台以上の場合においても、上述した本発明の技術思想に基づいてアルゴリズムを構築することができる。
その他、本発明は上述した実施形態に限定されず、本発明の要旨を逸脱しない範囲で種々変更できることは勿論である。
【図面の簡単な説明】
【００５５】
【図１】本発明の実施形態にかかる協調搬送装置の概要図である。
【図２】リーダが動作したときのマーカ位置の変化を説明する図である。
【図３】フォロワの画像処理部の構成を示す図である。
【図４】リーダが右旋回したときのフォロワの動作説明図である。
【図５】リーダの軌道を右旋回しながら走行した場合のシミュレーション結果を示す図である。
【図６】リーダの軌道を左旋回しながら走行した場合のシミュレーション結果を示す図である。
【符号の説明】
【００５６】
１ 搬送物体
３ 移動台車
４ クレーン
５ 支柱
６ ワイヤ
８ 撮像装置
９ ビーム
１０ 協調搬送装置
１１ リーダ
１２ フォロワ
１３ マーカ
１５ 枠
２０ 処理部
２１ 位置検知部
２２ 誤差修正部
２３ 動作推定部
２４ 動作制御部
【特許請求の範囲】
【請求項１】
搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された移動式クレーンロボットを複数台用い、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する、ことを特徴とする協調搬送方法。
【請求項２】
前記複数の移動式クレーンロボットのうち一台を目的地までの動作指令が与えられるリーダとし、他の残りの移動式クレーンロボットを前記リーダの動作を推定しながら移動するフォロワとし、搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置を前記フォロワに設置し、
前記リーダに目的地までの動作指令を与え、前記撮像装置の画像からフォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成し、該位置情報に基づいて前記リーダの動作を推定し、推定した前記リーダの動作に基づいて前記フォロワの動作を制御する、
ことを特徴とする請求項１に記載の協調搬送方法。
【請求項３】
推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする請求項２に記載の協調搬送方法。
【請求項４】
前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について前記搬送物体の振れによる誤差を修正する、ことを特徴とする請求項２または３に記載の協調搬送方法。
【請求項５】
搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された複数台の移動式クレーンロボットからなり、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する協調搬送装置であって、
該複数台の移動式クレーンロボットのうち一台は、目的地までの動作指令が与えられるリーダであり、
他の残りの移動式クレーンロボットは、前記リーダの動作を推定しながら移動するフォロワであり、
該フォロワは、
前記搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置と、
該撮像装置の画像から当該フォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成する位置検知部と、
前記位置情報に基づいて前記リーダの動作を推定する動作推定部と、
推定されたリーダの動作に基づいて当該フォロワの動作を制御する動作制御部と、を有する、
ことを特徴とする協調搬送装置。
【請求項６】
前記動作制御部は、推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする請求項５に記載の協調搬送装置。
【請求項７】
前記フォロワは、前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について搬送物体の振れによる誤差を修正する誤差修正部をさらに有する、ことを特徴とする請求項５または６に記載の協調搬送装置。
【請求項１】
搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された移動式クレーンロボットを複数台用い、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する、ことを特徴とする協調搬送方法。
【請求項２】
前記複数の移動式クレーンロボットのうち一台を目的地までの動作指令が与えられるリーダとし、他の残りの移動式クレーンロボットを前記リーダの動作を推定しながら移動するフォロワとし、搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置を前記フォロワに設置し、
前記リーダに目的地までの動作指令を与え、前記撮像装置の画像からフォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成し、該位置情報に基づいて前記リーダの動作を推定し、推定した前記リーダの動作に基づいて前記フォロワの動作を制御する、
ことを特徴とする請求項１に記載の協調搬送方法。
【請求項３】
推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする請求項２に記載の協調搬送方法。
【請求項４】
前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について前記搬送物体の振れによる誤差を修正する、ことを特徴とする請求項２または３に記載の協調搬送方法。
【請求項５】
搬送物体を吊り下げ可能なクレーンを備え且つ移動可能に構成された複数台の移動式クレーンロボットからなり、該複数台の移動式クレーンロボットにより搬送物体を共吊りしながら目的地まで搬送する協調搬送装置であって、
該複数台の移動式クレーンロボットのうち一台は、目的地までの動作指令が与えられるリーダであり、
他の残りの移動式クレーンロボットは、前記リーダの動作を推定しながら移動するフォロワであり、
該フォロワは、
前記搬送物体と該搬送物体を吊り下げた状態のクレーンのワイヤのうち少なくともいずれかを上方から撮像する撮像装置と、
該撮像装置の画像から当該フォロワの座標系における搬送物体、ワイヤまたはこれらの所定部位の位置を検知して位置情報を生成する位置検知部と、
前記位置情報に基づいて前記リーダの動作を推定する動作推定部と、
推定されたリーダの動作に基づいて当該フォロワの動作を制御する動作制御部と、を有する、
ことを特徴とする協調搬送装置。
【請求項６】
前記動作制御部は、推定されたリーダの動作に基づいて、前記リーダと前記フォロワの相対位置を初期状態における前記リーダと当該フォロワの相対位置に保持するように、当該フォロワの動作を制御する、ことを特徴とする請求項５に記載の協調搬送装置。
【請求項７】
前記フォロワは、前記移動式クレーンロボットの動作による前記搬送物体の振れを推定し、この推定値に基づいて、前記の検知した位置について搬送物体の振れによる誤差を修正する誤差修正部をさらに有する、ことを特徴とする請求項５または６に記載の協調搬送装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図２】
【図３】
【図４】
【図５】
【図６】
【公開番号】特開２００７−１６１３９４（Ｐ２００７−１６１３９４Ａ）
【公開日】平成１９年６月２８日（２００７．６．２８）
【国際特許分類】
【出願番号】特願２００５−３５８４５９（Ｐ２００５−３５８４５９）
【出願日】平成１７年１２月１３日（２００５．１２．１３）
【出願人】（０００００００９９）石川島播磨重工業株式会社 (5,014)
【Ｆターム（参考）】
【公開日】平成１９年６月２８日（２００７．６．２８）
【国際特許分類】
【出願日】平成１７年１２月１３日（２００５．１２．１３）
【出願人】（０００００００９９）石川島播磨重工業株式会社 (5,014)
【Ｆターム（参考）】
[ Back to top ]