(57)【要約】【課題】  水中航走体自体で障害物のない浮上位置を選定できるようにする。【解決手段】  水中航走体１には、浮上位置制御器９と浮上予定位置設定記憶部１０を有する浮上位置選定装置８を設ける。水中航走体１を浮上させる場合は、浮上位置制御器９にて、浮上予定位置設定記憶部１０より浮上予定位置１１の位置情報を呼び出して、水中航走体１のソーナー７により、浮上予定位置１１と、その周辺領域１２をスキャンさせる。その結果を基に、浮上予定位置１１と周辺領域１２の水面深度の時間及び平面空間について平均処理し、浮上予定位置１１と周辺領域１２の水面深度の平均が共に深度のプラス側に振れておらず、且つ、浮上予定位置１１の水面深度の平均が、周辺領域１２の水面深度の平均よりも深度のプラス側に偏っていない場合に、浮上予定位置１１を、水中航走体１の実際の浮上位置として選定させる。【選択図】図１
2015217882.tif 000002
【特許請求の範囲】
【請求項１】
水中航走体に設けたソーナーにより、水中航走体の浮上予定位置の水面と、該浮上予定位置の周辺領域の水面をスキャンし、
浮上位置制御器による浮上位置選定処理として、
前記スキャンによる前記浮上予定位置の水面、及び、前記周辺領域の水面の検出結果を、水中航走体の位置及び姿勢の情報を基に、前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度に変換し、
次に、前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度について、時間平均処理と平面空間平均処理を行い、
次いで、前記周辺領域の水面深度の平均処理の結果が、予め深度のプラス側に設定した或る閾値よりも大となるという条件、前記浮上予定位置の水面深度の平均処理の結果が、予め深度のプラス側に設定した別の或る閾値よりも大となるという条件、及び、前記浮上予定位置の水面深度の平均処理の結果から、前記周辺領域の水面深度の平均処理の結果を引いた値が、予め設定した更に別の或る閾値よりも大となるという条件のいずれも満たさない場合に、前記浮上予定位置を、水中航走体の実際の浮上位置として選定すること
を特徴とする水中航走体の浮上位置選定方法。
【請求項２】
浮上予定位置設定記憶部に、複数の浮上予定位置を、その優先順位と共に予め設定しておき、
浮上位置制御器は、前記浮上予定位置設定記憶部に設定されている優先順位が第１位の浮上予定位置について、浮上位置選定処理を行って、周辺領域の水面深度の平均処理の結果が、予め深度のプラス側に設定した或る閾値よりも大となるという条件、浮上予定位置の水面深度の平均処理の結果が、予め深度のプラス側に設定した別の或る閾値よりも大となるという条件、又は、前記浮上予定位置の水面深度の平均処理の結果から、前記周辺領域の水面深度の平均処理の結果を引いた値が、予め設定した更に別の或る閾値よりも大となるという条件のいずれかが満たされると、該所定優先順位の浮上予定位置は、水中航走体の実際の浮上位置として不適格であると判断し、
その後、前記浮上予定位置設定記憶部に設定されている優先順位に従って順次下位の浮上予定位置を呼び出して、浮上位置選定処理を行うようにする
請求項１記載の水中航走体の浮上位置選定方法。
【請求項３】
水面をスキャンするためのソーナーを有する水中航走体に、浮上位置制御器を備え、
前記浮上位置制御器は、
前記ソーナーのスキャンによる前記浮上予定位置の水面、及び、前記周辺領域の水面の検出結果を、水中航走体の位置及び姿勢の情報を基に、前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度に変換する機能と、
前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度について、時間平均処理と平面空間平均処理を行う機能と、
前記周辺領域の水面深度の平均処理の結果が、予め深度のプラス側に設定した或る閾値よりも大となるという条件、前記浮上予定位置の水面深度の平均処理の結果が、予め深度のプラス側に設定した別の或る閾値よりも大となるという条件、及び、前記浮上予定位置の水面深度の平均処理の結果から、前記周辺領域の水面深度の平均処理の結果を引いた値が、予め設定した更に別の或る閾値よりも大となるという条件のいずれも満たさない場合に、前記浮上予定位置を、水中航走体の実際の浮上位置として選定する機能を備えるものとした構成を有すること
を特徴とする水中航走体の浮上位置選定装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、自律航走する水中航走体に、浮上に好適な浮上位置を選定させるために用いる水中航走体の浮上位置選定方法及び装置に関するものである。
【背景技術】
【０００２】
近年、海や湖沼における比較的深い領域や広範な領域の水中調査等の作業を行うための装置として、いわゆるＵＵＶ（Unmanned Underwater Vehicle）あるいはＡＵＶ（Autonomous Underwater Vehicle）と呼ばれる自律航走型の無人の水中航走体（自律型水中ロボット）が利用されるようになってきている。
【０００３】
前記自律航走型の水中航走体には、大別して、調査目標地点もしくはその地点を基準とした狭い範囲に留まって周囲の状況を調査するようにしてあるホバリング型の水中航走体と、水中を所定の航走速度で移動（航走）しながら周囲の状況を調査するようにしてあるクルージング型（巡航型）の水中航走体がある。
【０００４】
これらの水中航走体は、通常、支援船（母船）より水面に投入された状態から自律航走による潜航を開始して、水中航走を行うようにしてあり、予め設定されている所定の目的を達成するか、又は、或る時間経過すると、水面へ浮上するようにしてある。
【０００５】
前記のように水中航走体を水面へ浮上させるときには、万一、浮上予定位置に船等の浮遊物が存在していると、浮上する水中航走体が、該浮遊物に接触する虞が生じる。
【０００６】
そのために、前記水中航走体については、浮上前に、浮上予定位置に浮遊物が存在するか否かを検知して、該浮上予定位置が浮上に適していることを確認させる必要がある。
【０００７】
ところで、水中航走体は、通常、水中航走時に障害物との接触を避けるために、水中の障害物を検出するためのソーナーが装備されている。
【０００８】
前記ソーナーによる障害物の検出原理は、ビーム状に収束させた指向性を有する探査波（超音波）を発信し、その反射波の有無を基に該探査波を発信した方向における或る検知距離内の障害物の有無を調査するようにしてある。更に、前記調査により障害物の存在が検出された場合は、その時点で前記探査波を発信していた方位（方向）から該障害物が存在する方位を検出すると共に、前記探査波の発信から反射波の受信までの経過時間を基に、該障害物までの距離を求め、これにより、前記ソーナーを備えた水中航走体に対する相対位置として、該障害物の位置の検出を行うようにしてある。
【０００９】
しかし、前記ソーナーでは、水中から水面に向けて探査波を発信すると、該探査波が水面で反射されるために、前記した通常のソーナーによる障害物の検出原理では、水面自体が障害物として検出されてしまう。更に、この障害物として検出される水面には、波による凹凸（水面深度の変化）が存在しているために、水面に浮遊物が存在しているとしても、前記ソーナーでは、該浮遊物による反射波を、前記水面からの反射波より分離して特定することが難しいため、該浮遊物を直接検出することは困難である。
【００１０】
そのために、従来、水中航走体を水面に浮上させるときには、水中航走体の位置を音響通信や音響測位によって検知した水上の支援船が、レーダーやレーザーレーダー（ライダー）等によって水中航走体の浮上予定位置にて水中航走体の浮上に障害となり得る浮遊物の有無を確認するようにしている。その結果、前記浮上予定位置に前記浮遊物が検出されない場合は、前記支援船より水中航走体に、該浮上予定位置に浮上するよう指示を与えるようにしてある。一方、前記浮上予定位置に前記浮遊物の存在が検出された場合は、前記支援船より水中航走体に、浮上中断や浮上位置変更を指示するようにしている。
【００１１】
なお、ソーナーを用いて浮遊物である水上艦の検出を行うことができるようにするための手法としては、以下のような手法が従来提案されている。
【００１２】
これは、ソーナーにより探査波（音信号）を発信すると共に、その反射波（反射信号）を受信して、この受信信号に基づいて２次元画像データを生成すると、水上艦は、反射波による画像が形成され、その背後には前記探査波が到達せずに反射波のないシャドウ領域が形成されるという原理を利用するものである。よって、かかる手法では、前記２次元画像データに水面の反射波による像が形成されるとしても、該２次元画像データにおける反射波のレベルが低い領域を前記シャドウ領域として検出することにより、該検出されるシャドウ領域の手前側には水上艦が存在するものとして、該水上艦の位置の検出を行うことができるとされている（たとえば、特許文献１参照）。
【先行技術文献】
【特許文献】
【００１３】
【特許文献１】特開２０１０−２５６１６２号公報
【発明の概要】
【発明が解決しようとする課題】
【００１４】
水中航走体の浮上予定位置について、浮遊物の有無を支援船により確認し、その結果を基に、該支援船より水中航走体に前記所定の指示を行わせるようにしてある従来の手法は、水中航走体の浮上位置を選定するのに有効である。
【００１５】
しかし、自律航走する水中航走体の運用時には、該水中航走体の浮上予定位置の近傍に支援船が必ず存在するとは限られず、又、支援船から水中航走体に指令を送ることができない事態や、支援船から水中航走体の位置を計測できない事態が生じることも考えられる。
【００１６】
そのために、水中航走体の浮上予定位置についての浮遊物の有無の検出、及び、その結果に基づく浮上位置の選定は、水中航走体で自律的に行わせることが望ましいが、そのような手法は従来提案されていない。
【００１７】
なお、前記特許文献１に示された手法は、その検出原理上、検出対象となる浮遊物は、ソーナーによる探査時に、背後に前記シャドウ領域という探査波が到達しない領域が確実に且つ或る程度広い範囲に形成されるような喫水とサイズを有している必要がある。
【００１８】
したがって、前記特許文献１に示された手法は、波による水面深度の変化よりも大きな喫水を常時に有する水上艦のような比較的大型の艦船の検出には有効であるとしても、波による水面深度の変化との差があまりないような喫水の小さい小型の船舶や浮体等の浮遊物の検出は困難である。
【００１９】
しかし、前記水中航走体は、全長が数メートルから十数メートル程度であるために、該水中航走体の浮上時には、前記のような喫水の小さい小型の船舶や浮体等の浮遊物も障害となり得るため、これらの浮遊物の検出も望まれる。
【００２０】
そこで、本発明は、自律航走する水中航走体を浮上させるときに、浮上予定位置について浮遊物の有無を予め調査して、浮遊物の検出されない浮上予定位置を実際の浮上位置として選定できるようにするための水中航走体の浮上位置選定方法及び装置を提供しようとするものである。
【課題を解決するための手段】
【００２１】
本発明は、前記課題を解決するために、請求項１に対応して、水中航走体に設けたソーナーにより、水中航走体の浮上予定位置の水面と、該浮上予定位置の周辺領域の水面をスキャンし、浮上位置制御器による浮上位置選定処理として、前記スキャンによる前記浮上予定位置の水面、及び、前記周辺領域の水面の検出結果を、水中航走体の位置及び姿勢の情報を基に、前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度に変換し、次に、前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度について、時間平均処理と平面空間平均処理を行い、次いで、前記周辺領域の水面深度の平均処理の結果が、予め深度のプラス側に設定した或る閾値よりも大となるという条件、前記浮上予定位置の水面深度の平均処理の結果が、予め深度のプラス側に設定した別の或る閾値よりも大となるという条件、及び、前記浮上予定位置の水面深度の平均処理の結果から、前記周辺領域の水面深度の平均処理の結果を引いた値が、予め設定した更に別の或る閾値よりも大となるという条件のいずれも満たさない場合に、前記浮上予定位置を、水中航走体の実際の浮上位置として選定する水中航走体の浮上位置選定方法とする。
【００２２】
又、請求項２に対応して、前記請求項１に対応する構成において、浮上予定位置設定記憶部に、複数の浮上予定位置を、その優先順位と共に予め設定しておき、浮上位置制御器は、前記浮上予定位置設定記憶部に設定されている優先順位が第１位の浮上予定位置について、浮上位置選定処理を行って、周辺領域の水面深度の平均処理の結果が、予め深度のプラス側に設定した或る閾値よりも大となるという条件、浮上予定位置の水面深度の平均処理の結果が、予め深度のプラス側に設定した別の或る閾値よりも大となるという条件、又は、前記浮上予定位置の水面深度の平均処理の結果から、前記周辺領域の水面深度の平均処理の結果を引いた値が、予め設定した更に別の或る閾値よりも大となるという条件のいずれかが満たされると、該所定優先順位の浮上予定位置は、水中航走体の実際の浮上位置として不適格であると判断し、その後、前記浮上予定位置設定記憶部に設定されている優先順位に従って順次下位の浮上予定位置を呼び出して、浮上位置選定処理を行うようにする。
【００２３】
更に、請求項３に対応して、水面をスキャンするためのソーナーを有する水中航走体に、浮上位置制御器を備え、前記浮上位置制御器は、前記ソーナーのスキャンによる前記浮上予定位置の水面、及び、前記周辺領域の水面の検出結果を、水中航走体の位置及び姿勢の情報を基に、前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度に変換する機能と、前記浮上予定位置の水面深度、及び、前記周辺領域の水面深度について、時間平均処理と平面空間平均処理を行う機能と、前記周辺領域の水面深度の平均処理の結果が、予め深度のプラス側に設定した或る閾値よりも大となるという条件、前記浮上予定位置の水面深度の平均処理の結果が、予め深度のプラス側に設定した別の或る閾値よりも大となるという条件、及び、前記浮上予定位置の水面深度の平均処理の結果から、前記周辺領域の水面深度の平均処理の結果を引いた値が、予め設定した更に別の或る閾値よりも大となるという条件のいずれも満たさない場合に、前記浮上予定位置を、水中航走体の実際の浮上位置として選定する機能を備えるものとした構成を有する水中航走体の浮上位置選定装置とする。
【発明の効果】
【００２４】
本発明によれば、以下のような優れた効果を発揮する。
（１）請求項１に示した構成を有する水中航走体の浮上位置選定方法では、水中航走体を浮上させるときに、浮上予定位置について浮遊物の有無を予め調査して、浮遊物の検出されない浮上予定位置を水中航走体の実際の浮上位置として選定することができる。
（２）したがって、水中航走体は、浮遊物と接触する虞が生じない好適な浮上位置を自律的に選択して、水面への浮上を実施することができる。
（３）請求項３に示した構成を有する水中航走体の浮上位置選定装置では、前記（１）（２）と同様の効果を得ることができる。
【図面の簡単な説明】
【００２５】
【図１】本発明の水中航走体の浮上位置選定方法及び装置の実施の一形態を示すもので、（ａ）は概略側面図、（ｂ）は水面上方から見た図である。
【図２】図１の装置の浮上位置判定器における浮上位置選定処理の手順を示すフロー図である。
【図３】本発明の実施の他の形態として、浮上位置選定処理の別の処理手順を示すフロー図である。
【発明を実施するための形態】
【００２６】
以下、本発明を実施するための形態を図面を参照して説明する。
【００２７】
図１（ａ）（ｂ）及び図２は本発明の水中航走体の浮上位置選定方法及び装置の実施の一形態を示すものである。
【００２８】
ここで、先ず、本発明を適用する水中航走体の一例として、クルージング型の水中航走体１の構成について概説する。
【００２９】
前記水中航走体１は、図１（ａ）（ｂ）に示すように、略円柱形状の機体（胴体）２の後端部に、推進用のメインスラスタ３が設けられている。又、前記機体２の後部には、垂直舵（ラダー）４及び水平舵（エレベータ）５が設けられている。
【００３０】
前記機体２の内部には、図示しないが、電池の如き動力源と、該動力源より電力等の供給を受けて前記メインスラスタ３を駆動する電動モータ等の動力装置と、前記動力源より電力等の供給を受けて前記垂直舵４及び水平舵５を作動させる操舵装置と、水中航走体１自体のロール、ピッチ及びヨーの姿勢を検出することができるようにしてある慣性航法装置（Inertial Navigation System）と、水深計及び高度計を備えた構成としてある。
【００３１】
更に、前記水中航走体１には、図１（ａ）に示すように、前記図示しない慣性航法装置、水深計及び高度計からの入力に応じて、前記図示しない動力装置と操舵装置に指令を与える航走制御装置６を備える。
【００３２】
これにより、前記水中航走体１では、前記航走制御装置６からの指令に基づいて、前記動力装置により前記メインスラスタ３を駆動して推力を発生させ、前記操舵装置により前記各舵４及び５を適宜作動させることにより、水中航走体１を航走させると共に、航走速力、航走方位、深度を自在に変更できるようにしてある。
【００３３】
又、前記水中航走体１は、図１（ａ）（ｂ）に示すように、機体２の前部に、進行方向前方に存在する障害物を検出するためのソーナー７を設けた構成としてある。なお、前記水中航走体１では、航走時は常に、前記ソーナー７により、ビーム状に収束させた指向性を有する探査波を比較的短い時間で左右前方にスキャン（走査）させて、検知距離内の障害物の有無を調査するようにしてあるものとする。
【００３４】
以上の構成としてある水中航走体１に適用する本発明の水中航走体の浮上位置選定装置８（以下、単に本発明の浮上位置選定装置８と云う）は、図１（ａ）に示すように、浮上位置制御器９と、浮上予定位置設定記憶部１０とを備えた構成としてある。
【００３５】
前記浮上予定位置設定記憶部１０は、予め、水中航走体１を水面に浮上させるための浮上予定位置１１について、複数の候補の位置情報（緯度、経度）を記憶させることができるようにしてあると共に、該各浮上予定位置１１の各候補について予め設定される優先順位を、併せて記憶させることができるようにしてある。
【００３６】
以下、前記浮上位置制御器９の機能の説明に則して、本発明の水中航走体の浮上位置選定方法について説明する。
【００３７】
水中を航走している状態の前記水中航走体１を水面に浮上させる場合は、前記本発明の浮上位置選定装置８では、前記浮上位置制御器９により、前記浮上予定位置設定記憶部１０に予め記憶させてある優先順位が第１位の浮上予定位置１１の位置情報を呼び出して、前記航走制御装置６に目標地点の位置情報として与える。これにより、前記水中航走体１は、前記航走制御装置６により制御されて、前記所定優先順位の浮上予定位置１１に向けて航走するようになる。
【００３８】
前記のようにして所定優先順位の浮上予定位置１１に向けて航走する水中航走体１が、水面にある程度近づいて、該水中航走体１から水面までの距離（水中航走体１のピッチ角方向の距離）が、前記ソーナー７の検知距離よりも短くなると、該ソーナー７では、前記探査波による水面のスキャンが行われるようになるため、該水面が障害物として検出されるようになる。よって、前記ソーナー７は、前記障害物として検出される水面までの距離を順次出力するようになる。
【００３９】
次いで、前記浮上位置制御器９は、前記航走制御装置６より得る水中航走体１の自機の位置情報（緯度、経度、深度）を基に、該水中航走体１が、前記所定優先順位の浮上予定位置１１に対して前記ソーナー７の検知距離以内となる位置まで接近したことを検出すると、図２に示す浮上位置選定処理を開始するようにしてある。
【００４０】
すなわち、図２に示す浮上位置選定処理では、先ず、前記浮上位置制御器９は、前記ソーナー７により、検知距離以内となった前記所定優先順位の浮上予定位置１１の水面と、その周辺領域１２（図１（ｂ）にてハッチングを付した領域）の水面をスキャン（走査）させる（ステップＳ１）。この際、前記周辺領域１２は、図１（ｂ）に示すように、前記浮上予定位置１１の周囲を、該浮上予定位置１１と対応する前後幅及び左右幅で囲む範囲、すなわち、前記浮上予定位置１１の８倍の面積の範囲に設定することが好ましい。なお、前記浮上予定位置１１は、水中航走体１を浮上させるための領域であるため、水中航走体１の平面形状よりも大きな平面サイズを有することは当然であるが、図１（ａ）（ｂ）では、図示する便宜上、水中航走体１は、浮上予定位置１１及び周辺領域１２の縮尺に比して拡大して記載してある。
【００４１】
次に、前記浮上位置制御器９は、前記ソーナー７のスキャンによる前記所定優先順位の浮上予定位置１１の水面、及び、前記周辺領域１２の水面についての相対的な位置の検出結果を、前記航走制御装置６より得る水中航走体１の自機の位置情報（緯度、経度、深度）と、水中航走体１の姿勢（ロール、ピッチ、ヨー）の情報とを基にして、前記所定優先順位の浮上予定位置１１の水面深度と、前記周辺領域１２の水面深度に変換する（ステップＳ２）。
【００４２】
次いで、前記浮上位置制御器９では、前記のようにして求められた前記所定優先順位の浮上予定位置１１の水面深度と、前記周辺領域１２の水面深度のそれぞれについて、時間平均処理を行うと共に、平面空間平均処理を行う（ステップＳ３）。
【００４３】
これにより、前記所定優先順位の浮上予定位置１１と、前記周辺領域１２のそれぞれについて、水面に浮遊物がなければ、前記ステップＳ３による処理では、波による水面の上下変動分が平均されることになるため、各々の水面深度の平均処理の結果は、ほぼゼロとなる。
【００４４】
これに対し、たとえば、図１（ａ）（ｂ）に二点鎖線で示す如く、前記所定優先順位の浮上予定位置１１の水面に浮遊物１３が存在している場合は、前記ステップＳ２で求められる該浮上予定位置１１の水面深度に、前記浮遊物１３において水面の上下変動よりも大きな喫水で水面下に没している部分の値が含まれるようになる。したがって、この場合は、前記ステップＳ３による処理では、前記所定優先順位の浮上予定位置１１の水面深度を平均処理した結果は、ゼロとはならず、深度がプラス側に偏るようになる。
【００４５】
なお、図示してないが、前記浮上予定位置１１に存在している浮遊物１３が、前記周辺領域１２の水面にもまたがるような大きな浮遊物である場合は、前記ステップＳ２で求められる該周辺領域１２の水面深度に、前記浮遊物１３の水面下に没している部分の値が含まれるようになる。このため、この場合は、前記ステップＳ３による処理では、前記周辺領域１２の水面深度を平均処理した結果が、ゼロとはならず、深度がプラス側に偏るようになる。
【００４６】
以上の点に鑑みて、前記浮上位置制御器９は、前記ステップＳ３の後はステップＳ４に進んで、以下の３つの条件Ａ，Ｂ，Ｃのいずれかが満たされるか否かの判断をするようにしてある。
【００４７】
先ず、条件Ａは、前記ステップＳ３で求められる周辺領域１２の水面深度の平均処理の結果が、予めプラス側の値となるように設定された或る閾値ａよりも大となる、という条件である。したがって、この条件Ａが満たされる場合は、前記所定優先順位の浮上予定位置１１から周辺領域１２の水面深度が明らかにプラス側に偏っているので、前記周辺領域１２には、浮遊物１３が存在すると推定される。
【００４８】
次に、条件Ｂは、前記ステップＳ３で求められる前記所定優先順位の浮上予定位置１１の水面深度の平均処理の結果が、予め、プラス側の値となるように設定された或る閾値ｂよりも大となる、という条件である。なお、この閾値ｂは、閾値ｂ≧閾値ａとしてある。したがって、この条件Ｂが満たされる場合は、前記所定優先順位の浮上予定位置１１の水面深度が明らかにプラス側に偏っているので、該浮上予定位置１１には、浮遊物１３が存在すると推定される。
【００４９】
更に、条件Ｃは、前記所定優先順位の浮上予定位置の水面深度の平均処理の結果から、周辺領域１２の水面深度の平均処理の結果を引いた値が、閾値ｃよりも大となる、という条件である。なお、前記閾値ｃは、閾値ｃ≧（周辺領域１２の水面深度の分散）×２としてある。この条件Ｃが満たされる場合は、前記条件Ａ，Ｂが満たされない場合であっても、前記所定優先順位の浮上予定位置１１の水面深度が、前記周辺領域１２の水面深度よりも明らかにプラス側に偏っている場合である。したがって、この条件Ｃが満たされる場合は、前記所定優先順位の浮上予定位置１１に浮遊物が存在すると推定される。
【００５０】
前記浮上位置制御器９は、前記ステップＳ４にて、前記条件Ａ，Ｂ，Ｃのいずれか一つでも満たされた場合は、ステップＳ５に進み、前記所定優先順位の浮上予定位置１１は、水中航走体１の実際の浮上位置とするには不適格であると判断するようにしてある。
【００５１】
その後、前記浮上位置制御器９は、ステップＳ６へ進んで、前記浮上予定位置設定記憶部１０に予め設定されている優先順位が次の浮上予定位置１１を呼び出して、水中航走体１の航走制御装置６に与えるようにしてある。
【００５２】
よって、この場合は、前記優先順位が次の浮上予定位置１１に向けて、水中航走体１の移動（航走）が開始され、該水中航走体１が、前記所定優先順位の浮上予定位置１１に対してソーナー７の検知距離以内に近づいた時点で、浮上位置制御器９では、前記と同様に、図２に示した浮上位置選定処理を開始させるようにしてある。
【００５３】
この浮上位置選定処理によっても、前記ステップＳ４にて、条件Ａ，Ｂ，Ｃのいずれかが満たされる場合は、前記浮上位置制御器９は、前記浮上予定位置設定記憶部１０に予め設定されている優先順位に従って順次下位の浮上予定位置１１を呼び出して、該所定優先順位の浮上予定位置１１への移動と、該浮上予定位置１１に対する図２に示した浮上位置選定処理を、順次繰り返して行うようにする。
【００５４】
一方、前記図２の浮上位置選定処理のステップＳ４にて、前記条件Ａ，Ｂ，Ｃのいずれもが満たされないと判断される場合は、その時点で選択されている所定優先順位の浮上予定位置１１には、浮遊物は存在しないと推定される。そのため、前記浮上位置制御器９は、ステップＳ７へ進んで、該浮上予定位置１１を実際の浮上位置に選定し、該浮上位置に浮上するよう水中航走体１の航走制御装置６に指令を与えるようにしてある。
【００５５】
これにより、前記水中航走体１は、前記図２の浮上位置選定処理により該水中航走体１自身で自律的に選定された浮上位置において、浮遊物に接触する虞が防止された状態で水面に浮上するようになる。
【００５６】
このように、本発明の水中航走体の浮上位置選定方法及び装置によれば、自律航走する水中航走体１を浮上させるときに、浮上予定位置１１について浮遊物１３の有無を予め調査して、浮遊物１３の検出されない浮上予定位置１１を実際の浮上位置として選定することができる。
【００５７】
したがって、水中航走体１には、浮遊物１３と接触する虞が生じない好適な浮上位置を自律的に選択して、水面への浮上を実施させることができるようになる。
【００５８】
なお、前記浮上予定位置設定記憶部１０に予め設定されていたすべての浮上予定位置１１について、図２に示した浮上予定位置選定処理により、水中航走体１の実際の浮上位置とするには不適格であると判断された場合は、浮上位置制御器９は、航走制御装置６に、水中航走体１を一定深度で周回航走させた状態で、図示しない支援船からの指令を待つようにさせるようにすればよい。
【００５９】
次に、図３は本発明の実施の他の形態として、浮上位置制御器９で実施させる図２に示した浮上位置選定処理の応用例として、荒天時の対応を考慮した浮上位置選定処理を示すものである。
【００６０】
すなわち、荒天時には、水面における波の波高が高くなるために、前記浮上位置制御器９にて、図２のステップＳ２と同様に、ソーナー７のスキャンによる所定優先順位の浮上予定位置１１の水面、及び、前記周辺領域１２の水面についての相対的な位置の検出結果を、水面深度に変換すると、得られる水面深度の分散は、非荒天時（平穏時）に比して増大する。
【００６１】
したがって、その後、図２のステップＳ３と同様に、浮上予定位置１１及び周辺領域１２のそれぞれ水面深度について時間平均処理及び平面空間平均処理を行うと、荒天時に得られる結果が、非荒天時（平穏時）に得られる結果と等しいとしても、水面深度が大きい部分をより多く含んでいることになる。
【００６２】
そのため、図３に示す浮上位置選定処理では、図２に示したと同様の処理手順において、ステップＳ３の後に、ステップＳ８を設けて、以下の条件Ｄが満たされるか否かの判断を行うようにしてある。
【００６３】
前記条件Ｄは、前記ステップＳ２で求められた前記周辺領域１２の水面深度の分散が、予め設定してある或る閾値ｄより大きい、という条件である。なお、前記閾値ｄは、前記周辺領域１２の水面が少し荒れた状態のときの水面深度の分散を基に、設定するようにすればよい。
【００６４】
これにより、前記条件Ｄが満たされない場合は、荒天時ではないと判断できるため、図２に示したと同様のステップＳ４へ進むようにしてある。
【００６５】
一方、前記ステップＳ８にて、前記条件Ｄが満たされる場合は、荒天時であると判断できるようになる。よって、この場合、前記浮上位置制御器９では、ステップＳ９へ進んで、ステップＳ４の条件Ａ，Ｂ，Ｃでそれぞれ用いられる閾値ａ，ｂ，ｃについて、それぞれより大きめの値に補正する処理を予め行い、その後、前記ステップＳ４に進むようにしてある。
【００６６】
その他の処理は図２に示したものと同様である。
【００６７】
以上の構成としてある本実施の形態によっても、図１（ａ）（ｂ）及び図２の実施の形態と同様の効果を得ることができる。
【００６８】
なお、本発明は、前記実施の形態にのみ限定されるものではなく、浮上予定位置設定記憶部１０が、予め、水中航走体１を水面に浮上させるための浮上予定位置１１について、複数の候補の位置情報（緯度、経度）を、優先順位と併せて記憶させるようにしてあるものとしたが、浮上予定位置設定記憶部１０は、最初（第１位）の浮上予定位置１１の位置情報のみを設定して記憶させておき、図２及び図３のステップＳ５で該浮上予定位置１１が実際の浮上位置として適格でないという判断が下される場合は、該不適格と判断された位置より、予め設定されている方向と距離分、平行移動させた位置を、次の浮上予定位置１１として順次設定する機能を備えるようにしてもよい。
【００６９】
水面を検出するためのソーナー７は、クルージング型の水中航走体１の機体前部に設けられる進行方向前方の障害物検出用のソーナー７を利用（兼用）することが、前記水中航走体１の装置点数を削減するという観点から考えると好適である。しかし、水中航走体１の機体上部に、機体上方の水面をスキャンするためのソーナー７を、前記障害物検出用のソーナー７とは別に設けるようにしてもよいことは勿論である。
【００７０】
又、本発明の水中航走体の浮上位置選定方法は、クルージング型の水中航走体１のみならず、ホバリング型の水中航走体に適用してもよい。
【００７１】
本発明の浮上位置選定装置８における浮上位置制御器９と浮上予定位置設定記憶部１０は、水中航走体１の航走制御装置６を構成する電子計算機に機能として組み込むようにしてもよい。
【００７２】
その他本発明の要旨を逸脱しない範囲内で種々変更を加え得ることは勿論である。
【符号の説明】
【００７３】
１  水中航走体、７  ソーナー、８  浮上位置選定装置、９  浮上位置制御器、１０  浮上予定位置設定記憶部、１１  浮上予定位置、１２  周辺領域
【図１】
2015217882.tif 000003
【図２】
2015217882.tif 000004
【図３】
2015217882.tif 000005