ロボット本体のキャスティング方法及び装置
【課題】 到達が困難な位置に、ロボット本体を正確に移動させることができ、災害救助や宇宙空間の作業等に広く応用することを可能にする。
【解決手段】 ロボット本体の初期位置と、ロボット本体の目標到達位置の３次元座標とに基づいて、少なくとも３カ所の目標固定位置を決定し、ワイヤの先端に設けられたグリッパあるいはアンカーをそれぞれの目標固定位置に固定し、ロボット本体と目標固定位置との間をそれぞれワイヤで連結する。次にロボット本体の目標キャスティング軌道を演算し、ワイヤのうち、少なくとも２本のワイヤの張力をそれぞれの目標値に制御し、各ワイヤにより張力拮抗状態を形成する。その後張力拮抗状態にあるワイヤのいずれかの固定を解除し、蓄積された弾性エネルギにより、ロボット本体を３次元空間にキャスティングするとともに、ロボット本体の３次元空間での運動を、各ワイヤの繰り出し量、巻き取り量、あるいは張力を別個に制御する。
【解決手段】 ロボット本体の初期位置と、ロボット本体の目標到達位置の３次元座標とに基づいて、少なくとも３カ所の目標固定位置を決定し、ワイヤの先端に設けられたグリッパあるいはアンカーをそれぞれの目標固定位置に固定し、ロボット本体と目標固定位置との間をそれぞれワイヤで連結する。次にロボット本体の目標キャスティング軌道を演算し、ワイヤのうち、少なくとも２本のワイヤの張力をそれぞれの目標値に制御し、各ワイヤにより張力拮抗状態を形成する。その後張力拮抗状態にあるワイヤのいずれかの固定を解除し、蓄積された弾性エネルギにより、ロボット本体を３次元空間にキャスティングするとともに、ロボット本体の３次元空間での運動を、各ワイヤの繰り出し量、巻き取り量、あるいは張力を別個に制御する。
【発明の詳細な説明】
【技術分野】
【０００１】
宇宙開発や、土木・建築現場、災害救助・復旧支援、地質調査、海底・湖底開発、爆発物の処理等で使用する機材等を備え、かつロボットから伸展可能なワイヤ並びに把持部材（グリッパ等）を介して環境との結合が可能なロボットをキャスティングによって目標位置に移動させる方法とその装置に関する。
【背景技術】
【０００２】
下記特許文献１にみられるように、大型宇宙構造物の建設保守を想定して、作業を行うロボットに伸展式のアームを設け、このアームを用いて複数のテザー式のアームの構造物への把持位置を変更することにより、構造物上の移動を可能にするシステムが提案されている。
【０００３】
下記特許文献２では、線状柔軟リンクの先端に備えたグリッパを、剛体アームにより所望の箇所に投擲して、環境に固定されたバーをグリッパにより把持させた上で、線状柔軟リンクの巻き取りと剛体アームの運動を協調させることにより、ロボット本体を所定の位置に移動させるシステムが提案されている。
【０００４】
また、下記非特許文献１では、線路や道路を通すため、山の斜面を削って法面（斜面）を安全に形成するシステムとして、下記非特許文献１にみられるように、予め急斜面の最上面に２箇所のアンカーを設置し、このアンカーに固定された２本のワイヤでロボットを支持し、各ロープに作用する張力を制御することにより、ロープが常に張った状態でロボットを所定の位置に移動させるようなシステムが開発されている。
【０００５】
なお、下記特許文献３には、ロボットアームに接続される把持部材を、慣性力、遠心力を利用して投擲するとともに、並進・回転制御用に線状柔軟リンク（ワイヤ）の張力によって、把持部材を目標位置に制御する技術が示されている。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２００８−２６０４３６号公報
【特許文献２】特開２００７−１３６６０１号公報
【特許文献３】特許４００６５２８号公報
【非特許文献】
【０００７】
【非特許文献１】足歩行型法面作業ロボットＴＩＴＡＮ ＸＩの開発−基本設計と脚機構の動作実験−、程島 竜一・土居 隆宏・福田 靖・広瀬 茂男・岡本 俊仁・森 純一、日本ロボット学会誌、２３．７．８１−９１（２００５）
【発明の概要】
【発明が解決しようとする課題】
【０００８】
上記先行技術によれば、無重力の宇宙空間や、急斜面において、テザーやロープを張った状態でロボットを目標位置に移動させることができる。
しかしながら、上記特許文献１のものでは、宇宙構造物の外壁にある固定バーにフックをかける際、剛体の伸展式アームを用いていることから、長いアームを搭載する場合、ロボット運搬機での占有空間や搬送重量の増加を招き、装置搬送のコストが増加する問題やアーム操作時のエネルギ消費が高くなる問題が生ずる。
また、伸展式アームの伸展方法はＳＴＥＭ機構や自動車のアンテナ機構と同様の一直線方向の並進運動を想定しているため、図１に示すようにアームの根元から目標の固定バーまでの間に、壁などの障害物がある場合、これを迂回して固定バーにフックを掛けることは非常に困難である。仮に、伸展式アームとして回転関節を含む多関節駆動系アームを用いれば、アームを屈曲させることにより障害物を回避してアームを伸展させることが可能になると考えられるが、アームの重量や慣性モーメントが増加するため、消費エネルギの増加に加え、アームの制震制御が困難となる問題が生ずる。
【０００９】
一方、剛体の伸展式アームが短い場合、アームの届く範囲が狭いため、図２に示すようにハンドが固定バーに届くように外壁に短い距離間隔で多数の固定バーを密に設置しなければならない。
そのため設置費用がかかるうえに、移動時にフックをかける作業の頻度が高くなり、作業効率が低下するという問題がある。すなわち、テザー張力が拮抗する状態で広い可動領域を確保するには、領域の各頂点がお互いに遠い位置になければならないが、そのためには各頂点へ短いアームでフックを掛けながらロボットが移動していく必要があり、広い可動領域の確保に時間を要することになる。
【００１０】
また、図３に示すように構造物の外壁にアームの長さより幅のある深い溝がある場合、ロボットはその溝を飛び越えて移動することはできず、溝の側面に沿って設置した固定バーにフックをかけながら溝の底へ下りて、再び他方の側面に沿って上る必要があるため、移動に時間がかかるうえに、移動距離が長くなり、消費エネルギが高くなる問題がある。
さらに、ロボットが宇宙構造物に接していない初期状態では、短いアームを用いてフックを固定バーに掛けるには構造物の外壁に十分に近づく必要があり、スラスタなどの別の移動装置と衝突を防ぐための制御装置等が新たに必要となるという問題がある。
【００１１】
また、上記特許文献３のものでは、ロボット本体の位置を変えずにグリッパを固定バーの方向に投擲して把持させるが、一般的に固定バーの位置が遠方であるほど投擲誤差が拡大するので、固定バーを把持する精度は下がる。また、ロボットの移動範囲が、グリッパの把持位置までに制限されてしまうという問題点がある。
【００１２】
上記非特許文献１のものでは、あくまでも、急斜面の最上面に２箇所のアンカーを設置することが前提であり、アンカーが設置できないような急斜面での移動は不可能であり、また、アンカーが設置されたとしても、移動はアンカーの設置箇所から下ろした鉛直線の間の範囲に制限されてしまうという問題がある。
【課題を解決するための手段】
【００１３】
そこで、上記の課題を解決するため、本発明では、剛体の伸展式アームの代わりに、剛体アームの先からエンドエフェクタ（グリッパ、アンカー、フックなど）までを繋ぐ軽量で柔軟なワイヤを備え、該ワイヤの繰出量によって該ワイヤの長さを自在に変えることが可能な複数個のアームを用いて、ロボット本体をキャスティングし、環境との結合点で囲まれた領域を越えて目標点へロボットを移動させる。より具体的には、本発明のロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング方法は、
（１）ロボット本体を初期設置位置に配備する工程と、該初期設置位置と、ロボット本体の前記目標到達位置の３次元座標とに基づいて、少なくとも３カ所の目標固定位置を決定し、ワイヤの先端に設けられたグリッパあるいはアンカーなどのエンドエフェクタをそれぞれの目標固定位置に固定し、ロボット本体と目標固定位置との間をそれぞれワイヤで連結する工程と、前記初期設置位置と、前記グリッパあるいはアンカーの固定位置と、前記目標到達位置とに基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算する工程と、各ワイヤの繰出量、巻取量を制御して、前記ロボット本体を、前記キャスティング開始時点における位置及び姿勢に調整する工程と、前記目標キャスティング軌道に基づいて、前記ワイヤのうち、少なくとも２本のワイヤに蓄積される弾性エネルギをそれぞれの目標値に制御することにより、すべてのワイヤの張力拮抗状態において、前記ロボット本体の初期キャスティング力ベクトルを決定する工程と、前記張力拮抗状態にあるワイヤのうち、蓄積される弾性エネルギを前記目標値に制御したワイヤ以外のワイヤの固定を解除し、前記初期キャスティング力ベクトルにより、前記ロボット本体を３次元空間にキャスティングする工程と、前記ロボット本体の３次元空間での運動を、各ワイヤの繰出量、巻取量、あるいは張力を別個に制御することにより、前記ロボット本体を前記目標到達位置に到達させる工程とから構成される。
【００１４】
（２）上記ロボット本体のキャスティング方法は、前記決定された目標固定位置の３次元位置に基づいて、前記エンドエフェクタの目標投擲位置及び目標投擲軌道を演算し、該エンドエフェクタを、投擲機構により投擲することにより、それぞれの目標固定位置に固定する工程を具備してもよい。
【００１５】
（３）上記ロボット本体のキャスティング方法は、前記エンドエフェクタの目標固定位置に、前記ロボット本体の目標到達位置の上方位置を付加し、前記ロボット本体が目標到達位置に着地させる際の重力による衝撃を緩和させる工程を具備してもよい。
【００１６】
（４）また、上記ロボット本体のキャスティング方法は、前記目標到達位置を、前記ロボット本体の目標着地位置の上方に設定し、前記ロボット本体がキャスティングにより該目標到達位置に到達したとき、前記ロボット本体に内蔵したパラシュートを開き、前記ロボット本体が目標着地位置に着地させる際の重力による衝撃を緩和させる工程を具備してもよい。
【００１７】
（５）また、上記ロボット本体のキャスティング方法は、前記ロボット本体を３次元空間にキャスティングする工程に先だって、ワイヤ付き鉄球を該目標到達位置より上方に向けて投擲し、前記ロボット本体が該目標到達位置に到達したとき、該鉄球が鉛直方向上向きに所定の速度ベクトル成分を有するようにするとともに、該鉄球が先端に接続されたワイヤを拘束し、前記目標固定位置に固定されたワイヤの少なくとも一本を拘束することにより、各ワイヤに作用する張力の合力が鉛直方向上向きの成分を有するようにすることによって、前記ロボット本体に作用する重力加速度を相殺し、目標着地位置に着地させる際の重力による衝撃を緩和させる工程を具備してもよい。
【００１８】
また、上記のロボット本体のキャスティング方法を実現するため、本発明のロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング装置は、
（６）先端にグリッパあるいはアンカーなどのエンドエフェクタを備えた少なくとも３本のワイヤと、該ワイヤのそれぞれに対応してロボット本体に設置され、各ワイヤの末端が結合された回転ドラムと、該回転ドラムのワイヤ繰出量及び巻取量を制御する駆動モータ、電磁ブレーキ、電磁クラッチとからなる繰出・巻取制御装置と、前記ロボット本体の初期設置位置、前記エンドエフェクタの固定位置及び前記ロボット本体の目標到達位置に基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算するとともに、該演算結果に基づいて、前記繰出・巻取制御装置を介して前記回転ドラムのワイヤ繰出量及び巻取量並びに各ワイヤに蓄積される弾性エネルギを制御するコントローラとを具備している。
【００１９】
（７）上記ロボット本体のキャスティング装置は、前記ロボット本体のフレームの少なくとも３カ所に、軸線方向の伸縮量、軸線周りの旋回量及び複数の関節角度を制御し得る剛体アームが設置され、該剛体アームのそれぞれは、前記繰出・巻取制御装置及び前記エンドエフェクタを前記固定位置に投擲する投擲機構を具備し、前記コントローラからの指令に応じて、前記エンドエフェクタの投擲開始位置及び投擲方向を制御するとともに、マニピュレータ機能を具備してもよい。
【００２０】
（８）前記投擲機構は、ワイヤが巻回される回転ドラム、該回転ドラムを駆動する駆動モータ、該回転ドラムを制動する電磁ブレーキ、前記駆動モータから前記回転ドラムに伝達されるトルクを制御するとともにドラムを自由に回転させる電磁クラッチ及びワイヤの運動を拘束あるいは解放する電磁ブレーキを具備してもよい。
【００２１】
（９）さらに、前記ロボット本体は、前記コントローラにより作動されるパラシュートを内蔵していてもよい。
【００２２】
（１０）また、前記ロボット本体は、鉄球と、該鉄球を予め設定された方向に投擲する投擲機構と、該鉄球を先端に備えたワイヤの末端が結合された回転ドラムと、該ワイヤを拘束する電磁ブレーキとをさらに備え、前記コントローラにより前記鉄球の投擲方向と投擲速度を制御するとともに、所定のタイミングで前記電磁ブレーキを作動させて該ワイヤを拘束するようにしてもよい。
【発明の効果】
【００２３】
本発明のロボット本体のキャスティング方法、及びこれを実現するキャスティング装置によれば、これまで車輪などの移動機構や伸展式アームでは到達が困難であった環境でも、ワイヤの固定位置で囲まれた領域を越えて、ロボット本体を予め演算された３次元空間内の目標軌道に沿ってキャスティングし、正確に目標位置に到達させるとともに、ロボット本体を目標姿勢で着地させることが可能になる。
【図面の簡単な説明】
【００２４】
【図１】アンテナ式に進展する剛体アームを使用した従来技術を示す図である。
【図２】短い剛体アームを使用した従来技術を示す図である。
【図３】アンテナ式に進展する剛体アームを使用した従来技術において、剛体アームの長さより幅のある深い溝がある場合の移動ルートを示す図である。
【図４】本発明によりロボット本体を対岸にキャスティングさせる際の動作を示す図である。
【図５】キャスティング準備のための張力拮抗状態を示す図である。
【図６】ロボット本体を目標位置に到達させるための方向制御を示す図である。
【図７】遠方の見えない場所へキャスティングする例を示す図である。
【図８】裏側の破損部を検査し修復するため、回り込んでキャスティングする例を示す図である。
【図９】ロボット本体の主要部を示す図である。
【図１０】地上の目標固定端の上方でロボット本体に内蔵したパラシュートを作動させた状態を示す図である。
【図１１】ワイヤ付き鉄球を投擲して、ロボット本体の落下速度を緩和させた状態を示す図である。
【発明を実施するための形態】
【００２５】
以下、図面を参照しつつ本発明の実施例について説明する。
【実施例】
【００２６】
図４は、ロボット本体１を対岸にキャスティング移動させる場合を示している。
ロボット本体１は、初期位置に所定の姿勢で設置され、その四隅に設けられた剛体アーム１１、１２、１３、１７は、ワイヤの先端に取り付けられたグリッパ５、６やアンカー（突き刺し機構）７を投擲する投擲機構を有している。この投擲装置については後述するが、上記特許文献３に示されているような、ワイヤ２、３、４の先端に連結されているグリッパ５、６あるいはアンカー７に回転運動や並進運動を与え、ワイヤの張力によって空中における回転運動や並進運動を制御する装置を用いて、木や岩などの環境の固定端８、９、１０に向けて正確に投擲するものである。
なお、この実施例では、後述するように剛体アーム１１、１２、１３、１７にマニピュレータ機能を具備させているが、ロボット本体１に、目標とする着地位置で必要とされる作業を実行するための種々のマニピュレータやカメラ等を搭載してもよい。
【００２７】
まず、剛体アーム１１、１２、１３の投擲機能を使用して、ワイヤ２、３、４の先端に装着されたグリッパ５、６、アンカー７を目標とする固定端８、９、１０にキャスティングし、図５に示すように各固定端８、９及び固定端１０に固定し、ワイヤ２、３、４により、パラレルワイヤ構造を形成する。
なお、固定端８、９、１０がアクセス可能な位置にある場合は、剛体アーム１１、１２、１３、１７のマニピュレータ機能を使用して固定してもよいし、作業員がワイヤ２、３、４を引き延ばして、手動で環境の固定端８、９、１０に固定してもよい。
【００２８】
この実施例では、各ワイヤ３、４は、弾性的に伸縮し得る素材で形成されており、ロボット本体１側に設けたコントローラ及び各剛体アーム１１、１２、１３に個別に設けられた投擲機構の繰出・巻取制御装置により、独立してワイヤ２、３、４の繰出量、巻取量が制御されるようになっている。
なお、図５では、アンカー７に換え、グリッパ１４で固定端１０に結合された状態を示している。
【００２９】
グリッパ５、６及びアンカー７が環境にある固定端８、９、１０に固定されると、ロボット本体１あるいは外部に設置されたコントローラにより、ワイヤ２、３、４を、各投擲機構の繰出・巻取制御装置を介して巻き取り、あるいは繰り出すことによって、ロボット本体１を投擲可能な位置に移動させる。
繰出・巻取制御装置のそれぞれは、図９に示されるように、ワイヤ２、３、４の基端が連結されるとともに、これらの巻き取り、繰り出しを行う回転ドラム２１、この回転ドラム２１を駆動する駆動モータ２３、この回転ドラムを制動する電磁ブレーキ（図示せず）、ワイヤ２、３、４を瞬時にロックあるいは解放する電磁ブレーキ２２、及び回転ドラム２１と駆動モータ２３とを切り離し、ドラムを自由に回転させる電磁クラッチ２４などから構成されている。
なお、駆動モータ２３の出力軸は、電磁クラッチ２４、タイミングベルト２６を介して回転ドラム２１に連結されており、コントローラには、このタイミングベルト２６の張力を測定するベルト張力測定器２５の検出値とともに、ワイヤ２、３、４をガイドするローラにそれぞれ設けられた張力検出器の検出値が入力されるようになっている。
【００３０】
コントローラは、駆動モータ２３の出力、電磁ブレーキ２２のオンオフ、電磁クラッチ２４の伝達トルクを制御するとともに、ベルト張力測定器２５の出力に基づいて、駆動モータ２３から回転ドラム２１に伝達されるトルクを目標値にフィードバック制御することにより、各ワイヤ２、３、４の巻取量、繰出量及び張力をそれぞれ独立して制御し、キャスティング開始時のロボット本体１の初期位置及び初期姿勢を微調整することができる。
【００３１】
次に、ワイヤ２を繰出・巻取制御装置内に搭載された電磁ブレーキ２２によりロックし、ワイヤ３、４の繰出・巻取制御装置が、ワイヤ３、４を巻き取ってバネのように伸ばし、ワイヤ２、３、４のそれぞれに個別の目標張力を発生させて、図５に示すようにロボット本体１をワイヤ張力が拮抗する静止状態にする。ここで、固定端８、９、１０で形成される三角形内部の範囲が、張力拮抗状態となり得る可動領域となる。
【００３２】
なお、この実施例では、ワイヤ２にはあまり伸縮しない高バネ係数の素材を使用し、ワイヤ３、４には、所定の伸縮ストロークが確保できるよう、低バネ係数の素材を使用するが、すべてのワイヤ２、３、４に、高バネ係数の素材を使用し、ワイヤ３、４に、本発明者が上記特許文献２で提案した、スライダ上に設置された電磁ブレーキによりワイヤ３、４にロックすることにより、一端が投擲レバー側に、他端がスライダ側に固定されたスプリングを伸張させて、所定の伸縮ストロークが確保されるようにしてもよい。
【００３３】
なお、環境との結合機能を有するグリッパ５、６やアンカー７、あるいはフック等のエンドエフェクタはロボット本体１にある収納箱１６に収納されており、各剛体アーム１１、１２、１３，１７は、そのアーム先端を収納箱１６に伸ばし、周囲の環境に応じてグリッパ５、６やアンカー７等のエンドエフェクタを選択した上で着脱できるようになっている。
【００３４】
図５の状態では、ロボット本体１には、各ワイヤ２、３、４の目標張力が作用しており、これらの張力の合力は釣り合いの状態になる。
次に、この静止状態において、剛体アーム１１の投擲装置に設けられた繰出・巻取制御装置内の電磁ブレーキ２２を解放することによりワイヤ２のロックを解除して、ワイヤ２をその張力が零の状態になるように繰り出せば、合力の釣り合い状態が崩れ、ワイヤ３、４の張力の合力がロボット本体の重心にかかる並進力並びにその重心を通る軸まわりの回転力として作用し、図６に示されるように、ロボット本体１はグリッパ６とアンカー７の間を通る方向へ加速され、ロボット本体１が空間にキャスティングされることになる。
【００３５】
ロボット本体１が空間にキャスティングされてからの３次元空間における運動の制御は、それぞれの繰出・巻取制御装置によりワイヤ２、３、４の繰出量、巻取量を調整して、各ワイヤの張力を制御することにより行う。
【００３６】
図９はロボット本体１の主要部を示すもので、Ｙ型のフレームを２つ組み合わせ、各端部に剛体アーム１１、１２、１３、１７が配置され、その中央部に収納箱１６が設置されている。各剛体アーム１１、１２、１３、１７は、マニピュレータ機能を具備させるため、コントローラからの指令に応じて、軸線方向の伸縮量、軸線周りの旋回量とともに、複数の関節角度を制御できるようになっている。
【００３７】
各剛体アーム１１、１２、１３、１７の先端には、モータにより回転駆動される投擲レバー２７が設けられ、コントローラからの指令により、各剛体アームの伸縮長さ、軸方向の回転角及び各関節の回転角を調整した後、投擲レバー２７を駆動するモータが目標回転速度に達したとき、所定の投擲角度で投擲機構の電磁クラッチを解放し、所定の初速度、所定の投擲角度で、グリッパ５、６やアンカー７などのエンドエフェクタを、目標軌道に沿って目標固定位置に投擲するようになっている。
また、収納箱１６には、各種エンドエフェクタが収納され、その側部空間に剛体アーム１１、１２、１３、１７、あるいは各種作業用のマニピュレータ、カメラ、コントローラなどが収容される。
【００３８】
以下、具体的なキャスティングについて説明する。
（１）〈グリッパ、アンカーのキャスティング〉
ロボット本体１に設けられたカメラからの画像あるいは環境に設置したカメラからの画像を用いて、ユーザがグリッパ５、６で固定する固定端８、９、１０の３次元位置を決め、画像を表示する画面上において、各固定端８、９、１０との結合位置をロボットに与え、投擲の指示を送る。
【００３９】
なお、固定端周辺の暗さや霧などの影響や地形や障害物の状態などによって、カメラ画像の解像度が十分得られず、固定端の位置を正確に計測できない場合は、カメラ画像から推定されるおおよその位置データをもとに、ワイヤを介して本体と繋がったワイヤ付き鉄球などの破損しにくいエンドエフェクタを剛体アームにより固定端周辺へ投擲する。
このワイヤ付き鉄球が固定端周辺に着地して静止したら、該ワイヤ付き鉄球とロボット本体を繋ぐワイヤを巻き取って、該ワイヤ付き鉄球が動かず、かつワイヤが伸びない程度にワイヤを張った状態にし、そのときのワイヤの繰り出し長さとロボット本体１からみたワイヤの方向ベクトルを計測することにより、ロボット本体１からみた該ワイヤ付き鉄球の位置を算出することができ、着地点に到るまでの軌跡の良否を確認するとともに、ロボット本体１の初期設置位置からみた固定端の位置を推測することができる。
【００４０】
そして、この鉄球に内蔵したライトにより固定端周辺の照明を行い、カメラ画像の解像度を上げ、固定端の位置を正確に測定できるようにしたり、あるいは、鉄球自体にもカメラを設けて、算出した鉄球の位置からの固定端の位置を算出する。
また、これによっても、固定端の測定が困難な場合には、その後、ワイヤを巻き取って該ワイヤ付き鉄球をロボット本体へ回収して、さらに、固定端周辺の他の場所へ再度、投擲し、固定端の測定が可能となるまでこれを繰り返せばよい。
【００４１】
さらに、正確に固定端周辺の計測する必要がある場合は、複数のワイヤ付き鉄球を同時にそれぞれ固定端周辺の別の場所へ投擲することによって、固定端周辺の複数の場所に着地したワイヤ付き鉄球の各位置を上記の方法によりそれぞれ算出する。
これにより、固定端周辺の複数の位置を正確に算出できるので、固定端の位置をカメラ画像により確認し、あるいは、固定端周辺の鉄球の位置データと、各鉄球からの固定端の位置データに基づいて、固定端の位置を高精度に推定することができる。
【００４２】
次に、ロボット本体１内、あるいは外部に設けられたコントローラは、視覚センサあるいはレーザレンジセンサなどの計測器を用いてユーザが指示した固定端の実際の位置を測定し、ロボット本体１の現在位置から各固定端との結合位置までの相対位置を演算し、その結果に基づいて、グリッパ５、６、アンカー７の目標投擲軌道及び目標投擲位置を演算し、各剛体アーム１１、１２、１３の先端に設けられた投擲機構を利用して各目標位置に投擲し、グリッパ５、６、アンカー７を投擲目標位置である固定端８、９、１０にそれぞれ固定する。
【００４３】
なお、ロボット本体１の初期位置とキャスティング目標位置との間に建物等の障害物があるときは、コントローラはこうした障害物を避けた目標キャスティング軌道を演算し、この演算結果に基づいて、グリッパ５、６、アンカー７を目標３次元位置へ投擲する。
また、グリッパ等を投擲しなくても固定端に届く場合は、剛体アーム１１、１２、１３をマニピュレータとして使用して、収容箱１６から最適なエンドエフェクタを選択して装着した後、アームの伸張、旋回、関節角度を制御することにより、直接８、９、１０にそれぞれのエンドエフェクタを固定させてもよい。
【００４４】
（２）〈ロボット本体の固定〉
ロボット本体１内、あるいは外部に設けられたコントローラは、図５のように、繰出・巻取制御装置により各ワイヤの繰出量、巻取量を制御することにより、周辺及び対岸の環境、地形、さらには、ユーザが指定するロボット本体１の目標キャスティング位置・姿勢に基づいて決定した、キャスティング開始時点における初期位置、初期姿勢となるよう、ロボット本体１の位置及び姿勢の微調整を行う。
【００４５】
（３）〈各ワイヤの張力制御〉
コントローラは、まず、ロボット本体１が初期位置及び初期姿勢から、目標キャスティング位置及び着地時の目標姿勢へ到達するのに必要なエネルギを算出する。次に、ワイヤ２を繰出・巻取制御装置内に搭載された電磁ブレーキ２２によりロックし、例えば、各ワイヤ３、４をガイドする部材に設けられたひずみ計などの張力検出器の検出値に基づいて、ワイヤ３、４の繰出・巻取制御装置を用いてワイヤ３、４を巻き取ってバネのように伸ばすことによって、必要とされるエネルギに相当するよう、ワイヤ３、４の弾性エネルギを蓄積し、ロボット本体１をワイヤ２、３、４が個々の目標張力で拮抗する静止状態を維持しながら、ロボット本体１のキャスティング準備を整える。
なお、例えば、ワイヤ３、４のバネ定数が等しい場合は、ワイヤ３に蓄積する弾性エネルギをワイヤ４より大きくすることにより、ロボット本体１のキャスティング時の方向を右側に向けるなど、ワイヤ３、４に蓄積する弾性エネルギに差を付けることにより、キャスティング開始時のキャスティング力ベクトルを調節することができる。
【００４６】
（４）〈ロボット本体のキャスティング〉
コントローラは、ワイヤ２をロックしている電磁ブレーキ２２に対しロック解除の指令出力し、かつワイヤ２の張力が零となるように繰出・巻取制御装置に対して繰り出しの指令を与えると、ワイヤ２、３、４の張力拮抗状態が崩れ、ワイヤ３及びワイヤ４の張力の和となる３次元力ベクトルがロボット本体１の重心に作用する。
そして、張力により剛体アーム１２、１３の先端にかかる３次元力ベクトルと、ロボット本体１の重心から各アームの先端までの位置ベクトルとの外積で求まる３次元モーメントベクトルの和がロボット本体１の重心を通る軸回りに作用する。これらの３次元力ベクトル及び３次元モーメントベクトルにより表されるロボット本体１の並進運動及び回転運動に関する運動方程式より、ロボット本体１のキャスティング初期の３次元空間における加速度ベクトルが定まり、図６に示されるように、目標位置に向けてのロボット本体１のキャスティングが開始される。
【００４７】
（５）〈ロボット本体の３次元空間での運動制御及び姿勢制御〉
ロボット本体１がキャスティングされた後、ワイヤ２、３及び４の巻取量、繰出量を制御することにより、３次元空間において、キャスティング中の運動制御、姿勢制御が行われる。
キャスティング初期は、ワイヤ２、３、４の各繰出・巻取制御装置は、コントローラからの指令に応じて、駆動モータ２３の回転方向、回転数、出力トルクを制御するとともに、ベルト張力測定器２５の検出値に基づいて、タイミングベルト２６を介して回転ドラム２１に伝達されるトルクを制御したり、さらには、電磁クラッチ２４を解放して回転ドラム２１を自由回転させたり、電磁ブレーキ２２を作動させることにより、各ワイヤ２、３及び張力を独立して目標張力に制御し、これによりロボット本体１の並進方向や回転方向を制御する。
【００４８】
ロボット本体１の３次元空間飛行中は、例えば、ワイヤ３の繰出・巻取制御装置により、ワイヤ張力が増加するように繰出量を減少させたり、巻き取りを開始すると、ロボット本体１のキャスティング方向は進行方向に向かって右側に進み、逆に、ワイヤ４の繰出・巻取制御装置により、ワイヤ張力が増加するように繰出量を減少させたり、巻き取りを開始すると、ロボット本体１のキャスティング方向は進行方向に向かって左側に進むことになり、キャスティング方向を制御することができる。
【００４９】
また、ロボット本体１が目標位置に近づくと、ワイヤ２、３、４の各繰出・巻取制御装置を用いて、回転ドラム２１に伝達されるトルクを徐々に減少させたり、ロボット本体１に内蔵された加速度計やジャイロ等の検出値あるいは各固定端８、９、１０に設定した座標系からみた各ワイヤの角度とその長さから推定されるロボット本体１の位置・姿勢に基づいて、ワイヤ２、３、４の各繰出・巻取制御装置を連携させて、張力に基づくフィードバック制御を行うことにより、ロボット本体１を目標位置・姿勢に制御することができる。
【００５０】
地上など重力が作用する場で使用する際は、キャスティング目標位置周辺の上方の固定端を利用して、剛体アーム１７の投擲機構により別途グリッパあるいはアンカーを先端に備えたワイヤを、その固定端に予め投擲して固定しておき、ロボット本体１がキャスティング目標位置に着地する際の衝撃を緩和するために、着地前にこのワイヤの繰出量を減少させたり、巻き取ることにより、上方向の張力を与え続けることによってロボット本体１を下方向に減速させる協調制御をするようにしてもよい。
また、図１０に示すように、ロボット本体１のキャスティング目標位置を、ロボット本体１の地上における目標固定端の上方に設定し、ロボット本体１がこの目標位置に到達した瞬間に、コントローラが、ロボット本体１に内蔵したパラシュートを作動させて落下速度を抑制し、その間、各ワイヤ２、３、４の繰出量や巻取量を微調整して、ロボット本体１を、目標固定端に固定することもできる。
【００５１】
さらに、以下のように、予め鉄球を目標到達位置の上方に投擲しておき、その慣性を利用して落下速度を緩和することができる。
（１）まず、図１１の上図のように剛体アーム１７を用いてロボット本体１の重心にワイヤで結合された質点（鉄球）２８を投擲する。
（２）その後、すぐにロボット本体１を目標位置へキャスティングする。
（３）ロボット本体１が、目標到達位置に到達するまで、上記の実施例と同様に、ワイヤ２〜４の張力を制御することにより、この間の運動制御に影響を与えないようにした上で、図１１の下図のように、ロボットが飛んでいる間は、ロボット本体１の重心と鉄球２８を結ぶワイヤは緩んだ状態になるように、ワイヤ２９用の繰出・巻取制御機構によりワイヤ２９を繰り出しておく。
（４）ロボット本体１が目標到達位置へ到達したとき、ロボット本体１の重心と鉄球２８を結ぶワイヤ２９の張力と、少なくともワイヤ２、３、４のいずれか１本の張力が瞬間的に正となるように、各ワイヤの長さを繰出・巻取制御機構により制御する。あるいは、すべての各ワイヤの運動を電磁ブレーキ等により同時に拘束してもよい。
なお、上記（１）で鉄球２８を投擲する際、ロボット本体１が目標到達位置へ到達した時点で、鉄球の速度が、鉛直方向上向きに所定の速度ベクトル成分を有するように、上記（１）での鉄球２８の投擲角度、投擲速度が予め設定されている。
（５）ここで、ロボット本体１は、目標固定位置１５に向けて落下を開始するが、例えば、各ワイヤを拘束した場合、ロボット本体１の慣性により、ワイヤ２、３、４には、図１１の下図に示されるように、ロボット本体１から見ると斜め左上向きの張力が発生し、また、ワイヤ２９には、ロボット本体１ならびに鉛直方向上向きの速度ベクトル成分を有する鉄球２８の慣性により、ロボット本体１から見ると斜め右上向きの張力が発生する。
【００５２】
これにより、ワイヤ２、３、４の張力の水平方向成分は、ワイヤ２９の張力の水平方向成分により緩和されるとともに、ワイヤ２、３、４及びワイヤ２９の張力の上向き方向の合力が、重力加速度を緩和させるので、ロボット本体１が目標点へ到達するときの衝撃を緩和することが可能となる。なお、ロボット本体１が目標到達位置に到達したときのワイヤ２、３、４、及びワイヤ２９の相対位置関係ならびに、そのときのロボット本体１及び鉄球２８の運動量などを調べれば、ワイヤ２、３、４の１本あるいは２本のみを拘束すればよい場合もあることが分かる。
【００５３】
このような鉄球により重力加速度を緩和する際は、図１１に示されるように、ロボット本体１に、鉄球２８を先端に備えたワイヤ２９の末端を結合した回転ドラム、この鉄球２８を所定の投擲方向と投擲速度で投擲する鉄球投擲用投擲装置及び回転ドラムから繰り出されるワイヤを拘束する電磁ブレーキを別途設ける。
そして、コントローラにより鉄球２８の投擲方向と投擲速度を演算して、鉄球投擲用投擲装置を制御するとともに、ロボット本体１が目標位置へ到達したとき、電磁ブレーキに作動させて、ワイヤ２９を拘束するようにすればよい。
【００５４】
一方、無重力空間では、キャスティング初期の速度ベクトルが維持されることから、目標到達位置付近に、別途グリッパあるいはアンカーを備えたワイヤを前記のように固定し、ロボット本体の着地時の運動を制御するようにするとよい。
【００５５】
このように、本発明の実施例によれば、固定端に固定されたグリッパ６、アンカー７を結ぶ線（図５では固定端９と１０を結ぶ点線）を越えて、ロボット本体１をキャスティング目標位置・姿勢に正確にキャスティングすることができ、さらに、衝撃緩和制御を加えれば、着地時にロボット本体１を安定に正立させたり、損傷を防止したりすることができる。また、同様の方法により、固定端８、９、１０で囲まれた張力拮抗状態で移動可能な領域を越えて、ロボット本体１の到達可能領域を様々な方向に拡大することができる。
【００５６】
次に、キャスティングを行う環境や、ロボット本体１の目標キャスティング位置に応じた、本発明の具体例を説明する。
〈ロボット本体に、遠方の見えない場所に設置された固定バーを把持させる例〉
図７に示されるように、ロボット本体１は、右側の低い宇宙建造物の壁面等に置かれており、このロボット本体１の剛体アーム１７により、左側の高い建物等に設置された固定バー１５を把持させる場合、まず、右側の低位置において、ワイヤ２、３、４により、パラレルワイヤ構造を形成し、上述のとおり、各ワイヤ２、３、４をそれぞれの繰出・巻取制御装置により、固定バー１５に向けた目標キャスティング位置・姿勢に基づいて、各ワイヤの張力を調整する。
【００５７】
なお、ロボット本体１に対する固定バー１５の相対位置を測定するために、予め、カメラや、視覚センサあるいはレーザレンジセンサなどの計測器を備えた視覚システム１８を、剛体アーム１７に設けられた投擲装置により投擲されるグリッパ１９で把持させ、これを固定バー１５周辺の適切な場所に投擲し、図７の右上の枠内の図のように、剛体アーム１７とグリッパ１９とを結ぶワイヤを繰り出して、視覚システム１８を固定バー１５周辺の適切な場所に設置する。そして、視覚システム１８設置後、グリッパ１９から視覚システム１８を離した後、剛体アーム１７の引き動作と、ワイヤの巻き取りによりグリッパ１９を元の剛体アーム１７の先端位置へ戻しておく。
このようにして設置された視覚システム１８により、目標とする固定バー１５の位置を検出し、その検出結果に基づいてロボット本体１のキャスティング軌道を演算し、ロボット本体１を目標固定バー１５へ向けてキャスティングし、ワイヤ２、３、４の各繰出・巻取制御装置を連携制御して、ロボット本体１の３次元空間での運動を制御することにより、確実に固定バー１５を把持させることができる。
【００５８】
〈ロボット本体に、障害物裏側の目標位置にキャスティングさせる例〉
図８にみられるように、宇宙空間において左側の低い宇宙建造物にあるロボットを右側の高い宇宙建造物裏側の破損部に到達させる場合、ロボット本体１を破損部に直接キャスティングすることは不可能である。そこで、右側の宇宙建造物裏側上端面を基点に、ロボット本体１の進行方向を変えて、高い建物の宇宙建造物を回り込ませるようにして建物裏側の破損部に到達させるようにすればよい。
【産業上の利用可能性】
【００５９】
以上説明したとおり、本発明のロボット本体のキャスティング方法及び装置によれば、これまで、到達が困難な環境であっても、ロボット本体を正確に移動させることができ、災害救助や宇宙空間の作業等に広く応用することが可能になる。
【符号の説明】
【００６０】
１ ロボット本体
２、３、４ ワイヤ
５、６、１４、１９ グリッパ
７ アンカー
８、９、１０ 固定端
１５ 目標とする固定バー
１１、１２、１３、１７ 剛体アーム
１６ 収納箱
１８ 視覚システム
２１ 回転ドラム
２２ 電磁ブレーキ
２３ 駆動モータ
２４ 電磁クラッチ
２５ ベルト張力測定器
２６ タイミングベルト
２７ 投擲レバー
２８ 鉄球
２９ 先端に鉄球が固定されたワイヤ
【技術分野】
【０００１】
宇宙開発や、土木・建築現場、災害救助・復旧支援、地質調査、海底・湖底開発、爆発物の処理等で使用する機材等を備え、かつロボットから伸展可能なワイヤ並びに把持部材（グリッパ等）を介して環境との結合が可能なロボットをキャスティングによって目標位置に移動させる方法とその装置に関する。
【背景技術】
【０００２】
下記特許文献１にみられるように、大型宇宙構造物の建設保守を想定して、作業を行うロボットに伸展式のアームを設け、このアームを用いて複数のテザー式のアームの構造物への把持位置を変更することにより、構造物上の移動を可能にするシステムが提案されている。
【０００３】
下記特許文献２では、線状柔軟リンクの先端に備えたグリッパを、剛体アームにより所望の箇所に投擲して、環境に固定されたバーをグリッパにより把持させた上で、線状柔軟リンクの巻き取りと剛体アームの運動を協調させることにより、ロボット本体を所定の位置に移動させるシステムが提案されている。
【０００４】
また、下記非特許文献１では、線路や道路を通すため、山の斜面を削って法面（斜面）を安全に形成するシステムとして、下記非特許文献１にみられるように、予め急斜面の最上面に２箇所のアンカーを設置し、このアンカーに固定された２本のワイヤでロボットを支持し、各ロープに作用する張力を制御することにより、ロープが常に張った状態でロボットを所定の位置に移動させるようなシステムが開発されている。
【０００５】
なお、下記特許文献３には、ロボットアームに接続される把持部材を、慣性力、遠心力を利用して投擲するとともに、並進・回転制御用に線状柔軟リンク（ワイヤ）の張力によって、把持部材を目標位置に制御する技術が示されている。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２００８−２６０４３６号公報
【特許文献２】特開２００７−１３６６０１号公報
【特許文献３】特許４００６５２８号公報
【非特許文献】
【０００７】
【非特許文献１】足歩行型法面作業ロボットＴＩＴＡＮ ＸＩの開発−基本設計と脚機構の動作実験−、程島 竜一・土居 隆宏・福田 靖・広瀬 茂男・岡本 俊仁・森 純一、日本ロボット学会誌、２３．７．８１−９１（２００５）
【発明の概要】
【発明が解決しようとする課題】
【０００８】
上記先行技術によれば、無重力の宇宙空間や、急斜面において、テザーやロープを張った状態でロボットを目標位置に移動させることができる。
しかしながら、上記特許文献１のものでは、宇宙構造物の外壁にある固定バーにフックをかける際、剛体の伸展式アームを用いていることから、長いアームを搭載する場合、ロボット運搬機での占有空間や搬送重量の増加を招き、装置搬送のコストが増加する問題やアーム操作時のエネルギ消費が高くなる問題が生ずる。
また、伸展式アームの伸展方法はＳＴＥＭ機構や自動車のアンテナ機構と同様の一直線方向の並進運動を想定しているため、図１に示すようにアームの根元から目標の固定バーまでの間に、壁などの障害物がある場合、これを迂回して固定バーにフックを掛けることは非常に困難である。仮に、伸展式アームとして回転関節を含む多関節駆動系アームを用いれば、アームを屈曲させることにより障害物を回避してアームを伸展させることが可能になると考えられるが、アームの重量や慣性モーメントが増加するため、消費エネルギの増加に加え、アームの制震制御が困難となる問題が生ずる。
【０００９】
一方、剛体の伸展式アームが短い場合、アームの届く範囲が狭いため、図２に示すようにハンドが固定バーに届くように外壁に短い距離間隔で多数の固定バーを密に設置しなければならない。
そのため設置費用がかかるうえに、移動時にフックをかける作業の頻度が高くなり、作業効率が低下するという問題がある。すなわち、テザー張力が拮抗する状態で広い可動領域を確保するには、領域の各頂点がお互いに遠い位置になければならないが、そのためには各頂点へ短いアームでフックを掛けながらロボットが移動していく必要があり、広い可動領域の確保に時間を要することになる。
【００１０】
また、図３に示すように構造物の外壁にアームの長さより幅のある深い溝がある場合、ロボットはその溝を飛び越えて移動することはできず、溝の側面に沿って設置した固定バーにフックをかけながら溝の底へ下りて、再び他方の側面に沿って上る必要があるため、移動に時間がかかるうえに、移動距離が長くなり、消費エネルギが高くなる問題がある。
さらに、ロボットが宇宙構造物に接していない初期状態では、短いアームを用いてフックを固定バーに掛けるには構造物の外壁に十分に近づく必要があり、スラスタなどの別の移動装置と衝突を防ぐための制御装置等が新たに必要となるという問題がある。
【００１１】
また、上記特許文献３のものでは、ロボット本体の位置を変えずにグリッパを固定バーの方向に投擲して把持させるが、一般的に固定バーの位置が遠方であるほど投擲誤差が拡大するので、固定バーを把持する精度は下がる。また、ロボットの移動範囲が、グリッパの把持位置までに制限されてしまうという問題点がある。
【００１２】
上記非特許文献１のものでは、あくまでも、急斜面の最上面に２箇所のアンカーを設置することが前提であり、アンカーが設置できないような急斜面での移動は不可能であり、また、アンカーが設置されたとしても、移動はアンカーの設置箇所から下ろした鉛直線の間の範囲に制限されてしまうという問題がある。
【課題を解決するための手段】
【００１３】
そこで、上記の課題を解決するため、本発明では、剛体の伸展式アームの代わりに、剛体アームの先からエンドエフェクタ（グリッパ、アンカー、フックなど）までを繋ぐ軽量で柔軟なワイヤを備え、該ワイヤの繰出量によって該ワイヤの長さを自在に変えることが可能な複数個のアームを用いて、ロボット本体をキャスティングし、環境との結合点で囲まれた領域を越えて目標点へロボットを移動させる。より具体的には、本発明のロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング方法は、
（１）ロボット本体を初期設置位置に配備する工程と、該初期設置位置と、ロボット本体の前記目標到達位置の３次元座標とに基づいて、少なくとも３カ所の目標固定位置を決定し、ワイヤの先端に設けられたグリッパあるいはアンカーなどのエンドエフェクタをそれぞれの目標固定位置に固定し、ロボット本体と目標固定位置との間をそれぞれワイヤで連結する工程と、前記初期設置位置と、前記グリッパあるいはアンカーの固定位置と、前記目標到達位置とに基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算する工程と、各ワイヤの繰出量、巻取量を制御して、前記ロボット本体を、前記キャスティング開始時点における位置及び姿勢に調整する工程と、前記目標キャスティング軌道に基づいて、前記ワイヤのうち、少なくとも２本のワイヤに蓄積される弾性エネルギをそれぞれの目標値に制御することにより、すべてのワイヤの張力拮抗状態において、前記ロボット本体の初期キャスティング力ベクトルを決定する工程と、前記張力拮抗状態にあるワイヤのうち、蓄積される弾性エネルギを前記目標値に制御したワイヤ以外のワイヤの固定を解除し、前記初期キャスティング力ベクトルにより、前記ロボット本体を３次元空間にキャスティングする工程と、前記ロボット本体の３次元空間での運動を、各ワイヤの繰出量、巻取量、あるいは張力を別個に制御することにより、前記ロボット本体を前記目標到達位置に到達させる工程とから構成される。
【００１４】
（２）上記ロボット本体のキャスティング方法は、前記決定された目標固定位置の３次元位置に基づいて、前記エンドエフェクタの目標投擲位置及び目標投擲軌道を演算し、該エンドエフェクタを、投擲機構により投擲することにより、それぞれの目標固定位置に固定する工程を具備してもよい。
【００１５】
（３）上記ロボット本体のキャスティング方法は、前記エンドエフェクタの目標固定位置に、前記ロボット本体の目標到達位置の上方位置を付加し、前記ロボット本体が目標到達位置に着地させる際の重力による衝撃を緩和させる工程を具備してもよい。
【００１６】
（４）また、上記ロボット本体のキャスティング方法は、前記目標到達位置を、前記ロボット本体の目標着地位置の上方に設定し、前記ロボット本体がキャスティングにより該目標到達位置に到達したとき、前記ロボット本体に内蔵したパラシュートを開き、前記ロボット本体が目標着地位置に着地させる際の重力による衝撃を緩和させる工程を具備してもよい。
【００１７】
（５）また、上記ロボット本体のキャスティング方法は、前記ロボット本体を３次元空間にキャスティングする工程に先だって、ワイヤ付き鉄球を該目標到達位置より上方に向けて投擲し、前記ロボット本体が該目標到達位置に到達したとき、該鉄球が鉛直方向上向きに所定の速度ベクトル成分を有するようにするとともに、該鉄球が先端に接続されたワイヤを拘束し、前記目標固定位置に固定されたワイヤの少なくとも一本を拘束することにより、各ワイヤに作用する張力の合力が鉛直方向上向きの成分を有するようにすることによって、前記ロボット本体に作用する重力加速度を相殺し、目標着地位置に着地させる際の重力による衝撃を緩和させる工程を具備してもよい。
【００１８】
また、上記のロボット本体のキャスティング方法を実現するため、本発明のロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング装置は、
（６）先端にグリッパあるいはアンカーなどのエンドエフェクタを備えた少なくとも３本のワイヤと、該ワイヤのそれぞれに対応してロボット本体に設置され、各ワイヤの末端が結合された回転ドラムと、該回転ドラムのワイヤ繰出量及び巻取量を制御する駆動モータ、電磁ブレーキ、電磁クラッチとからなる繰出・巻取制御装置と、前記ロボット本体の初期設置位置、前記エンドエフェクタの固定位置及び前記ロボット本体の目標到達位置に基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算するとともに、該演算結果に基づいて、前記繰出・巻取制御装置を介して前記回転ドラムのワイヤ繰出量及び巻取量並びに各ワイヤに蓄積される弾性エネルギを制御するコントローラとを具備している。
【００１９】
（７）上記ロボット本体のキャスティング装置は、前記ロボット本体のフレームの少なくとも３カ所に、軸線方向の伸縮量、軸線周りの旋回量及び複数の関節角度を制御し得る剛体アームが設置され、該剛体アームのそれぞれは、前記繰出・巻取制御装置及び前記エンドエフェクタを前記固定位置に投擲する投擲機構を具備し、前記コントローラからの指令に応じて、前記エンドエフェクタの投擲開始位置及び投擲方向を制御するとともに、マニピュレータ機能を具備してもよい。
【００２０】
（８）前記投擲機構は、ワイヤが巻回される回転ドラム、該回転ドラムを駆動する駆動モータ、該回転ドラムを制動する電磁ブレーキ、前記駆動モータから前記回転ドラムに伝達されるトルクを制御するとともにドラムを自由に回転させる電磁クラッチ及びワイヤの運動を拘束あるいは解放する電磁ブレーキを具備してもよい。
【００２１】
（９）さらに、前記ロボット本体は、前記コントローラにより作動されるパラシュートを内蔵していてもよい。
【００２２】
（１０）また、前記ロボット本体は、鉄球と、該鉄球を予め設定された方向に投擲する投擲機構と、該鉄球を先端に備えたワイヤの末端が結合された回転ドラムと、該ワイヤを拘束する電磁ブレーキとをさらに備え、前記コントローラにより前記鉄球の投擲方向と投擲速度を制御するとともに、所定のタイミングで前記電磁ブレーキを作動させて該ワイヤを拘束するようにしてもよい。
【発明の効果】
【００２３】
本発明のロボット本体のキャスティング方法、及びこれを実現するキャスティング装置によれば、これまで車輪などの移動機構や伸展式アームでは到達が困難であった環境でも、ワイヤの固定位置で囲まれた領域を越えて、ロボット本体を予め演算された３次元空間内の目標軌道に沿ってキャスティングし、正確に目標位置に到達させるとともに、ロボット本体を目標姿勢で着地させることが可能になる。
【図面の簡単な説明】
【００２４】
【図１】アンテナ式に進展する剛体アームを使用した従来技術を示す図である。
【図２】短い剛体アームを使用した従来技術を示す図である。
【図３】アンテナ式に進展する剛体アームを使用した従来技術において、剛体アームの長さより幅のある深い溝がある場合の移動ルートを示す図である。
【図４】本発明によりロボット本体を対岸にキャスティングさせる際の動作を示す図である。
【図５】キャスティング準備のための張力拮抗状態を示す図である。
【図６】ロボット本体を目標位置に到達させるための方向制御を示す図である。
【図７】遠方の見えない場所へキャスティングする例を示す図である。
【図８】裏側の破損部を検査し修復するため、回り込んでキャスティングする例を示す図である。
【図９】ロボット本体の主要部を示す図である。
【図１０】地上の目標固定端の上方でロボット本体に内蔵したパラシュートを作動させた状態を示す図である。
【図１１】ワイヤ付き鉄球を投擲して、ロボット本体の落下速度を緩和させた状態を示す図である。
【発明を実施するための形態】
【００２５】
以下、図面を参照しつつ本発明の実施例について説明する。
【実施例】
【００２６】
図４は、ロボット本体１を対岸にキャスティング移動させる場合を示している。
ロボット本体１は、初期位置に所定の姿勢で設置され、その四隅に設けられた剛体アーム１１、１２、１３、１７は、ワイヤの先端に取り付けられたグリッパ５、６やアンカー（突き刺し機構）７を投擲する投擲機構を有している。この投擲装置については後述するが、上記特許文献３に示されているような、ワイヤ２、３、４の先端に連結されているグリッパ５、６あるいはアンカー７に回転運動や並進運動を与え、ワイヤの張力によって空中における回転運動や並進運動を制御する装置を用いて、木や岩などの環境の固定端８、９、１０に向けて正確に投擲するものである。
なお、この実施例では、後述するように剛体アーム１１、１２、１３、１７にマニピュレータ機能を具備させているが、ロボット本体１に、目標とする着地位置で必要とされる作業を実行するための種々のマニピュレータやカメラ等を搭載してもよい。
【００２７】
まず、剛体アーム１１、１２、１３の投擲機能を使用して、ワイヤ２、３、４の先端に装着されたグリッパ５、６、アンカー７を目標とする固定端８、９、１０にキャスティングし、図５に示すように各固定端８、９及び固定端１０に固定し、ワイヤ２、３、４により、パラレルワイヤ構造を形成する。
なお、固定端８、９、１０がアクセス可能な位置にある場合は、剛体アーム１１、１２、１３、１７のマニピュレータ機能を使用して固定してもよいし、作業員がワイヤ２、３、４を引き延ばして、手動で環境の固定端８、９、１０に固定してもよい。
【００２８】
この実施例では、各ワイヤ３、４は、弾性的に伸縮し得る素材で形成されており、ロボット本体１側に設けたコントローラ及び各剛体アーム１１、１２、１３に個別に設けられた投擲機構の繰出・巻取制御装置により、独立してワイヤ２、３、４の繰出量、巻取量が制御されるようになっている。
なお、図５では、アンカー７に換え、グリッパ１４で固定端１０に結合された状態を示している。
【００２９】
グリッパ５、６及びアンカー７が環境にある固定端８、９、１０に固定されると、ロボット本体１あるいは外部に設置されたコントローラにより、ワイヤ２、３、４を、各投擲機構の繰出・巻取制御装置を介して巻き取り、あるいは繰り出すことによって、ロボット本体１を投擲可能な位置に移動させる。
繰出・巻取制御装置のそれぞれは、図９に示されるように、ワイヤ２、３、４の基端が連結されるとともに、これらの巻き取り、繰り出しを行う回転ドラム２１、この回転ドラム２１を駆動する駆動モータ２３、この回転ドラムを制動する電磁ブレーキ（図示せず）、ワイヤ２、３、４を瞬時にロックあるいは解放する電磁ブレーキ２２、及び回転ドラム２１と駆動モータ２３とを切り離し、ドラムを自由に回転させる電磁クラッチ２４などから構成されている。
なお、駆動モータ２３の出力軸は、電磁クラッチ２４、タイミングベルト２６を介して回転ドラム２１に連結されており、コントローラには、このタイミングベルト２６の張力を測定するベルト張力測定器２５の検出値とともに、ワイヤ２、３、４をガイドするローラにそれぞれ設けられた張力検出器の検出値が入力されるようになっている。
【００３０】
コントローラは、駆動モータ２３の出力、電磁ブレーキ２２のオンオフ、電磁クラッチ２４の伝達トルクを制御するとともに、ベルト張力測定器２５の出力に基づいて、駆動モータ２３から回転ドラム２１に伝達されるトルクを目標値にフィードバック制御することにより、各ワイヤ２、３、４の巻取量、繰出量及び張力をそれぞれ独立して制御し、キャスティング開始時のロボット本体１の初期位置及び初期姿勢を微調整することができる。
【００３１】
次に、ワイヤ２を繰出・巻取制御装置内に搭載された電磁ブレーキ２２によりロックし、ワイヤ３、４の繰出・巻取制御装置が、ワイヤ３、４を巻き取ってバネのように伸ばし、ワイヤ２、３、４のそれぞれに個別の目標張力を発生させて、図５に示すようにロボット本体１をワイヤ張力が拮抗する静止状態にする。ここで、固定端８、９、１０で形成される三角形内部の範囲が、張力拮抗状態となり得る可動領域となる。
【００３２】
なお、この実施例では、ワイヤ２にはあまり伸縮しない高バネ係数の素材を使用し、ワイヤ３、４には、所定の伸縮ストロークが確保できるよう、低バネ係数の素材を使用するが、すべてのワイヤ２、３、４に、高バネ係数の素材を使用し、ワイヤ３、４に、本発明者が上記特許文献２で提案した、スライダ上に設置された電磁ブレーキによりワイヤ３、４にロックすることにより、一端が投擲レバー側に、他端がスライダ側に固定されたスプリングを伸張させて、所定の伸縮ストロークが確保されるようにしてもよい。
【００３３】
なお、環境との結合機能を有するグリッパ５、６やアンカー７、あるいはフック等のエンドエフェクタはロボット本体１にある収納箱１６に収納されており、各剛体アーム１１、１２、１３，１７は、そのアーム先端を収納箱１６に伸ばし、周囲の環境に応じてグリッパ５、６やアンカー７等のエンドエフェクタを選択した上で着脱できるようになっている。
【００３４】
図５の状態では、ロボット本体１には、各ワイヤ２、３、４の目標張力が作用しており、これらの張力の合力は釣り合いの状態になる。
次に、この静止状態において、剛体アーム１１の投擲装置に設けられた繰出・巻取制御装置内の電磁ブレーキ２２を解放することによりワイヤ２のロックを解除して、ワイヤ２をその張力が零の状態になるように繰り出せば、合力の釣り合い状態が崩れ、ワイヤ３、４の張力の合力がロボット本体の重心にかかる並進力並びにその重心を通る軸まわりの回転力として作用し、図６に示されるように、ロボット本体１はグリッパ６とアンカー７の間を通る方向へ加速され、ロボット本体１が空間にキャスティングされることになる。
【００３５】
ロボット本体１が空間にキャスティングされてからの３次元空間における運動の制御は、それぞれの繰出・巻取制御装置によりワイヤ２、３、４の繰出量、巻取量を調整して、各ワイヤの張力を制御することにより行う。
【００３６】
図９はロボット本体１の主要部を示すもので、Ｙ型のフレームを２つ組み合わせ、各端部に剛体アーム１１、１２、１３、１７が配置され、その中央部に収納箱１６が設置されている。各剛体アーム１１、１２、１３、１７は、マニピュレータ機能を具備させるため、コントローラからの指令に応じて、軸線方向の伸縮量、軸線周りの旋回量とともに、複数の関節角度を制御できるようになっている。
【００３７】
各剛体アーム１１、１２、１３、１７の先端には、モータにより回転駆動される投擲レバー２７が設けられ、コントローラからの指令により、各剛体アームの伸縮長さ、軸方向の回転角及び各関節の回転角を調整した後、投擲レバー２７を駆動するモータが目標回転速度に達したとき、所定の投擲角度で投擲機構の電磁クラッチを解放し、所定の初速度、所定の投擲角度で、グリッパ５、６やアンカー７などのエンドエフェクタを、目標軌道に沿って目標固定位置に投擲するようになっている。
また、収納箱１６には、各種エンドエフェクタが収納され、その側部空間に剛体アーム１１、１２、１３、１７、あるいは各種作業用のマニピュレータ、カメラ、コントローラなどが収容される。
【００３８】
以下、具体的なキャスティングについて説明する。
（１）〈グリッパ、アンカーのキャスティング〉
ロボット本体１に設けられたカメラからの画像あるいは環境に設置したカメラからの画像を用いて、ユーザがグリッパ５、６で固定する固定端８、９、１０の３次元位置を決め、画像を表示する画面上において、各固定端８、９、１０との結合位置をロボットに与え、投擲の指示を送る。
【００３９】
なお、固定端周辺の暗さや霧などの影響や地形や障害物の状態などによって、カメラ画像の解像度が十分得られず、固定端の位置を正確に計測できない場合は、カメラ画像から推定されるおおよその位置データをもとに、ワイヤを介して本体と繋がったワイヤ付き鉄球などの破損しにくいエンドエフェクタを剛体アームにより固定端周辺へ投擲する。
このワイヤ付き鉄球が固定端周辺に着地して静止したら、該ワイヤ付き鉄球とロボット本体を繋ぐワイヤを巻き取って、該ワイヤ付き鉄球が動かず、かつワイヤが伸びない程度にワイヤを張った状態にし、そのときのワイヤの繰り出し長さとロボット本体１からみたワイヤの方向ベクトルを計測することにより、ロボット本体１からみた該ワイヤ付き鉄球の位置を算出することができ、着地点に到るまでの軌跡の良否を確認するとともに、ロボット本体１の初期設置位置からみた固定端の位置を推測することができる。
【００４０】
そして、この鉄球に内蔵したライトにより固定端周辺の照明を行い、カメラ画像の解像度を上げ、固定端の位置を正確に測定できるようにしたり、あるいは、鉄球自体にもカメラを設けて、算出した鉄球の位置からの固定端の位置を算出する。
また、これによっても、固定端の測定が困難な場合には、その後、ワイヤを巻き取って該ワイヤ付き鉄球をロボット本体へ回収して、さらに、固定端周辺の他の場所へ再度、投擲し、固定端の測定が可能となるまでこれを繰り返せばよい。
【００４１】
さらに、正確に固定端周辺の計測する必要がある場合は、複数のワイヤ付き鉄球を同時にそれぞれ固定端周辺の別の場所へ投擲することによって、固定端周辺の複数の場所に着地したワイヤ付き鉄球の各位置を上記の方法によりそれぞれ算出する。
これにより、固定端周辺の複数の位置を正確に算出できるので、固定端の位置をカメラ画像により確認し、あるいは、固定端周辺の鉄球の位置データと、各鉄球からの固定端の位置データに基づいて、固定端の位置を高精度に推定することができる。
【００４２】
次に、ロボット本体１内、あるいは外部に設けられたコントローラは、視覚センサあるいはレーザレンジセンサなどの計測器を用いてユーザが指示した固定端の実際の位置を測定し、ロボット本体１の現在位置から各固定端との結合位置までの相対位置を演算し、その結果に基づいて、グリッパ５、６、アンカー７の目標投擲軌道及び目標投擲位置を演算し、各剛体アーム１１、１２、１３の先端に設けられた投擲機構を利用して各目標位置に投擲し、グリッパ５、６、アンカー７を投擲目標位置である固定端８、９、１０にそれぞれ固定する。
【００４３】
なお、ロボット本体１の初期位置とキャスティング目標位置との間に建物等の障害物があるときは、コントローラはこうした障害物を避けた目標キャスティング軌道を演算し、この演算結果に基づいて、グリッパ５、６、アンカー７を目標３次元位置へ投擲する。
また、グリッパ等を投擲しなくても固定端に届く場合は、剛体アーム１１、１２、１３をマニピュレータとして使用して、収容箱１６から最適なエンドエフェクタを選択して装着した後、アームの伸張、旋回、関節角度を制御することにより、直接８、９、１０にそれぞれのエンドエフェクタを固定させてもよい。
【００４４】
（２）〈ロボット本体の固定〉
ロボット本体１内、あるいは外部に設けられたコントローラは、図５のように、繰出・巻取制御装置により各ワイヤの繰出量、巻取量を制御することにより、周辺及び対岸の環境、地形、さらには、ユーザが指定するロボット本体１の目標キャスティング位置・姿勢に基づいて決定した、キャスティング開始時点における初期位置、初期姿勢となるよう、ロボット本体１の位置及び姿勢の微調整を行う。
【００４５】
（３）〈各ワイヤの張力制御〉
コントローラは、まず、ロボット本体１が初期位置及び初期姿勢から、目標キャスティング位置及び着地時の目標姿勢へ到達するのに必要なエネルギを算出する。次に、ワイヤ２を繰出・巻取制御装置内に搭載された電磁ブレーキ２２によりロックし、例えば、各ワイヤ３、４をガイドする部材に設けられたひずみ計などの張力検出器の検出値に基づいて、ワイヤ３、４の繰出・巻取制御装置を用いてワイヤ３、４を巻き取ってバネのように伸ばすことによって、必要とされるエネルギに相当するよう、ワイヤ３、４の弾性エネルギを蓄積し、ロボット本体１をワイヤ２、３、４が個々の目標張力で拮抗する静止状態を維持しながら、ロボット本体１のキャスティング準備を整える。
なお、例えば、ワイヤ３、４のバネ定数が等しい場合は、ワイヤ３に蓄積する弾性エネルギをワイヤ４より大きくすることにより、ロボット本体１のキャスティング時の方向を右側に向けるなど、ワイヤ３、４に蓄積する弾性エネルギに差を付けることにより、キャスティング開始時のキャスティング力ベクトルを調節することができる。
【００４６】
（４）〈ロボット本体のキャスティング〉
コントローラは、ワイヤ２をロックしている電磁ブレーキ２２に対しロック解除の指令出力し、かつワイヤ２の張力が零となるように繰出・巻取制御装置に対して繰り出しの指令を与えると、ワイヤ２、３、４の張力拮抗状態が崩れ、ワイヤ３及びワイヤ４の張力の和となる３次元力ベクトルがロボット本体１の重心に作用する。
そして、張力により剛体アーム１２、１３の先端にかかる３次元力ベクトルと、ロボット本体１の重心から各アームの先端までの位置ベクトルとの外積で求まる３次元モーメントベクトルの和がロボット本体１の重心を通る軸回りに作用する。これらの３次元力ベクトル及び３次元モーメントベクトルにより表されるロボット本体１の並進運動及び回転運動に関する運動方程式より、ロボット本体１のキャスティング初期の３次元空間における加速度ベクトルが定まり、図６に示されるように、目標位置に向けてのロボット本体１のキャスティングが開始される。
【００４７】
（５）〈ロボット本体の３次元空間での運動制御及び姿勢制御〉
ロボット本体１がキャスティングされた後、ワイヤ２、３及び４の巻取量、繰出量を制御することにより、３次元空間において、キャスティング中の運動制御、姿勢制御が行われる。
キャスティング初期は、ワイヤ２、３、４の各繰出・巻取制御装置は、コントローラからの指令に応じて、駆動モータ２３の回転方向、回転数、出力トルクを制御するとともに、ベルト張力測定器２５の検出値に基づいて、タイミングベルト２６を介して回転ドラム２１に伝達されるトルクを制御したり、さらには、電磁クラッチ２４を解放して回転ドラム２１を自由回転させたり、電磁ブレーキ２２を作動させることにより、各ワイヤ２、３及び張力を独立して目標張力に制御し、これによりロボット本体１の並進方向や回転方向を制御する。
【００４８】
ロボット本体１の３次元空間飛行中は、例えば、ワイヤ３の繰出・巻取制御装置により、ワイヤ張力が増加するように繰出量を減少させたり、巻き取りを開始すると、ロボット本体１のキャスティング方向は進行方向に向かって右側に進み、逆に、ワイヤ４の繰出・巻取制御装置により、ワイヤ張力が増加するように繰出量を減少させたり、巻き取りを開始すると、ロボット本体１のキャスティング方向は進行方向に向かって左側に進むことになり、キャスティング方向を制御することができる。
【００４９】
また、ロボット本体１が目標位置に近づくと、ワイヤ２、３、４の各繰出・巻取制御装置を用いて、回転ドラム２１に伝達されるトルクを徐々に減少させたり、ロボット本体１に内蔵された加速度計やジャイロ等の検出値あるいは各固定端８、９、１０に設定した座標系からみた各ワイヤの角度とその長さから推定されるロボット本体１の位置・姿勢に基づいて、ワイヤ２、３、４の各繰出・巻取制御装置を連携させて、張力に基づくフィードバック制御を行うことにより、ロボット本体１を目標位置・姿勢に制御することができる。
【００５０】
地上など重力が作用する場で使用する際は、キャスティング目標位置周辺の上方の固定端を利用して、剛体アーム１７の投擲機構により別途グリッパあるいはアンカーを先端に備えたワイヤを、その固定端に予め投擲して固定しておき、ロボット本体１がキャスティング目標位置に着地する際の衝撃を緩和するために、着地前にこのワイヤの繰出量を減少させたり、巻き取ることにより、上方向の張力を与え続けることによってロボット本体１を下方向に減速させる協調制御をするようにしてもよい。
また、図１０に示すように、ロボット本体１のキャスティング目標位置を、ロボット本体１の地上における目標固定端の上方に設定し、ロボット本体１がこの目標位置に到達した瞬間に、コントローラが、ロボット本体１に内蔵したパラシュートを作動させて落下速度を抑制し、その間、各ワイヤ２、３、４の繰出量や巻取量を微調整して、ロボット本体１を、目標固定端に固定することもできる。
【００５１】
さらに、以下のように、予め鉄球を目標到達位置の上方に投擲しておき、その慣性を利用して落下速度を緩和することができる。
（１）まず、図１１の上図のように剛体アーム１７を用いてロボット本体１の重心にワイヤで結合された質点（鉄球）２８を投擲する。
（２）その後、すぐにロボット本体１を目標位置へキャスティングする。
（３）ロボット本体１が、目標到達位置に到達するまで、上記の実施例と同様に、ワイヤ２〜４の張力を制御することにより、この間の運動制御に影響を与えないようにした上で、図１１の下図のように、ロボットが飛んでいる間は、ロボット本体１の重心と鉄球２８を結ぶワイヤは緩んだ状態になるように、ワイヤ２９用の繰出・巻取制御機構によりワイヤ２９を繰り出しておく。
（４）ロボット本体１が目標到達位置へ到達したとき、ロボット本体１の重心と鉄球２８を結ぶワイヤ２９の張力と、少なくともワイヤ２、３、４のいずれか１本の張力が瞬間的に正となるように、各ワイヤの長さを繰出・巻取制御機構により制御する。あるいは、すべての各ワイヤの運動を電磁ブレーキ等により同時に拘束してもよい。
なお、上記（１）で鉄球２８を投擲する際、ロボット本体１が目標到達位置へ到達した時点で、鉄球の速度が、鉛直方向上向きに所定の速度ベクトル成分を有するように、上記（１）での鉄球２８の投擲角度、投擲速度が予め設定されている。
（５）ここで、ロボット本体１は、目標固定位置１５に向けて落下を開始するが、例えば、各ワイヤを拘束した場合、ロボット本体１の慣性により、ワイヤ２、３、４には、図１１の下図に示されるように、ロボット本体１から見ると斜め左上向きの張力が発生し、また、ワイヤ２９には、ロボット本体１ならびに鉛直方向上向きの速度ベクトル成分を有する鉄球２８の慣性により、ロボット本体１から見ると斜め右上向きの張力が発生する。
【００５２】
これにより、ワイヤ２、３、４の張力の水平方向成分は、ワイヤ２９の張力の水平方向成分により緩和されるとともに、ワイヤ２、３、４及びワイヤ２９の張力の上向き方向の合力が、重力加速度を緩和させるので、ロボット本体１が目標点へ到達するときの衝撃を緩和することが可能となる。なお、ロボット本体１が目標到達位置に到達したときのワイヤ２、３、４、及びワイヤ２９の相対位置関係ならびに、そのときのロボット本体１及び鉄球２８の運動量などを調べれば、ワイヤ２、３、４の１本あるいは２本のみを拘束すればよい場合もあることが分かる。
【００５３】
このような鉄球により重力加速度を緩和する際は、図１１に示されるように、ロボット本体１に、鉄球２８を先端に備えたワイヤ２９の末端を結合した回転ドラム、この鉄球２８を所定の投擲方向と投擲速度で投擲する鉄球投擲用投擲装置及び回転ドラムから繰り出されるワイヤを拘束する電磁ブレーキを別途設ける。
そして、コントローラにより鉄球２８の投擲方向と投擲速度を演算して、鉄球投擲用投擲装置を制御するとともに、ロボット本体１が目標位置へ到達したとき、電磁ブレーキに作動させて、ワイヤ２９を拘束するようにすればよい。
【００５４】
一方、無重力空間では、キャスティング初期の速度ベクトルが維持されることから、目標到達位置付近に、別途グリッパあるいはアンカーを備えたワイヤを前記のように固定し、ロボット本体の着地時の運動を制御するようにするとよい。
【００５５】
このように、本発明の実施例によれば、固定端に固定されたグリッパ６、アンカー７を結ぶ線（図５では固定端９と１０を結ぶ点線）を越えて、ロボット本体１をキャスティング目標位置・姿勢に正確にキャスティングすることができ、さらに、衝撃緩和制御を加えれば、着地時にロボット本体１を安定に正立させたり、損傷を防止したりすることができる。また、同様の方法により、固定端８、９、１０で囲まれた張力拮抗状態で移動可能な領域を越えて、ロボット本体１の到達可能領域を様々な方向に拡大することができる。
【００５６】
次に、キャスティングを行う環境や、ロボット本体１の目標キャスティング位置に応じた、本発明の具体例を説明する。
〈ロボット本体に、遠方の見えない場所に設置された固定バーを把持させる例〉
図７に示されるように、ロボット本体１は、右側の低い宇宙建造物の壁面等に置かれており、このロボット本体１の剛体アーム１７により、左側の高い建物等に設置された固定バー１５を把持させる場合、まず、右側の低位置において、ワイヤ２、３、４により、パラレルワイヤ構造を形成し、上述のとおり、各ワイヤ２、３、４をそれぞれの繰出・巻取制御装置により、固定バー１５に向けた目標キャスティング位置・姿勢に基づいて、各ワイヤの張力を調整する。
【００５７】
なお、ロボット本体１に対する固定バー１５の相対位置を測定するために、予め、カメラや、視覚センサあるいはレーザレンジセンサなどの計測器を備えた視覚システム１８を、剛体アーム１７に設けられた投擲装置により投擲されるグリッパ１９で把持させ、これを固定バー１５周辺の適切な場所に投擲し、図７の右上の枠内の図のように、剛体アーム１７とグリッパ１９とを結ぶワイヤを繰り出して、視覚システム１８を固定バー１５周辺の適切な場所に設置する。そして、視覚システム１８設置後、グリッパ１９から視覚システム１８を離した後、剛体アーム１７の引き動作と、ワイヤの巻き取りによりグリッパ１９を元の剛体アーム１７の先端位置へ戻しておく。
このようにして設置された視覚システム１８により、目標とする固定バー１５の位置を検出し、その検出結果に基づいてロボット本体１のキャスティング軌道を演算し、ロボット本体１を目標固定バー１５へ向けてキャスティングし、ワイヤ２、３、４の各繰出・巻取制御装置を連携制御して、ロボット本体１の３次元空間での運動を制御することにより、確実に固定バー１５を把持させることができる。
【００５８】
〈ロボット本体に、障害物裏側の目標位置にキャスティングさせる例〉
図８にみられるように、宇宙空間において左側の低い宇宙建造物にあるロボットを右側の高い宇宙建造物裏側の破損部に到達させる場合、ロボット本体１を破損部に直接キャスティングすることは不可能である。そこで、右側の宇宙建造物裏側上端面を基点に、ロボット本体１の進行方向を変えて、高い建物の宇宙建造物を回り込ませるようにして建物裏側の破損部に到達させるようにすればよい。
【産業上の利用可能性】
【００５９】
以上説明したとおり、本発明のロボット本体のキャスティング方法及び装置によれば、これまで、到達が困難な環境であっても、ロボット本体を正確に移動させることができ、災害救助や宇宙空間の作業等に広く応用することが可能になる。
【符号の説明】
【００６０】
１ ロボット本体
２、３、４ ワイヤ
５、６、１４、１９ グリッパ
７ アンカー
８、９、１０ 固定端
１５ 目標とする固定バー
１１、１２、１３、１７ 剛体アーム
１６ 収納箱
１８ 視覚システム
２１ 回転ドラム
２２ 電磁ブレーキ
２３ 駆動モータ
２４ 電磁クラッチ
２５ ベルト張力測定器
２６ タイミングベルト
２７ 投擲レバー
２８ 鉄球
２９ 先端に鉄球が固定されたワイヤ
【特許請求の範囲】
【請求項１】
ロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング方法であって、
ロボット本体を初期設置位置に配備する工程と、
該初期設置位置と、ロボット本体の前記目標到達位置の３次元座標とに基づいて、少なくとも３カ所の目標固定位置を決定し、ワイヤの先端に設けられたグリッパあるいはアンカーなどのエンドエフェクタをそれぞれの目標固定位置に固定し、ロボット本体と目標固定位置との間をそれぞれワイヤで連結する工程と、
前記初期設置位置と、前記グリッパあるいはアンカーの固定位置と、前記目標到達位置とに基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算する工程と、
各ワイヤの繰出量、巻取量を制御して、前記ロボット本体を、前記キャスティング開始時点における位置及び姿勢に調整する工程と、
前記目標キャスティング軌道に基づいて、前記ワイヤのうち、少なくとも２本のワイヤに蓄積される弾性エネルギをそれぞれの目標値に制御することにより、すべてのワイヤの張力拮抗状態において、前記ロボット本体の初期キャスティング力ベクトルを決定する工程と、
前記張力拮抗状態にあるワイヤのうち、蓄積される弾性エネルギを前記目標値に制御したワイヤ以外のワイヤの固定を解除し、前記初期キャスティング力ベクトルにより、前記ロボット本体を３次元空間にキャスティングする工程と、
前記ロボット本体の３次元空間での運動を、各ワイヤの繰出量、巻取量、あるいは張力を別個に制御することにより、前記ロボット本体を前記目標到達位置に到達させる工程とからなるロボット本体のキャスティング方法。
【請求項２】
前記決定された目標固定位置の３次元位置に基づいて、前記エンドエフェクタの目標投擲位置及び目標投擲軌道を演算し、該エンドエフェクタを、投擲機構により投擲することにより、それぞれの目標固定位置に固定する工程を備えた請求項１に記載されたロボット本体のキャスティング方法。
【請求項３】
前記エンドエフェクタの目標固定位置に、前記ロボット本体の目標到達位置の上方位置を付加し、前記ロボット本体が目標到達位置に着地させる際の重力による衝撃を緩和させる工程を備えた請求項１または２に記載されたロボット本体のキャスティング方法。
【請求項４】
前記目標到達位置を、前記ロボット本体の目標着地位置の上方に設定し、前記ロボット本体がキャスティングにより該目標到達位置に到達したとき、前記ロボット本体に内蔵したパラシュートを開き、前記ロボット本体が目標着地位置に着地させる際の重力による衝撃を緩和させる工程を備えた請求項１ないし３に記載されたロボット本体のキャスティング方法。
【請求項５】
前記ロボット本体を３次元空間にキャスティングする工程に先だって、ワイヤ付き鉄球を該目標到達位置より上方に向けて投擲し、前記ロボット本体が該目標到達位置に到達したとき、該鉄球が鉛直方向上向きに所定の速度ベクトル成分を有するようにするとともに、該鉄球が先端に接続されたワイヤを拘束し、前記目標固定位置に固定されたワイヤの少なくとも一本を拘束することにより、各ワイヤに作用する張力の合力が鉛直方向上向きの成分を有するようにすることによって、前記ロボット本体に作用する重力加速度を相殺し、目標着地位置に着地させる際の重力による衝撃を緩和させる工程を備えた請求項１ないし３に記載されたロボット本体のキャスティング方法。
【請求項６】
ロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング装置であって、
先端にグリッパあるいはアンカーなどのエンドエフェクタを備えた少なくとも３本のワイヤと、
該ワイヤのそれぞれに対応してロボット本体に設置され、各ワイヤの末端が結合された回転ドラムと、該回転ドラムのワイヤ繰出量及び巻取量を制御する駆動モータ、電磁ブレーキ、電磁クラッチとからなる繰出・巻取制御装置と、
前記ロボット本体の初期設置位置、前記エンドエフェクタの固定位置及び前記ロボット本体の目標到達位置に基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算するとともに、該演算結果に基づいて、前記繰出・巻取制御装置を介して前記回転ドラムのワイヤ繰出量及び巻取量並びに各ワイヤに蓄積される弾性エネルギを制御するコントローラとからなるロボット本体のキャスティング装置。
【請求項７】
前記ロボット本体のフレームの少なくとも３カ所に、軸線方向の伸縮量、軸線周りの旋回量及び複数の関節角度を制御し得る剛体アームが設置され、該剛体アームのそれぞれは、前記繰出・巻取制御装置及び前記エンドエフェクタを前記固定位置に投擲する投擲機構を具備し、前記コントローラからの指令に応じて、前記エンドエフェクタの投擲開始位置及び投擲方向を制御するとともに、マニピュレータ機能を具備している請求項５に記載されたロボット本体のキャスティング装置。
【請求項８】
前記投擲機構は、ワイヤが巻回される回転ドラム、該回転ドラムを駆動する駆動モータ、該回転ドラムを制動する電磁ブレーキ、前記駆動モータから前記回転ドラムに伝達されるトルクを制御するとともにドラムを自由に回転させる電磁クラッチ及びワイヤの運動を拘束あるいは解放する電磁ブレーキとからなる請求項５または６に記載されたロボット本体のキャスティング装置。
【請求項９】
前記ロボット本体は、前記コントローラにより作動されるパラシュートを内蔵する請求項５ないし７に記載されたロボット本体のキャスティング装置。
【請求項１０】
前記ロボット本体は、鉄球と、該鉄球を予め設定された方向に投擲する投擲機構と、該鉄球を先端に備えたワイヤの末端が結合された回転ドラムと、該ワイヤを拘束する電磁ブレーキとをさらに備え、前記コントローラにより前記鉄球の投擲方向と投擲速度を制御するとともに、所定のタイミングで前記電磁ブレーキを作動させて該ワイヤを拘束するようにした請求項５ないし７に記載されたロボット本体のキャスティング装置。
【請求項１】
ロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング方法であって、
ロボット本体を初期設置位置に配備する工程と、
該初期設置位置と、ロボット本体の前記目標到達位置の３次元座標とに基づいて、少なくとも３カ所の目標固定位置を決定し、ワイヤの先端に設けられたグリッパあるいはアンカーなどのエンドエフェクタをそれぞれの目標固定位置に固定し、ロボット本体と目標固定位置との間をそれぞれワイヤで連結する工程と、
前記初期設置位置と、前記グリッパあるいはアンカーの固定位置と、前記目標到達位置とに基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算する工程と、
各ワイヤの繰出量、巻取量を制御して、前記ロボット本体を、前記キャスティング開始時点における位置及び姿勢に調整する工程と、
前記目標キャスティング軌道に基づいて、前記ワイヤのうち、少なくとも２本のワイヤに蓄積される弾性エネルギをそれぞれの目標値に制御することにより、すべてのワイヤの張力拮抗状態において、前記ロボット本体の初期キャスティング力ベクトルを決定する工程と、
前記張力拮抗状態にあるワイヤのうち、蓄積される弾性エネルギを前記目標値に制御したワイヤ以外のワイヤの固定を解除し、前記初期キャスティング力ベクトルにより、前記ロボット本体を３次元空間にキャスティングする工程と、
前記ロボット本体の３次元空間での運動を、各ワイヤの繰出量、巻取量、あるいは張力を別個に制御することにより、前記ロボット本体を前記目標到達位置に到達させる工程とからなるロボット本体のキャスティング方法。
【請求項２】
前記決定された目標固定位置の３次元位置に基づいて、前記エンドエフェクタの目標投擲位置及び目標投擲軌道を演算し、該エンドエフェクタを、投擲機構により投擲することにより、それぞれの目標固定位置に固定する工程を備えた請求項１に記載されたロボット本体のキャスティング方法。
【請求項３】
前記エンドエフェクタの目標固定位置に、前記ロボット本体の目標到達位置の上方位置を付加し、前記ロボット本体が目標到達位置に着地させる際の重力による衝撃を緩和させる工程を備えた請求項１または２に記載されたロボット本体のキャスティング方法。
【請求項４】
前記目標到達位置を、前記ロボット本体の目標着地位置の上方に設定し、前記ロボット本体がキャスティングにより該目標到達位置に到達したとき、前記ロボット本体に内蔵したパラシュートを開き、前記ロボット本体が目標着地位置に着地させる際の重力による衝撃を緩和させる工程を備えた請求項１ないし３に記載されたロボット本体のキャスティング方法。
【請求項５】
前記ロボット本体を３次元空間にキャスティングする工程に先だって、ワイヤ付き鉄球を該目標到達位置より上方に向けて投擲し、前記ロボット本体が該目標到達位置に到達したとき、該鉄球が鉛直方向上向きに所定の速度ベクトル成分を有するようにするとともに、該鉄球が先端に接続されたワイヤを拘束し、前記目標固定位置に固定されたワイヤの少なくとも一本を拘束することにより、各ワイヤに作用する張力の合力が鉛直方向上向きの成分を有するようにすることによって、前記ロボット本体に作用する重力加速度を相殺し、目標着地位置に着地させる際の重力による衝撃を緩和させる工程を備えた請求項１ないし３に記載されたロボット本体のキャスティング方法。
【請求項６】
ロボット本体を目標到達位置にキャスティングするロボット本体のキャスティング装置であって、
先端にグリッパあるいはアンカーなどのエンドエフェクタを備えた少なくとも３本のワイヤと、
該ワイヤのそれぞれに対応してロボット本体に設置され、各ワイヤの末端が結合された回転ドラムと、該回転ドラムのワイヤ繰出量及び巻取量を制御する駆動モータ、電磁ブレーキ、電磁クラッチとからなる繰出・巻取制御装置と、
前記ロボット本体の初期設置位置、前記エンドエフェクタの固定位置及び前記ロボット本体の目標到達位置に基づいて、前記ロボット本体のキャスティング開始時点における位置及び姿勢並びに目標キャスティング軌道を演算するとともに、該演算結果に基づいて、前記繰出・巻取制御装置を介して前記回転ドラムのワイヤ繰出量及び巻取量並びに各ワイヤに蓄積される弾性エネルギを制御するコントローラとからなるロボット本体のキャスティング装置。
【請求項７】
前記ロボット本体のフレームの少なくとも３カ所に、軸線方向の伸縮量、軸線周りの旋回量及び複数の関節角度を制御し得る剛体アームが設置され、該剛体アームのそれぞれは、前記繰出・巻取制御装置及び前記エンドエフェクタを前記固定位置に投擲する投擲機構を具備し、前記コントローラからの指令に応じて、前記エンドエフェクタの投擲開始位置及び投擲方向を制御するとともに、マニピュレータ機能を具備している請求項５に記載されたロボット本体のキャスティング装置。
【請求項８】
前記投擲機構は、ワイヤが巻回される回転ドラム、該回転ドラムを駆動する駆動モータ、該回転ドラムを制動する電磁ブレーキ、前記駆動モータから前記回転ドラムに伝達されるトルクを制御するとともにドラムを自由に回転させる電磁クラッチ及びワイヤの運動を拘束あるいは解放する電磁ブレーキとからなる請求項５または６に記載されたロボット本体のキャスティング装置。
【請求項９】
前記ロボット本体は、前記コントローラにより作動されるパラシュートを内蔵する請求項５ないし７に記載されたロボット本体のキャスティング装置。
【請求項１０】
前記ロボット本体は、鉄球と、該鉄球を予め設定された方向に投擲する投擲機構と、該鉄球を先端に備えたワイヤの末端が結合された回転ドラムと、該ワイヤを拘束する電磁ブレーキとをさらに備え、前記コントローラにより前記鉄球の投擲方向と投擲速度を制御するとともに、所定のタイミングで前記電磁ブレーキを作動させて該ワイヤを拘束するようにした請求項５ないし７に記載されたロボット本体のキャスティング装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【公開番号】特開２０１１−２５５４９０（Ｐ２０１１−２５５４９０Ａ）
【公開日】平成２３年１２月２２日（２０１１．１２．２２）
【国際特許分類】
【出願番号】特願２０１０−１６１４５０（Ｐ２０１０−１６１４５０）
【出願日】平成２２年７月１６日（２０１０．７．１６）
【出願人】（３０１０２１５３３）独立行政法人産業技術総合研究所 (6,529)
【Ｆターム（参考）】
【公開日】平成２３年１２月２２日（２０１１．１２．２２）
【国際特許分類】
【出願日】平成２２年７月１６日（２０１０．７．１６）
【出願人】（３０１０２１５３３）独立行政法人産業技術総合研究所 (6,529)
【Ｆターム（参考）】
[ Back to top ]