JP2010115723A - ロボット及びロボットシステム - Google Patents

Abstract

【課題】可動部の場所を短時間に検出できるロボットを提供する。
【解決手段】可動部を有するロボットであって、可動部に配置され超音波信号を発信する複数のロボット用超音波タグ１３と、ロボット用超音波タグ１３が発信した超音波信号を受信する３個以上のロボット用超音波受信装置１９と、複数のロボット用超音波受信装置１９が受信する超音波信号の到達時間を用いてロボット用超音波タグ１３の場所を検出する発信位置演算部と、を有し、発信位置演算部は検出した複数のロボット用超音波タグにおける場所の情報から前記ロボットの姿勢を検出する。
【選択図】図１

Description

本発明は、ロボット及びロボットシステム等にかかわり、特にロボットにおける可動部の位置検出に関するものである。

複数のロボットを用いて作業を自動化する製造装置が活用されている。通常は各ロボットの動作が同期をとって動作するようにプログラムされるので、ロボット同士が衝突しないようになっている。そして、各ロボットを自律的に動作させるときには、ロボット同士が衝突する可能性がある。各ロボットの動作をシミュレーションすることにより、ロボット同士の衝突を防止する方法が特許文献１に開示されている。それによると、コンピュータに複数のロボットモデルを形成し、モデルを構成する主要な点の推移を推測する。次に、ロボットモデル同士が相互干渉するか検証する。相互干渉することが判明するときには一方のロボットを所定の時間停止することにより衝突を回避していた。

移動するロボットの場所を検出する方法が特許文献２に開示されている。それによると、ロボットがＲＦＩＤ（Ｒａｄｉｏ Ｆｒｅｑｕｅｎｃｙ Ｉｄｅｎｔｉｆｉｃａｔｉｏｎ）タグまたは超音波タグを持って移動する。そして、受信機が電波または超音波を受信することによりロボットの位置を検出していた。

特開２００４−２８０６３５号公報 特開２００７−３００４７０号公報

ロボットの動作をシミュレーションするときには、ロボットを構成する腕や手等の可動部の場所を認識する必要がある。そして、可動部の場所を短時間に検出できるロボットが求められていた。

本発明は、上述の課題の少なくとも一部を解決するためになされたものであり、以下の形態または適用例として実現することが可能である。

［適用例１］
本適用例にかかるロボットは、可動部を有するロボットであって、前記可動部に配置され無線信号を発信する複数の発信部と、前記発信部が発信した前記無線信号を受信する３個以上の受信部と、複数の前記受信部が受信する前記無線信号の到達時間を用いて前記発信部の場所を検出する位置演算部と、を有し、前記位置演算部は検出した複数の前記発信部における前記場所の情報から前記ロボットの姿勢を検出することを特徴とする。

このロボットによれば、発信部が発信する無線信号を３個以上の受信部が受信する。発信部と受信部との距離が長い程、発信後に受信部が受信するまでの到達時間が長くなる。そして、無線信号の伝播速度と伝播にかかった到達時間を掛算することにより、発信部と受信部との距離を演算することができる。その後、発信部と受信部との相対位置は三角測量法を用いて演算することができる。

そして、ロボットの可動部には発信部が配置されているので、発信部の場所を検出することにより、ロボットの姿勢を検出することができる。ロボットの姿勢を検出する方法としては可動部と可動部とが接続する部分にエンコーダ等のセンサを配置する方法がある。そして、可動部と可動部との相対位置を検出する。その場合、各可動部の一端の位置データに対する他端の位置データを検出することにより、接続する可動部の両端の相対位置が認識される。複数の可動部を有するときには、各可動部の相対位置の情報を積算して末端の可動部の場所を認識することになる。本適用例の方法では発信部の場所を直接検出することができるので、各可動部の相対位置を用いて演算する方法に比べて、位置演算部が短い時間で可動部の位置や姿勢を検出することができる。

［適用例２］
上記適用例にかかるロボットにおいて、前記ロボットが把持するワークを搬送する搬送部を備え、前記搬送部は複数の前記発信部を有し、前記位置演算部は前記受信部を用いて前記搬送部の場所を検出し、前記搬送部と前記ロボットとの相対位置を演算することを特徴とする。

このロボットによれば、位置演算部はコンベア装置とロボットとの相対位置を演算する。従って、コンベア装置に対してロボットの可動部が到達できる範囲を認識することができる。

［適用例３］
上記適用例にかかるロボットにおいて、前記位置演算部は前記可動部の軌跡を演算することを特徴とする。

このロボットによれば、位置演算部は算出した可動部の軌跡を用いて、可動部に加わる慣性力を推測することができる。

［適用例４］
上記適用例にかかるロボットにおいて、前記発信部は超音波を発信する超音波タグであり、前記受信部は超音波を受信することを特徴とする。

このロボットによれば、超音波を用いて発信部と受信部との距離を計測している。光や電波等の電磁波に比べて超音波は伝播速度が遅い。従って、電磁波に比べて超音波は伝播距離に対応する到達時間が長くなる。その結果、電磁波を用いるときに比べて、超音波を用いる方が到達時間を測定し易くすることができる。

［適用例５］
上記適用例にかかるロボットにおいて、前記可動部における自由度の数以上の前記発信部が前記可動部に配置されていることを特徴とする。

このロボットによれば、可動部における自由度の数だけ可動部が移動する場所を検出できるので、可動部の姿勢を検出することができる。

［適用例６］
上記適用例にかかるロボットにおいて、前記可動部が移動する軌跡の推移を演算するシミュレーション演算部を有し、前記シミュレーション演算部は前記発信部の前記場所の情報を用いて前記軌跡の推移を演算することを特徴とする。

このロボットによれば、発信部の場所の情報を用いるので、可動部の姿勢を認識することができる。そして、その姿勢から可動部の推移を演算する。推移前の可動部の位置を基にして、可動部の推移を算出するので、可動部の推移を正確に算出することができる。

［適用例７］
本適用例にかかるロボットシステムは、複数のロボットが動作するロボットシステムであって、前記ロボットの可動部に配置され無線信号を発信する複数の発信部と、前記発信部が発信した前記無線信号を受信する３個以上の受信部と、複数の前記受信部が受信する前記無線信号の到達時間を用いて前記発信部の場所を検出する位置演算部と、前記ロボット同士が衝突するかを推測する衝突演算部と、を有し、前記衝突演算部は前記発信部における前記場所の情報を用いて前記ロボット同士の衝突を検出することを特徴とする。

このロボットシステムによれば、短い時間で発信部の場所を検出することができる。そして、衝突演算部は発信部の場所の情報を用いてロボット同士の衝突を検出している。従って、短い時間でロボット同士の衝突を検出することができる。

［適用例８］
上記適用例にかかるロボットシステムにおいて、前記発信部は超音波を発信する超音波タグであり、前記受信部は超音波を受信することを特徴とする。

このロボットによれば、超音波を用いて発信部と受信部との距離を計測している。光や電波等の電磁波に比べて超音波は伝播速度が遅い。従って、電磁波に比べて超音波は伝播距離に対応する伝播時間が長くなる。その結果、電磁波を用いるときに比べて、超音波を用いる方が伝播時間を測定し易くすることができる。

［適用例９］
上記適用例にかかるロボットシステムにおいて、前記衝突演算部は、前記可動部が移動する軌跡の推移を演算するシミュレーション演算部と、前記可動部同士が干渉するかを演算する干渉演算部と、を有することを特徴とする。

このロボットシステムによれば、シミュレーション演算部が可動部の推移を演算する。そして、衝突演算部が可動部同士の衝突するか否かを演算する。従って、可動部が移動するときの各場所で可動部同士の衝突を検出することができる。

以下、実施形態について図面に従って説明する。
尚、各図面における各部材は、各図面上で認識可能な程度の大きさとするため、各部材毎に縮尺を異ならせて図示している。
（実施形態）
本実施形態における特徴的なロボット、ロボットシステム及びロボット制御方法について図１〜図１０に従って説明する。ロボット制御方法は、２台のロボットがワークを把持して移動して離すことにより、ワーク移動させる例を用いて説明する。

図１は、ロボットシステムの構成を示す概略斜視図である。図１に示すように、ロボットシステム１は主に搬送部としてのコンベア装置２、位置検出ユニット３及びロボット４から構成されている。コンベア装置２は１方向に長く形成された基台５を備えている。基台５の長手方向をＸ方向とする。そして、重力方向と逆の方向をＺ方向とし、Ｘ方向及びＺ方向と直交する方向をＹ方向とする。

基台５のＹ方向の両側には一対の側板６が配置されている。各側板６の上面においてＸ方向の両側には発信部及び超音波タグとしてのワーク用超音波タグ７が配置されている。さらに、Ｙ方向と逆側の側板６の上面には電波発信装置８が配置されている。ワーク用超音波タグ７は内部に超音波発信源を備えることにより、無線信号としての超音波を発信することができる。各側板６に設置されたワーク用超音波タグ７の場所を検出することにより側板６の位置が認識可能になっている。電波発信装置８は発信回路とアンテナとを備え、所定の波形の電波信号を発信することができる。

２つの側板６の間にはベルト９が配置されている。ベルト９は円筒状に形成されたシートからなり、ベルト９の内部には図示しないプーリーが配置されている。そして、プーリーによりベルト９はＸ方向に所定の張力がかけられている。側板６のＸ方向の逆側においてＹ方向と逆の面にはモータ１０が配置され、モータ１０の駆動軸はプーリーと接続されている。ベルト９の上面にはワーク１１が載置され、ワーク１１はワーク支持部１２に支持されている。そして、ワーク支持部１２には複数のワーク用超音波タグ７が配置されている。ワーク１１は図示しない供給装置によりベルト９上に載置される。そして、モータ１０を駆動することによりベルト９を介してワーク１１をＸ方向に移動させることが可能になっている。

側板６とベルト９との相対的な位置関係は予め設定されている。そして、側板６上に配置されたワーク用超音波タグ７の場所を検出することによりロボットシステム１はベルト９の場所を認識することができる。従って、ロボットシステム１はワーク１１の流動方向やワーク１１が移動可能な範囲を認識することができる。

コンベア装置２のＹ方向と逆の方向でＸ方向の側には２台のロボット４が配置されている。Ｘ方向の逆側に位置するロボット４を第１ロボット４ａとする。そして、Ｘ方向に位置するロボット４を第２ロボット４ｂとする。ロボット４はベルト９の近くに配置され、ベルト９の上に位置するワーク１１を把持することができる。ロボット４には複数の発信部及び超音波タグとしてのロボット用超音波タグ１３が配置されている。

コンベア装置２のＹ方向の側面には２本の第１支柱部１４がＺ方向に立設されている。第１支柱部１４の上には第１受信装置支持部１５が配置されている。第１受信装置支持部１５の外形は梁により約長方形に形成されている。そして、第１受信装置支持部１５には２本の梁１５ａが内側に配置され、第１受信装置支持部１５には矩形の窓１５ｂが３つ形成されている。３つの窓１５ｂの各辺に相当する場所の梁にはワーク用超音波受信装置１６が配置されている。ワーク用超音波受信装置１６は超音波信号を受信する装置である。そして、ワーク用超音波受信装置１６は第１受信装置支持部１５においてコンベア装置２側の面に配置されている。ワーク用超音波受信装置１６はベルト９の上側に位置し、ワーク用超音波タグ７が発信する超音波信号を受信することができる。そして、ワーク用超音波受信装置１６は所定のレイアウトに配置され、１つのワーク用超音波タグ７が発信する超音波信号を３つ以上のワーク用超音波受信装置１６が受信するようになっている。

第１受信装置支持部１５上には２本の第２支柱部１７が立設されている。第２支柱部１７の上には第２受信装置支持部１８が配置されている。第２受信装置支持部１８はＹ方向と逆の方向に延在して配置され、ロボット４の上側まで達している。そして、第２受信装置支持部１８はロボット４の上でＸ方向に架橋されている。第２受信装置支持部１８のロボット４側の面には受信部としてのロボット用超音波受信装置１９が配置されている。ロボット用超音波受信装置１９は各ロボット４の頭上に３個毎配置されている。そして、ロボット用超音波タグ１３が発信する超音波信号を受信することができる。

コンベア装置２のＹ方向側には収納装置２０が配置されている。ロボット４は、姿勢を変化させることによりワーク１１をベルト９上から収納装置２０の上面に移動させることができる。収納装置２０は内部に昇降機構を備え、ワーク１１の量に応じて上面を下降させる。そして、収納装置２０はワーク１１を載置する場所の高さを同じ高さにする。

ロボット４のＸ方向には制御装置２１が配置されている。制御装置２１はコンベア装置２、位置検出ユニット３、ロボット４等を含むロボットシステム１を制御する装置である。

図２は、ロボットを示す概略斜視図である。図２に示すように、ロボット４は基台２４を備え、基台２４上には可動部としての回転台２５が配置されている。回転台２５は固定台２５ａと回転軸２５ｂとを備えている。回転台２５は内部にサーボモータと減速機構とを備え、回転軸２５ｂを角度精度良く回転及び停止することができる。固定台２５ａにはロボット用超音波タグ１３が配置されている。ワーク用超音波受信装置１６を用いてコンベア装置２の側板６上面に配置されたワーク用超音波タグ７と回転台２５に配置されたロボット用超音波タグ１３との場所を検出する。そして、コンベア装置２とロボット４との相対位置のデータを設定することが可能になっている。そして、ベルト９上において流動するワーク１１をロボット４が捕捉可能な範囲を認識することができる。

回転台２５の回転軸２５ｂと接続して可動部としての第１関節２６が配置され、第１関節２６と接続して可動部としての第１腕２７が配置されている。第１関節２６の回転軸にはロボット用超音波タグ１３が配置されている。そして、このロボット用超音波タグ１３の位置を検出することにより、回転軸２５ｂを回転させるときの回転角度を検出することができる。第１腕２７と接続して可動部としての第２関節２８が配置され、第２関節２８の回転軸にはロボット用超音波タグ１３が配置されている。そして、このロボット用超音波タグ１３の位置を検出することにより、第１関節２６を中心にして第１腕２７の姿勢を検出することができる。

第２関節２８と接続して可動部としての第２腕２９が配置されている。第２腕２９は固定軸２９ａと回転軸２９ｂとを備え、第２腕２９は第２腕２９の長手方向を回転軸にして回転軸２９ｂを回転させることができる。第２腕２９の回転軸２９ｂと接続して第３関節３０が配置され、第３関節３０の回転軸の方向において両側には一対のロボット用超音波タグ１３が配置されている。このロボット用超音波タグ１３の位置を検出することにより、第２腕２９の姿勢と回転軸２９ｂの回転具合を検出することができる。

第３関節３０と接続して可動部としての第３腕３１が配置されている。第３腕３１は固定軸３１ａと回転軸３１ｂとを備え、第３腕３１は第３腕３１の長手方向を回転軸にして回転軸３１ｂを回転させることができる。第３腕３１の回転軸３１ｂと接続して可動部としての手部３２が配置されている。手部３２は第３腕３１の回転軸３１ｂと直交する方向に長く形成されている。そして、長手方向の両端にはロボット用超音波タグ１３が配置されている。このロボット用超音波タグ１３の位置を検出することにより、手部３２の姿勢を検出することができる。

手部３２には一対の可動部としての指部３３が配置されている。手部３２にはサーボモータとサーボモータにより駆動される直動機構を備えている。そして、この直動機構により指部３３の間隔を変更可能になっている。

第１関節２６、第２関節２８、第２腕２９、第３関節３０及び第３腕３１は内部にサーボモータと減速機構とを備え、第１腕２７、第２腕２９及び第３腕３１を角度精度良く回転及び停止することができる。上述のようにロボット４は多くの関節と回転機構を備えている。そして、これらの関節及び回転機構に加えて指部３３を制御することによりワーク１１を把持することが可能になっている。

第１腕２７、第２腕２９、第３腕３１及び手部３２には各部位が動作可能な自由度の数以上のロボット用超音波タグ１３が配置されている。従って、各部位の姿勢を検出することが可能になっている。

図３（ａ）は、ロボット用超音波タグを示す模式断面図である。図３（ａ）に示すように、ロボット用超音波タグ１３は支持部３４を備えている。支持部３４には球形の外装部３５が接続されている。外装部３５の内部には空洞が形成されている。外装部３５は超音波を通過させる材質であれば良く、硬質の樹脂等を用いることができる。

外装部３５の下側には電力送電部３６が配置されている。電力送電部３６は磁心３６ａとコイル３６ｂ等から構成され、磁心３６ａにコイル３６ｂが巻かれている。コイル３６ｂに交流の電流を通電することにより、磁心３６ａに磁力線を形成する。そして、形成した磁力線の回路を外装部３５の内部に向けて形成することが可能になっている。

外装部３５の内部には球形の胴体３７が配置され、胴体３７と外装部３５との間には隙間が形成されている。そして、その隙間には潤滑性のある流動体３８と気体３９が配置されている。従って、胴体３７は外装部３５の内部で動き易くなっている。流動体３８は粘性が少ない材料であることが好ましく、本実施形態では、例えば、シリコーンオイルを採用している。

胴体３７の上部には超音波出力部４０が配置されている。超音波出力部４０は振動板４１と振動板４１に固着された圧電素子４２等を備えている。そして、圧電素子４２を駆動して振動板４１を振動させることにより、振動板４１から超音波を発信することができる。

ロボット用超音波タグ１３が発信する超音波は円錐状に広がって進行する。超音波が広がるときの広がり角度及び周波数は超音波出力部４０の仕様により異なり、特に限定されない。本実施形態では、例えば、広がり角度は約１００度に設定している。超音波の周波数は４０Ｋヘルツに近い周波数を採用している。

超音波出力部４０の下側には回路基板４３が配置され、圧電素子４２と回路基板４３とが配線４４により電気的に接続されている。回路基板４３の左側にはアンテナ４５が配置されている。そして、アンテナ４５と回路基板４３とは配線４４により電気的に接続されている。

回路基板４３の下側には電力受電部４６が配置されている。電力受電部４６は磁心４６ａとコイル４６ｂ等から構成され、磁心４６ａにコイル４６ｂが巻かれている。電力受電部４６が電力送電部３６と対向する場所に位置するとき、電力送電部３６が磁心３６ａから磁力線を出力する。そして、出力された磁力線が電力受電部４６の磁心４６ａを通過する。従って、電力送電部３６及び電力受電部４６によりトランスが形成される。

胴体３７の下側には錘４７が配置されている。錘４７は、胴体３７に比べて比重の大きな材料等から形成されている。錘４７に重力が作用することにより、錘４７には重力加速度方向の力が作用する。そして、胴体３７は外装部３５内で回転可能に配置されている。従って、ロボット用超音波タグ１３の支持部３４が各種の方向を向くときにも超音波出力部４０はＺ方向を向くようになっている。ロボット４のＺ方向にはロボット用超音波受信装置１９が配置されている。その結果、超音波出力部４０が発信する超音波はロボット用超音波受信装置１９が受信することが可能になっている。

図３（ｂ）は、超音波タグの電気制御ブロック図である。図３（ｂ）に示すように、ロボット用超音波タグ１３はアンテナ４５を備えている。アンテナ４５は受信回路５０に接続されている。受信回路５０はアンテナ４５が受信した微弱電波を増幅する回路である。そして、アンテナ４５及び受信回路５０は電波発信装置８が発信した電波信号を受信する。受信回路５０はコード分析回路５１と接続されている。コード分析回路５１は電波発信装置８が発信する電波信号を分析する回路である。電波信号にはコード信号と発信タイミング信号とが含まれている。コード分析回路５１はコード信号を分析して超音波を発信するか否かの判断を行う。コード信号のコードは認識番号を示す。各ロボット用超音波タグ１３にはコードが設定されており、コード分析回路５１は受信したコード信号とロボット用超音波タグ１３に設定されたコードとが一致するか否かを判断する。そして、受信したコード信号とロボット用超音波タグ１３に設定されたコードとが一致するときコード分析回路５１は超音波を発信する判断をする。

コード分析回路５１は送信制御回路５２と接続されている。そして、送信制御回路５２は発信信号形成回路５３及び送信回路５４と接続されている。発信信号形成回路５３は発振回路を含み予め設定された波形の電圧信号を形成する回路である。波形パターンは特に限定されず正弦波、矩形波、三角波等を用いることができ、本実施形態では例えば正弦波を採用している。波形の周波数は１種類に限定されず複数種類の波形を形成できるようにしても良い。但し、１種類の波長のみ用いるときには必ずしも複数の周波数の波形を形成する必要はない。そして、発信信号形成回路５３は形成した電圧信号を送信制御回路５２に出力する。

送信制御回路５２は信号の送信を制御する回路である。コード分析回路５１が超音波を発信する判断をしたとき、発信信号形成回路５３は形成した電圧信号を送信回路５４に出力する。そして、発信タイミング信号と同期して電圧信号を出力する。送信回路５４は増幅部と超音波出力部４０とを備えている。増幅部は入力した電圧信号を増幅して超音波出力部４０に出力する。超音波出力部４０は圧電素子４２を備えた振動板４１等からなり、電圧信号に対応して振動板４１を振動させる。そして、振動板４１が気体を振動させることにより、超音波を発信する。

ロボット用超音波タグ１３は電源部５５を備えている。電源部５５には電池や蓄電池等を用いることができる。本実施形態では、例えば、電源部５５にリチウム２次電池を採用している。そして、電源部５５はロボット用超音波タグ１３が備える各回路に電力を供給する。

電源部５５は電力受電部４６と電気的に接続されている。そして、電力受電部４６は電力送電部３６とトランスを形成することができる。電力送電部３６は本体電源部５６と電気的に接続されている。そして、本体電源部５６から電力送電部３６及び電力受電部４６を介して電源部５５に電力が供給される。

アンテナ４５、受信回路５０、コード分析回路５１、送信制御回路５２、発信信号形成回路５３、送信回路５４、電源部５５及び電力受電部４６は胴体３７に配置されている。そして、胴体３７の外部から無線により信号及び電力を受信する。

つまり、ロボット用超音波タグ１３は電波信号を受信する。そして、電波信号に含まれるコード信号とロボット用超音波タグ１３に予め設定されたコードとが一致するときに超音波を発信する。このとき、電波信号に含まれている発信タイミング信号と同期して超音波を発信する。

ワーク用超音波タグ７はロボット用超音波タグ１３と同様な回路構成を有している。従って、ワーク用超音波タグ７はロボット用超音波タグ１３と同様な機能を備えている。そして、電波信号に含まれるコード信号とワーク用超音波タグ７に予め設定されたコードとが一致するときに超音波を発信する。このとき、電波信号に含まれている発信タイミング信号と同期して超音波を発信する。

図４は、ロボットシステムの電気制御ブロック図である。図４において、ロボットシステム１の制御部としての制御装置２１はプロセッサとして各種の演算処理を行うＣＰＵ（演算処理装置）５９と各種情報を記憶する記憶部としてのメモリ６０とを有する。

コンベア駆動装置６１、電波発信装置８、ワーク用超音波受信装置１６、ロボット用超音波受信装置１９、ロボット駆動装置６２、収納装置２０は、入出力インターフェース６３及びデータバス６４を介してＣＰＵ５９に接続されている。さらに、入力装置６５、表示装置６６も入出力インターフェース６３及びデータバス６４を介してＣＰＵ５９に接続されている。

コンベア駆動装置６１はコンベア装置２と接続され、コンベア装置２を制御する装置である。コンベア駆動装置６１はベルト９の移動と停止及び移動させるときの速度を制御する。ロボット駆動装置６２は、第１ロボット４ａ及び第２ロボット４ｂと接続されロボット４の動作を制御する装置である。ロボット駆動装置６２はロボット４の姿勢に関する情報をＣＰＵ５９に出力することができる。そして、ＣＰＵ５９が指示する場所に手部３２を移動して、指部３３を動作することが可能になっている。

入力装置６５はワーク用超音波タグ７及びロボット用超音波タグ１３のコードやロボット４がワーク支持部１２を把持するときの把持方法等の動作条件を入力する装置である。例えば、ワーク１１毎のワーク支持部１２の形状を示す座標を図示しない外部装置から受信し、入力する装置である。表示装置６６はワーク１１やロボット用超音波タグ１３に関するデータや作業状況を表示する装置である。表示装置６６に表示される情報を基に入力装置６５を用いて操作者が入力操作を行う。

メモリ６０は、ＲＡＭ、ＲＯＭ等といった半導体メモリや、ハードディスク、ＤＶＤ−ＲＯＭといった外部記憶装置を含む概念である。機能的には、ロボットシステム１における動作の制御手順が記述されたプログラムソフト６７を記憶する記憶領域がメモリ６０に設定される。さらに、ワーク用超音波タグ７及びロボット用超音波タグ１３に設置されたコード等の情報である超音波タグデータ６８を記憶するための記憶領域もメモリ６０に設定される。超音波タグデータ６８にはロボット用超音波タグ１３の配置場所とロボット用超音波タグ１３のコードとの関係も記憶される。さらに、コンベア装置２、位置検出ユニット３及び収納装置２０とロボット４との相対位置等の情報であるロボット関連データ６９を記憶するための記憶領域もメモリ６０に設定される。さらに、ワーク１１の形状やワーク１１を把持するときにロボット４の指部３３がワーク１１を挟む場所等のデータであるワークデータ７０を記憶するための記憶領域もメモリ６０に設定される。他にも、ＣＰＵ５９のためのワークエリアやテンポラリファイル等として機能する記憶領域やその他各種の記憶領域がメモリ６０に設定される。

ＣＰＵ５９はメモリ６０内に記憶されたプログラムソフト６７に従って、ワーク１１の識別やワーク１１を移動させるための制御を行うものである。具体的な機能実現部として、ロボット４を駆動してワーク１１を移動させるための制御を行うロボット制御部７１を有する。他にも、特定のワーク用超音波タグ７及びロボット用超音波タグ１３に発信させるために電波発信装置８の制御を行う発信制御部７２を有する。さらに、ワーク用超音波受信装置１６及びロボット用超音波受信装置１９が受信する超音波を用いてワーク用超音波タグ７及びロボット用超音波タグ１３の場所を演算する位置演算部としての発信位置演算部７３を有する。他にも、第１ロボット４ａの可動部と第２ロボット４ｂの可動部との衝突を検出する衝突演算部７４を有する。衝突演算部７４は軌跡演算部としてのシミュレーション演算部７５及び干渉演算部７６等からなる。シミュレーション演算部７５はロボット４の腕や手部３２の動作をシミュレーションする。干渉演算部７６はシミュレーションの演算結果を用いて第１ロボット４ａの可動部と第２ロボット４ｂの可動部とが干渉するかを演算する。他にも、ロボット４の動作と連携してベルト９の動作を制御するコンベア演算部７７等を有する。

（ロボット制御方法）
次に、上述したロボットシステム１を用いて、ワーク１１をコンベア装置２から収納装置２０へ移動させる作業におけるロボットの制御方法について図５〜図１０にて説明する。図５は、ワークを収納場所へ移動させる工程を示すフローチャートである。図６〜図１０は、ロボットを用いた作業方法を説明する図である。

図５に示すフローチャートにおいて、ステップＳ１とステップＳ２〜ステップＳ８とが並行して行われる。ステップＳ１は、第１移動工程に相当し、コンベア装置を用いてワークを移動させる工程である。次にステップＳ９に移行する。ステップＳ２とステップＳ３とは並行して行われる。ステップＳ２は、ワーク検出工程に相当し、ワーク用超音波タグが発信する超音波を受信してワークの場所を検出する工程である。次にステップＳ４に移行する。ステップＳ３は、ロボット検出工程に相当し、ロボット用超音波タグが発信する超音波を受信してロボットを構成する各部材の場所を検出する工程である。次にステップＳ４に移行する。ステップＳ４は、シミュレーション工程に相当する。ワークが移動する場所を予測し、その場所へロボットの手部を移動させるときの軌跡をシミュレーションする。さらに、ワークを収納場所へ移動させるときの軌跡をシミュレーションする工程である。次にステップＳ５に移行する。ステップＳ５は、衝突演算工程に相当し、ロボットの各可動部の軌跡をシミュレーションした結果を用いて、２台のロボットが衝突する部分がないかを演算する工程である。次にステップＳ６に移行する。

ステップＳ６は、衝突判断工程に相当し、２台のロボットが衝突するか否かを判断する工程である。ロボットの一部が衝突するときステップＳ７に移行する。ロボットが衝突しないときステップＳ８に移行する。ステップＳ７は、計画変更工程に相当し、ロボットの動作計画を変更する工程である。次にステップＳ４に移行する。ステップＳ８は、第２移動工程に相当し、ロボットがワークを収納装置へ移動させる工程である。次にステップＳ９に移行する。ステップＳ９は、終了確認工程に相当し、ワークを総て流動したかを確認する工程である。流動するワークがあり、作業が終了していないときステップＳ１、ステップＳ２及びステップＳ３に移行する。流動するワークがなく作業を終了するとき、ワークをコンベア装置から収納装置へ移動させる工程を終了する。

次に、図６〜図１０を用いて、図５に示したステップと対応させて、ロボットを用いた作業方法を詳細に説明する。図６（ａ）は、ステップＳ１の第１移動工程に対応する図である。図６（ａ）に示すように、ステップＳ１において、ベルト９上にワーク１１が載置される。そして、ベルト９によりワーク１１が移動される。

図６（ｂ）〜図７（ｂ）は、ステップＳ２のワーク検出工程に対応する図である。図６（ｂ）に示すように、電波発信装置８は電波信号７９を出力する。ベルト９上には複数の種類のワーク１１が載置されている。そのワーク１１に向けて電波信号７９が放射される。ワーク用超音波タグ７には識別コードが設定されている。そして、電波信号７９には識別コードと超音波を発信するときの同期信号とが含まれている。電波発信装置８は識別コードを切り換えて電波信号７９を順次送信する。ワーク１１の片面には一対のワーク用超音波タグ７が配置されている。このワーク用超音波タグ７を第１ワーク用超音波タグ７ａ及び第２ワーク用超音波タグ７ｂとする。そして、ワーク用超音波タグ７が電波信号７９を受信する。

電波信号７９に含まれる識別コードと第１ワーク用超音波タグ７ａに設定された識別コードとが一致するとき、第１ワーク用超音波タグ７ａは図６（ｃ）に示すように無線信号及び超音波としての超音波信号８０を発信する。第１ワーク用超音波タグ７ａがＺ方向に超音波信号８０を発信するとき、超音波信号８０は３つのワーク用超音波受信装置１６に受信される。発信制御部７２は第１ワーク用超音波タグ７ａが発信してから各ワーク用超音波受信装置１６が受信するまでの到達時間を検出してメモリ６０に記憶する。

ワーク用超音波受信装置１６が超音波信号８０を受信するまでの時間の検出方法には、超音波信号８０の振幅を検出する方法、参照波と波形比較して一致するタイミングを検出する方法、２つの周波数の超音波信号８０を発信して、受信した超音波信号８０の位相を検出する位相一致方法等がある。位相一致法は特開２００６−２４２６４０号公報に開示されており、詳細な説明は省略する。位相一致法は測定精度が良いので超音波信号８０を発信してから受信するまでの時間を精度良く測定することができる。検出方法は公知の方法のいずれかを用いることができる。本実施形態では、例えば、位相一致法を採用している。

電波発信装置８から順次各ワーク用超音波タグ７に対して電波信号７９が送信される。電波信号７９に含まれる識別コードと第２ワーク用超音波タグ７ｂに設定された識別コードとが一致するとき、第２ワーク用超音波タグ７ｂは図６（ｄ）に示すように超音波信号８０を発信する。そして、超音波信号８０は３つのワーク用超音波受信装置１６に受信される。発信制御部７２は第２ワーク用超音波タグ７ｂが発信してから各ワーク用超音波受信装置１６が受信するまでの到達時間を検出してメモリ６０に記憶する。

図７（ａ）に示すように、第１ワーク用超音波タグ７ａが発信する超音波信号８０を３つのワーク用超音波受信装置１６が受信する。発信位置演算部７３は第１ワーク用超音波タグ７ａが超音波信号８０を発信してから各ワーク用超音波受信装置１６に受信されるまでの到達時間と超音波信号８０の進行速度とを積算して第１ワーク用超音波タグ７ａと各ワーク用超音波受信装置１６との距離８１を演算する。

ロボットシステム１におけるワーク用超音波受信装置１６の場所は予め計測されており、ロボット関連データ６９にワーク用超音波受信装置１６の座標が記憶されている。そして、発信位置演算部７３は、三角測量方式を用いてロボットシステム１における第１ワーク用超音波タグ７ａの場所を算出する。続いて、同様の方法を用いて、第２ワーク用超音波タグ７ｂの場所を演算する。

次に、図７（ｂ）に示すように、ワーク１１の姿勢を算出する。ワーク１１の姿勢はワーク１１の進行方向に対する姿勢角度８２を示す。本実施形態ではワーク１１の進行方向はＸ方向である。そして、第１ワーク用超音波タグ７ａ及び第２ワーク用超音波タグ７ｂを通る直線がＸ方向と成す角度を姿勢角度８２とする。次に、第１ワーク用超音波タグ７ａ及び第２ワーク用超音波タグ７ｂとの中点を算出する。この中点をワーク位置８３とする。ワーク位置８３と姿勢角度８２とをワークデータ７０としてメモリ６０に記憶する。

図８は、ステップＳ３のロボット検出工程に対応する図である。図８（ａ）に示すように、電波発信装置８はロボット４に向けて電波信号７９を放射する。ロボット用超音波タグ１３にはワーク用超音波タグ７と同様に識別コードが設定されている。そして、電波信号７９には識別コードと超音波を発信するときの同期信号とが含まれている。電波発信装置８は識別コードを切り換えて電波信号７９を順次送信する。そして、ロボット用超音波タグ１３は電波信号７９を受信する。

電波信号７９に含まれる識別コードとロボット用超音波タグ１３に設定された識別コードとが一致するとき、ロボット用超音波タグ１３は図８（ｂ）に示すように超音波信号８０を発信する。ロボット用超音波タグ１３はＺ方向に超音波信号８０を発信する。そして、超音波信号８０はロボット用超音波受信装置１９に受信される。発信制御部７２はロボット用超音波タグ１３が発信してから各ロボット用超音波受信装置１９が受信するまでの到達時間を検出してメモリ６０に記憶する。

ステップＳ２の場合と同様に、ロボット用超音波タグ１３が発信する超音波信号８０を３つのロボット用超音波受信装置１９が受信する。そして、発信位置演算部７３はロボット用超音波タグ１３と各ロボット用超音波受信装置１９との距離８１を演算する。次に、発信位置演算部７３は、三角測量方式を用いて発信したロボット用超音波タグ１３の場所を演算する。そして、発信位置演算部７３はロボット用超音波タグ１３の場所に関する位置情報を超音波タグデータ６８としてメモリ６０に記憶する。

電波発信装置８はロボット４に配置されたロボット用超音波タグ１３から順次超音波信号８０を順次発信させる。そして、ロボット用超音波受信装置１９が受信した後、発信位置演算部７３がロボット用超音波タグ１３の場所を演算する。そして、発信位置演算部７３はロボット用超音波タグ１３が配置されている場所の情報を用いてロボット４の各可動部の位置と姿勢とを演算する。そして、発信位置演算部７３は各ロボット用超音波タグ１３の場所、各可動部の位置と姿勢を超音波タグデータ６８としてメモリ６０に記憶する。

図９（ａ）はステップＳ４のシミュレーション工程に対応する図である。ワーク１１とロボット４との動作をシミュレートする１つの例を示す。図９（ａ）に示すように、ステップＳ４において、ワーク１１の移動場所を推測する。コンベア装置２のベルト９は等速度で移動している。そして、ある時刻におけるワーク１１の場所が検出されているので、所定の時間後にはベルトの移動方向へ移動することが推測される。そして、シミュレーション演算部７５は、仮想空間にベルト８６、収納装置８７、第１ロボット８８、第２ロボット８９、ワーク９０等のモデルを配置する。ベルト８６はコンベア装置２のベルト９に対応するモデルであり、収納装置８７は収納装置２０に対応するモデルである。第１ロボット８８は第１ロボット４ａに対応するモデルであり、第２ロボット８９は第２ロボット４ｂに対応するモデルである。ワーク９０はワーク１１に対応するモデルである。各モデルは実物と同じ大きさで同じ形状に設定されている。

シミュレーション演算部７５はベルト８６上を移動するワーク９０の軌跡を演算する。次に、シミュレーション演算部７５は第２ロボット８９の動きを演算する。第２ロボット８９は手部８９ａを備えている。手部８９ａは手部３２に対応するモデルである。そして、シミュレーション演算部７５はワーク９０の移動予定の場所に第２ロボット８９の手部８９ａが移動する軌跡を演算する。そして、第２ロボット８９の手部８９ａがワーク９０を把持する予定の場所を決定する。

次に、シミュレーション演算部７５は第１ロボット８８の動きを演算する。第１ロボット８８は第２ロボット８９と並行して作動する。第１ロボット８８は手部８８ａを備えている。手部８８ａは手部３２に対応するモデルである。第１ロボット８８の手部８８ａはワーク９０を把持しており、第１ロボット８８はワーク９０を収納装置８７の方へ移動させる。シミュレーション演算部７５は第１ロボット８８が移動する軌跡を演算する。

図９（ｂ）及び図９（ｃ）はステップＳ５の衝突演算工程に対応する図である。図９（ｂ）に示すように、ステップＳ５において、干渉演算部７６は第１ロボット８８と第２ロボット８９との動作を演算する。干渉演算部７６は演算した軌跡の推測データを用いる。そして、第１ロボット８８と第２ロボット８９とを同時に動作させる演算を行う。まず、第１ロボット８８と第２ロボット８９とが接近する部材を選定する。

第１ロボット８８はモータ８８ｂを備えている。モータ８８ｂは第３関節３０が備える図示しないモータに対応するモデルである。そして、第２ロボット８９は指部８９ｂを備えている。指部８９ｂは指部３３に対応するモデルである。そして、例えば、第１ロボット８８のモータ８８ｂと第２ロボット８９の指部８９ｂとが接近する場合を説明する。

次に、接近する部材が干渉するか否かを演算する。図９（ｃ）に示すように、第２ロボット８９の指部８９ｂにおいて第１ロボット８８側の側面を指部側面８９ｃとする。この指部側面８９ｃとモータ８８ｂとが干渉するかを演算する。まず、指部８９ｂの場所と姿勢から指部側面８９ｃの式を演算する。指部側面８９ｃは平面であるので、ａ、ｂ、ｃ、ｄを係数として、指部側面８９ｃの式はａＸ＋ｂＹ＋ｃＺ＋ｄ＝０の形式にて示すことができる。そして、指部側面８９ｃ上の点を用いて係数を算出することにより、指部側面８９ｃの式を演算する。

次に、モータ８８ｂの側面をモータ側面８８ｃとする。モータ８８ｂは円筒形で表されている。そして、モータ側面８８ｃ上でモータ８８ｂの軸方向の線分８８ｄを設定する。線分８８ｄはモータ側面８８ｃを外周方向で幾つかに分割することにより設定される。線分８８ｄは等間隔に配置されることが好ましいが、必ずしも限定されない。詳細に検証する場所を細かく分割しても良い。

続いて、各線分８８ｄが指部側面８９ｃを通過するかを演算する。まず、線分８８ｄの式を演算する。座標（ｘ、ｙ、ｚ）を通過し、方向ベクトルが（ｌ、ｍ、ｎ）の式は（Ｘ−ｘ）／ｌ＝（Ｙ−ｙ）／ｍ＝（Ｚ−ｚ）／ｎの形式にて示すことができる。そして、線分８８ｄ上の点を用いて係数を算出することにより、線分８８ｄの式を演算する。

次に、線分８８ｄの式と指部側面８９ｃの式とを用いて線分８８ｄと指部側面８９ｃとが交差する点である交点の座標を演算する。続いて、交点が指部側面８９ｃ及びモータ側面８８ｃに含まれる範囲にあるかを演算する。交点が指部側面８９ｃとモータ側面８８ｃとの両方の面に含まれるとき、指部８９ｂとモータ８８ｂとが干渉すると判断する。そして、干渉する部材とその時刻をロボット関連データ６９としてメモリ６０に記憶する。

ステップＳ６の衝突判断工程ではロボット関連データ６９を用いて第１ロボット８８と第２ロボット８９とが干渉する場所があるかを確認する。そして、干渉する場所があるときステップＳ７の計画変更工程において、第１ロボット８８及び第２ロボット８９を駆動する計画を変更する。

図１０はステップＳ７の計画変更工程に対応する図である。図１０（ａ）に示すように、ステップＳ７において、第１ロボット８８及び第２ロボット８９を駆動する計画を変更する。第１ロボット８８はワーク９０を把持している。そして、ベルト８６上をワーク９０が移動して、第２ロボット８９の手部８９ａがワーク９０に移動する。この動作は変更しない。そして、第２ロボット８９が移動する間は、第１ロボット８８は停止する。従って、第１ロボット８８が手部８８ａを収納装置８７に移動させる計画を変更する。

図１０（ｂ）に示すように、第２ロボット８９がワーク９０を把持している。次に、第１ロボット８８は手部８８ａを収納装置８７に向かって移動させ、第２ロボット８９は手部８９ａを収納装置８７に向かって移動させる。このとき、第１ロボット８８及び第２ロボット８９は略平行に移動するので衝突し難くなる。その結果、図１０（ｃ）に示すように第１ロボット８８及び第２ロボット８９はワーク９０を収納装置８７と対向する場所に移動させる。以上のようにロボット４を駆動する計画を変更する。

続いて、変更した計画に基づいてステップＳ４のシミュレーション工程及びステップＳ５の衝突演算工程を行う。そして、ステップＳ６の衝突判断工程において第１ロボット８８と第２ロボット８９とが衝突しないことを確認した後、ステップＳ８の第２移動工程を行う。ステップＳ８ではステップＳ７の計画変更工程にて作成した計画どおりにロボット４を駆動してワーク１１を収納装置２０に移動させる。以上によりワーク１１をコンベア装置２から収納装置２０へ移動させる工程を終了する。

上述したように、本実施形態によれば、以下の効果を有する。
（１）本実施形態によれば、ロボット４の手部３２や第３関節３０等にはロボット用超音波タグ１３が配置されている。ロボット用超音波タグ１３の場所を検出することにより、ロボット４の姿勢を検出することができる。ロボット４の姿勢を検出する方法としては可動部と可動部とが接続する部分にエンコーダ等のセンサを配置する方法がある。そして、可動部と可動部との相対位置を検出する。その場合、各可動部の一端の位置データに対する他端の位置データを加算することにより、接続する可動部の両端の相対位置データが算出される。この方法に比べて、本実施形態ではロボット用超音波タグ１３の場所を直接検出するので、発信位置演算部７３が短い時間で手部３２や第３関節３０等の位置や姿勢を検出することができる。

（２）本実施形態によれば、超音波信号８０を用いてロボット用超音波タグ１３とロボット用超音波受信装置１９との距離を測定している。光や電波等の電磁波に比べて超音波は伝播速度が遅い。従って、電磁波に比べて超音波は伝播距離に対応する到達時間が長くなる。その結果、電磁波を用いるときに比べて、超音波を用いる方が到達時間を測定し易くすることができる。

（３）本実施形態によれば、第１腕２７や第２腕２９等の可動部には可動部における自由度の数だけロボット用超音波タグ１３が配置されている。従って、可動部が移動する場所と姿勢とを検出することができる。

（４）本実施形態によれば、ロボット用超音波タグ１３の場所の情報を用いて手部３２等の可動部の姿勢を認識している。そして、その姿勢から可動部の推移をシミュレーションする演算をしている。推移前の可動部の位置を基にして、可動部の推移を算出するので、可動部の推移を正確に算出することができる。

（５）本実施形態によれば、短い時間でロボット用超音波タグ１３の場所を検出することができる。そして、干渉演算部７６はロボット用超音波タグ１３のデータを用いてロボット同士の衝突を検出している。従って、短い時間でロボット同士の衝突を検出することができる。

（６）本実施形態によれば、シミュレーション演算部７５が可動部の推移をシミュレーションする演算を行う。そして、干渉演算部７６が可動部同士の干渉を演算する。従って、可動部が移動するときの各場所で可動部同士の衝突を検出することができる。

（７）本実施形態によれば、ロボット用超音波タグ１３は姿勢によらずＺ方向に超音波信号８０を発信する。従って、ロボット４の可動部に姿勢によらずロボット用超音波受信装置１９に向けて超音波信号８０を発信することができる。

（８）本実施形態によれば、発信位置演算部７３はコンベア装置２とロボット４との相対位置を演算している。従って、コンベア装置に対してロボットの可動部が到達できる範囲を認識することができる。

尚、本実施形態は上述した実施形態に限定されるものではなく、種々の変更や改良を加えることも可能である。変形例を以下に述べる。
（変形例１）
前記実施形態では、ロボット用超音波タグ１３とロボット用超音波受信装置１９との距離を計測するのに超音波を用いたが、他の媒体による波形を用いても良い。例えば、レーザー光や赤外光を用いて光の位相を検出することにより距離を計測しても良い。他にも、電磁波を用いて距離を計測しても良い。計測し易い方法を採用しても良い。この場合にも、ロボット４の各可動部の場所や姿勢を検出することができる。

（変形例２）
前記実施形態では、ワーク１１とワーク支持部１２とを合わせて収納装置２０に移動した。ワーク支持部１２をベルト９上に残してワーク１１のみ収納装置２０に移動しても良い。ワーク支持部１２に着脱機構を配置して、手部３２が着脱機構を作動させるようにしても良い。次工程での作業をし易くすることができる。

（変形例３）
前記実施形態では、電波発信装置８は電波信号をロボット用超音波タグ１３に送信した。電波発信装置８を光発信装置におき変えて、光発信装置がロボット用超音波タグ１３と光通信をしても良い。電磁波ノイズの影響を受け難くすることができる。

（変形例４）
前記実施形態では、３つのロボット用超音波受信装置１９が受信した超音波信号８０からロボット用超音波タグ１３の場所を演算した。１つのロボット４に対して４つのロボット用超音波受信装置１９を配置しても良い。そして、４つのロボット用超音波受信装置１９が受信した超音波信号８０からロボット用超音波タグ１３の場所を演算しても良い。特開平６−２２２１３０号公報に１つの超音波源と４つの受波装置とを用いて超音波源の場所を演算する方法が開示されている。超音波源と４つの受波装置との距離に関して４つの方程式を作成している。そして、方程式の解を算出することにより超音波源の場所を算出している。この方法を採用してロボット用超音波タグ１３の場所を算出しても良い。この方法では、電波発信装置８が発信する発信タイミング信号がなくともよいので、回路の構成を簡略にすることができる。

（変形例５）
前記実施形態では、ステップＳ３のロボット検出工程にて、電波発信装置８は識別コードを順次切り換えて電波信号７９を送信した。そして、ロボット用超音波タグ１３は電波信号７９を受信した後、超音波信号８０を発信した。この手順に限定されなくとも良い。１つのロボット用超音波タグ１３が超音波信号８０を発信して所定の時間が経過後、他のロボット用超音波タグ１３が順次超音波信号８０を発信しても良い。手順が簡略化されるので、プログラムソフト６７を簡便にすることができる。その結果、プログラムソフト６７を生産性良く製造することができる。

（変形例６）
前記実施形態では、コンベア装置２を用いてワーク１１を移動したが、ワーク１１の移動方法はこの方法に限定されない。ワーク１１が所定のコースを移動できれば良い。例えば、ワーク支持部１２に自走装置を配置しても良い。ワーク１１の工程間移動を移動し易くすることができる。

（変形例７）
前記実施形態では、コンベア装置２のベルト９によりワーク１１は直進したが、これに限らない。ベルト９によりワーク１１は曲線を描いて移動しても良い。他にも、所定の角度でワーク１１が曲がって進行しても良い。この場合にも、予めワーク１１の移動軌跡が推定できるときにはシミュレーション演算部７５がワーク１１とロボット４との動作をシミュレーションすることができる。

（変形例８）
前記実施形態では、ステップＳ８の第２移動工程においてベルト９によりワーク１１を移動させながらロボット４がワーク１１を把持した。ロボット４がワーク１１を把持するときにはベルト９を停止しても良い。ロボット４がワーク１１を把持し易くすることができる。

（変形例９）
前記実施形態において、ロボット用超音波タグ１３は超音波信号８０を発信している。超音波信号８０が発信する周波数はロボット用超音波タグ１３毎に変えても良い。ロボット用超音波受信装置１９に周波数分析回路を追加する。そして、ロボット用超音波受信装置１９が超音波信号８０の周波数を分析する。これにより、ロボット用超音波受信装置１９は超音波信号８０を発信したロボット用超音波タグ１３を識別することができる。

（変形例１０）
前記実施形態において、発信位置演算部７３はロボット用超音波タグ１３が配置されている場所の情報を用いてロボット４の各可動部の位置と姿勢とを演算した。発信位置演算部７３は各可動部が移動した軌跡を演算しても良い。発信位置演算部７３はロボット用超音波タグ１３の場所をメモリ６０に記憶する。そして、そのメモリ６０に記憶された過去のロボット用超音波タグ１３の場所に関するデータを再生する。そのデータを用いて発信位置演算部７３は各可動部が移動した軌跡を演算する。そして、各可動部の軌跡の情報から各可動部に働く慣性力を配慮して各可動部の動作をシミュレーションしても良い。各可動部を精度良くシミュレーションすることができる。

（変形例１１）
前記実施形態において、発信位置演算部７３はロボット用超音波タグ１３が配置されている場所の情報を用いてロボット４の各可動部の位置と姿勢とを演算した。発信位置演算部７３はロボット用超音波タグ１３の動きから各稼動部の振動を検出しても良い。そして、ロボット４の可動部が不要な振動をしているとき、ロボット４を保守する指示を表示装置６６に表示しても良い。ロボット４を保守する時期を精度良く把握することができる。そして、ロボット４を保守することにより、ロボット４を品質良く作動させることができる。

（変形例１２）
前記実施形態において、ワーク用超音波受信装置１６は第１受信装置支持部１５に配置され、ロボット用超音波受信装置１９は第２受信装置支持部１８に配置された。ワーク用超音波受信装置１６はコンベア装置２と直接接続されなくとも良い。同様に、ロボット用超音波受信装置１９はロボット４と剛性のある部材を介して接続されなくとも良い。ワーク用超音波受信装置１６及びロボット用超音波受信装置１９はロボットシステム１が配置された部屋の天井に設置されても良い。そして、発信位置演算部７３がコンベア装置２の場所とロボット４との場所を検出して、コンベア装置２のロボット４との相対位置を認識しても良い。この場合にも精度良くコンベア装置２のロボット４との相対位置を認識することができる。このとき、第１受信装置支持部１５及び第２受信装置支持部１８を削減できるので省資源な装置にすることができる。
の移動方法はこの方法に限定されない。ワーク１１が所定のコースを移動できれば良い。例えば、ワーク支持部１２に自走装置を配置しても良い。

ロボットシステムの構成を示す概略斜視図。 ロボットを示す概略斜視図。 （ａ）は、ロボット用超音波タグを示す模式断面図、（ｂ）は、超音波タグの電気制御ブロック図。 ロボットシステムの電気制御ブロック図。 ワークを収納場所へ移動させる工程を示すフローチャート。 ロボットを用いた作業方法を説明する図。 ロボットを用いた作業方法を説明する図。 ロボットを用いた作業方法を説明する図。 ロボットを用いた作業方法を説明する図。 ロボットを用いた作業方法を説明する図。

符号の説明

１…ロボットシステム、２…搬送部としてのコンベア装置、４…ロボット、４ａ…ロボットとしての第１ロボット、４ｂ…ロボットとしての第２ロボット、７…発信部及び超音波タグとしてのワーク用超音波タグ、１３…発信部及び超音波タグとしてのロボット用超音波タグ、１９…受信部としてのロボット用超音波受信装置、２５…可動部としての回転台、２６…可動部としての第１関節、２７…可動部としての第１腕、２８…可動部としての第２関節、２９…可動部としての第２腕、３１…可動部としての第３腕、３２…可動部としての手部、３３…可動部としての指部、３４…可動部としての支持部、３５…可動部としての外装部、３６ａ…可動部としての磁心、７３…位置演算部としての発信位置演算部、７４…衝突演算部、７５…軌跡演算部としてのシミュレーション演算部、７６…干渉演算部、８０…無線信号及び超音波としての超音波信号。

Claims (9)

1. 可動部を有するロボットであって、
   前記可動部に配置され無線信号を発信する複数の発信部と、
   前記発信部が発信した前記無線信号を受信する３個以上の受信部と、
   複数の前記受信部が受信する前記無線信号の到達時間を用いて前記発信部の場所を検出する位置演算部と、を有し、
   前記位置演算部は検出した複数の前記発信部における前記場所の情報から前記ロボットの姿勢を検出することを特徴とするロボット。
2. 請求項１に記載のロボットであって、
   前記ロボットが把持するワークを搬送する搬送部を備え、
   前記搬送部は複数の前記発信部を有し、
   前記位置演算部は前記受信部を用いて前記搬送部の場所を検出し、前記搬送部と前記ロボットとの相対位置を演算することを特徴とするロボット。
3. 請求項２に記載のロボットであって、
   前記位置演算部は前記可動部の軌跡を演算することを特徴とするロボット。
4. 請求項３に記載のロボットであって、
   前記発信部は超音波を発信する超音波タグであり、
   前記受信部は超音波を受信することを特徴とするロボット。
5. 請求項４に記載のロボットであって、
   前記可動部における自由度の数以上の前記発信部が前記可動部に配置されていることを特徴とするロボット。
6. 請求項５に記載のロボットであって、
   前記可動部が移動する軌跡の推移を演算するシミュレーション演算部を有し、
   前記シミュレーション演算部は前記発信部の前記場所の情報を用いて前記軌跡の推移を演算することを特徴とするロボット。
7. 複数のロボットが動作するロボットシステムであって、
   前記ロボットの可動部に配置され無線信号を発信する複数の発信部と、
   前記発信部が発信した前記無線信号を受信する３個以上の受信部と、
   複数の前記受信部が受信する前記無線信号の到達時間を用いて前記発信部の場所を検出する位置演算部と、
   前記ロボット同士が衝突するかを推測する衝突演算部と、を有し、
   前記衝突演算部は前記発信部における前記場所の情報を用いて前記ロボット同士の衝突を検出することを特徴とするロボットシステム。
8. 請求項７に記載のロボットシステムであって、
   前記発信部は超音波を発信する超音波タグであり、
   前記受信部は超音波を受信することを特徴とするロボットシステム。
9. 請求項８に記載のロボットシステムであって、
   前記衝突演算部は、前記可動部が移動する軌跡の推移を演算するシミュレーション演算部と、
   前記可動部同士が干渉するかを演算する干渉演算部と、を有することを特徴とするロボットシステム。

Images