JP3949932B2 - 自律型水中航走体の航走制御装置 - Google Patents
自律型水中航走体の航走制御装置 Download PDFInfo
- Publication number
- JP3949932B2 JP3949932B2 JP2001332809A JP2001332809A JP3949932B2 JP 3949932 B2 JP3949932 B2 JP 3949932B2 JP 2001332809 A JP2001332809 A JP 2001332809A JP 2001332809 A JP2001332809 A JP 2001332809A JP 3949932 B2 JP3949932 B2 JP 3949932B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- calculation unit
- traveling
- water
- ground speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000004364 calculation method Methods 0.000 claims description 136
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 86
- 238000012937 correction Methods 0.000 claims description 56
- 238000001514 detection method Methods 0.000 claims description 33
- 230000005540 biological transmission Effects 0.000 description 11
- 239000013598 vector Substances 0.000 description 11
- 230000001133 acceleration Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 3
- 230000001141 propulsive effect Effects 0.000 description 3
- 241000282412 Homo Species 0.000 description 2
- 239000013535 sea water Substances 0.000 description 2
- 239000007983 Tris buffer Substances 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Description
【発明の属する技術分野】
本発明は、無索で水中を航行する自律型水中航走体の航走制御装置に係り、特に、外乱要素である水の流れによる影響の大きさを時々刻々求め、その求めた大きさに基づいて「あて舵」制御するすることにより、水中航走体を目標に向かって航走させるようにした自律型水中航走体の航走制御装置に関する。
【0002】
【従来の技術】
従来の自律型水中走行体の航走制御は、予め設定した目標点(到達目標点)に自律型水中走行体を航走させる場合、常に自律型水中走行体の先端(船首)を到達目標点に向けて航行させるようにしていた。このため、図8に示したように、水中走行体10を、例えば目標点Aから目標点Bまで、予め定めた基準航路12に沿って直線的に航走させようとすると、潮流14などの外乱の影響を受けて実際の航路16が一点鎖線で示したように基準航路12から大きく外れ、基準航路12上に設定した重要観測点18における観測を行なうことができない場合を生ずる。このため、潮流などの外乱の影響を排除できる航走装置の開発が望まれている。
【0003】
従来、外乱の影響を排除して針路を保持するいわゆる「あて舵制御システム」は、人間が操縦する船舶等の操縦支援装置として提供されているものがほとんどであった。このような「あて舵制御システム」は、あくまで人間が操縦する船舶等の航走体の操縦支援装置あるいは補助装置であって、人間が操縦装置(操舵装置)を操作して保持すべき船舶の舳先を向ける方位を指示するようになっていて、人間が搭乗しない無人の航走体に適用することができない。
【0004】
そして、特開2000−1199号公報には、船舶のジョイステック操船装置において、船舶に対する風、波、潮流等の外乱の影響を検出し、その影響が大きい場合、または船舶の実方位と目標方位との偏差が大きい場合に大きな推力を発生させ、外乱の影響が小さく、船舶の実方位と目標方位値の偏差が小さい場合に小さな推力を発生させ、船舶の方位をより正確に維持できるようにした操船装置が開示されている。
【0005】
一方、自律的に水中を航走する航走体の従来の航走装置として、目標点に構造物を用意し、当該構造物内にソナーを設置し、水中航走体側に当該ソナーと交信して構造物との位置関係を求め、この求めた位置関係に基づいて今後の水中航走体の位置および速度を推定し、水中航走体の速度ベクトルの方向が目標点に向くように制御し、潮流やかさ比重の影響があっても水中航走体を目標点に向かわせることができるものが提案されている(特開平9−318645号公報)。
【0006】
【発明が解決しようとする課題】
上述した特開2000−1199号公報に記載の従来技術は、風や波、潮流等の外乱の影響を考慮して針路を保持するようにしているが、ジョイスチック操船装置を操縦する人に対する操舵指令を出力するものであり、人が搭乗しない自律型水中航走体には適用することができない。
【0007】
また、上述した特開平9−318645号公報に記載の従来技術は、ソナーを内蔵した構造物をいちいち目標点に設置する必要がある。このため、長距離を航走したり、水中航走体を多くの点において屈曲させて航走させる場合、多くの到達目標点を設けてソナーを備えた構造物を設置しなければならず、構造物の設置、回収に多くの時間と手間と費用とを必要とするばかりでなく、ソナーによる測位が可能になる位置に航走体が近づかないと、測位が行えないという問題があった。
【0008】
本発明は、上述した問題点を解消し、目標物を設置することなく潮流などの外乱による影響をなくして目標点間を直線的に航走できるようにすることを目的としている。
また、本発明は、航走体が予め定めた基準の航路から外れた場合に、速やかに基準の航路に復帰できるようにすることを目的としている。
さらに、本発明は、海溝などの航走体の対地速度が得られないときにも、到達目標点に向けて航走できるようにすることを目的としている。
【0009】
【課題を解決するための手段】
上記目的を達成するために、本発明に係る自律型水中航走体の航走制御装置は、水中を航走する航走体の水底に対する速度を検出する対地速度検出手段と、前記航走体の水に対する速度を検出する対水速度検出手段と、この対水速度検出手段が検出した前記航走体の対水速度と、前記対地速度検出手段が検出した航走対地速度とに基づいて、前記水底に対する水の流れの速度を求める水流速度演算部と、前記航走体を到達させる到達目標点に向かう対地速度である目標対地速度を、前記水流速度演算部が求めた水流速度によって補正する速度補正部と、この速度補正部が求めた補正後の対地速度に基づいて、前記航走体の向きを求める船首方位演算部と、この船首方位演算部が求めた船首方位に基づいて操舵機構を制御し、前記航走体の先端を前記船首方位に向ける操舵制御部と、を有し、前記速度補正部は、前記航走体の地球座標における位置を検出する位置検出手段の出力信号と前記到達目標点とから、前記航走体に対する前記到達目標点の方位を求める目標点方位演算部と、この目標点方位演算部が求めた目標点方位と、前記航走体の推進器の駆動情報とに基づいて、前記目標対地速度を求める目標対地速度演算部と、この目標対地速度演算部が求めた前記目標対地速度に対して前記水流速度を相殺する速度成分を求める進行方向速度成分演算部と、を有することを特徴としている。
【0010】
前記速度補正部は、前記対地速度検出手段が前記航走対地速度を検出できないときに、予め与えられた基準水流速度を用いて前記補正後の対地速度を求めるように構成することができる。
【0011】
また本発明に係る自律型水中航走体の航走制御装置は、水中を航走する航走体の水底に対する速度を検出する対地速度検出手段と、前記航走体の水に対する速度を検出する対水速度検出手段と、この対水速度検出手段が検出した前記航走体の対水速度と、前記対地速度検出手段が検出した航走対地速度とに基づいて、前記水底に対する水の流れの速度を求める水流速度演算部と、前記航走体を到達させる到達目標点に向かう対地速度である目標対地速度を、前記水流速度演算部が求めた水流速度によって補正する速度補正部と、この速度補正部が求めた補正後の対地速度に基づいて、前記航走体の向きを求める船首方位演算部と、この船首方位演算部が求めた船首方位に基づいて操舵機構を制御し、前記航走体の先端を前記船首方位に向ける操舵制御部と、を有し、前記速度補正部は、前記対地速度検出手段が前記航走対地速度を検出できないときに、予め与えられた基準水流速度を用いて前記補正後の対地速度を求めるように構成している。さらに、前記船首方位演算部は、前記進行方向速度成分演算部が求めた前記航走体の進行方向の速度成分に基づいて、前記船首方位を算出する船首方位算出回路と、前記航走体が通過した第1到達目標点に対する航走体が向かう第2到達目標点の方位を基準方位として求める基準方位演算部と、この基準方位演算部が求めた基準方位と、前記目標点方位演算部が求めた目標点方位との偏差を求める方位偏差演算部と、この方位偏差演算部が求めた方位の偏差の大きさに応じて前記航走体の船首方位の補正量を求めて前記船首方位算出回路に与える方位補正量演算部と、を有し、前記速度補正部は、前記対地速度検出手段が前記航走対地速度を検出できないときに、予め与えられた基準水流速度を用いて前記補正後の対地速度を求めるように構成している。
【0012】
【作用】
このようになっている本発明は、水底に対する水の流れの速度を求め、航走体の水底に対する速度を水の流れの速度によって補正し、航走の外乱である潮流などの水の流れを相殺して航走体を航走させるようになっているため、予め定めた航路に沿って航走体を航走させることが可能で、重要観測点などを確実に通過させることができる。
【0013】
また、本発明は、航走体が到達目標点において旋回するときなどにおいて、航走体の船首の方位が基準の航路の方位から外れた場合に、外れた量に応じた大きさの船首方位の補正を行なうため、航走体を速やかに基準の航路に復帰させることができる。さらに、海溝などの海底が深く、航走体の対地速度を検出できない場合に、予め与えた基準の水流速度を用いて速度補正を行なうようにしているため、航走対地速度を得られない場所であっても、確実に到達目標点に向けて航走させることができる。
【0014】
【発明の実施の形態】
本発明に係る自律型水中航走体の航走制御装置の好ましい実施の形態を、添付図面に従って説明する。
図2は、本発明の実施の形態に係る自律型航走体の航走制御装置の概略ブロック図である。図2において、自律型の水中航走体10は、図示しない推進器と航走制御装置20とを搭載しており、この航走制御装置20によって、予め設定された到達目標点の経度、緯度に向かって水中を自動航走することができるようになっている。
【0015】
この水中航走体10の航走制御装置20は、大別すると、水中内で推進力の方向を可変させることができる操舵機構30と、水中航走体10の速度を検出するドップラー式超音波速度計40と、水中航走体の地球座標における位置を検出する慣性航法装置50と、詳細を後述する制御演算装置60とを有している。
【0016】
上述した操舵機構30は、制御演算装置60からの操舵制御指令に応じた方向に、先端(船首)を向けるように方向舵または水平首振り式推進器を操作する機構である。
上述したドップラー式超音波速度計40は、超音波41を水中に発しその反射波を基に、水に対する水中航走体10の速度および地面に対する速度に関する情報を得ることができる測定器であり、その測定結果を制御演算装置60に時々刻々と与えられるようになっている。すなわち、ドップラー式超音波速度計40は、図1に示したように、超音波41の送信・受信部42と、図示しない位置検出器と、対地速度検出手段である対地速度検出部44と、対水速度検出手段である対水速度検出部46とを備えている。
【0017】
送信・受信部42は、所定の周波数の超音波41を送信信号として海中などの水中に放射し、海底(水底)などからの反射波を受信信号として受信する。そして、対地速度検出部44は、送信・受信部42における超音波41の送信時刻と、その超音波41の海底からの反射波を受信した受信時刻、および図示しない位置検出器からの位置検出信号とに基づいて、水中航走体10の海底に対する速度の大きさ(速さ)と、地球座標における水中航走体10の移動方向、すなわち対地速度をベクトルとして出力する。また、対水速度検出部46は、同様にして、送信・受信部42における送信時刻と、プランクトンなどの水中浮遊物からの反射波の受信時刻、および水中航走体10の先端を向けた方向の移動量から水に対する速度(対水速度)をベクトルとして出力する。
【0018】
上述した位置検出手段である慣性航法装置50は、水中航走体10の現在の速度と移動開始点からの航走距離、地球座標における水中航走体10の位置の情報を得ることができる測定器であり、その測定結果を制御演算装置60に時々刻々と与えるようになっている。すなわち、慣性航法装置50は、図1に示したように、初期位置設定部52と、加速度センサ54と、航走速度演算部56と、位置演算部58となどを有している。
【0019】
慣性航法装置50の初期位置設定部52は、水中航走体10を航走させる際に、水中航走体10の地球座標における初期位置(経度および緯度)を設定できるようになっている。加速度センサ54は、図示しない慣性航法装置50を構成しているジャイロに設けてあって、水中航走体10の航走に伴う三次元の加速度を検出できるようになっている。そして、航走速度演算部56は、加速度センサ54の出力信号を積分して水中航走体10の航走(航行)速度を求めるようになっている。また、位置演算部58は、航走速度演算部56が求めた航走速度を積分して航走距離を算出するとともに、初期位置設定部52に設定してある初期位置を読み出し、算出した航走距離と初期位置とから水中航走体10の地球座標における現在位置(経度、緯度)を求めて出力する。
【0020】
制御演算装置60は、図1に示したように、水流速度演算部である潮流速度演算部62と、メモリ64、速度補正部66、船首方位演算部68と、操舵制御部70とを有している。潮流速度演算部62は、ドップラー式超音波速度計40の対地速度検出部44と対水速度検出部46とから速度検出信号が入力するようになっていて、後述するように、海底(水底)する水の流れの速度である潮流速度ベクトルを求めるようになっている。なお、潮流とは、この発明の場合、潮汐力による海水の水平方向の流ればかりでなく、海流や潜流など、すべての水の流れを意味している。
【0021】
制御演算装置60のメモリ64は、少なくとも目標点記憶部72と基準潮流記憶部74とを有している。目標点記憶部72には、水中航走体10を航走させるべき予め設定した航路上の複数の到達目標点が経度、緯度の値として記憶させてある。また、基準潮流記憶部74には、例えば気象庁などから発表されている各海域の潮流速度(速さ、方向)が基準潮流速度として記憶させてある。この基準潮流速度は、後述するように、ドップラー式超音波速度計40により水中航走体10の対地速度を検出することができないときに使用される。
【0022】
速度補正部66は、目標点方位演算部76と目標対地速度演算部78と進行方向速度成分演算部80とを有する。そして、目標点方位演算部76は、後述するように、慣性航法装置50の位置演算部58の出力する位置情報と、目標点記憶部72に格納してある到達目標点の座標とから、水中航走体10に対する目標到達点の方位を求める。
【0023】
目標対地速度演算部78は、水中航走体10の図示しない推進器の駆動を制御する推進器駆動部82の出力する駆動制御信号、すなわち推進器の駆動情報と、目標点方位演算部76が求めた目標点方位とにより、外乱である潮流がないときの到達目標点に向かう対地速度(ベクトル)を求めて出力する。また、進行方向速度成分演算部80は、目標対地速度演算部70が求めた目標対地速度を潮流速度演算部62が求めた潮流速度によって補正した対地速度、すなわち潮流速度を相殺するような対地速度を求めるようになっていて、この補正後の対地速度は船首方位演算部68の船首方位算出回路96に出力される。さらに、進行方向速度成分演算部80は、メモリ64の基準潮流記憶部74に格納してある基準潮流を読み出すことができるようになっており、潮流速度演算部62が潮流速度を算出することができないときに、基準潮流を用いて進行方向速度成分を算出する。
【0024】
船首方位演算部68は、基準方位演算部90、方位偏差演算部92、方位補正量演算部94および船首方位算出回路96を有する。基準方位演算部90は、後述するように、目標点記憶部72に記憶させてある複数の到達目標点から読み出した2つの到達目標点に基づいて、水中航走体10を航走させるべき基準の航路(水中航走体10が進むべき方位)を求める。また、方位偏差演算部92は、速度補正部66の目標点方位演算部76が求めた目標点の方位と、基準方位演算部90が求めた基準航路の方位との偏差を求める。方位補正量演算部94は、方位偏差演算部92の求めた偏差の大きさに応じた水中航走体10の向きの補正量を演算し、船首方位算出回路96に与える。この船首方位算出回路96は、速度補正部66の進行方向速度成分演算部80が求めた潮流を補正したのちの水中航走体10の対地速度(ベクトル)に基づいて、水中航走体10の先端の向き、すなわち船首の方位を算出し、この船首方位を方位補正量演算部94の求めた補正量によって補正する。そして、操舵制御部70は、船首方位算出回路96が求めた船首方位に基づいて操舵機構30を制御し、水中航走体30の先端をその方位に向ける。
【0025】
このようになっている実施形態の航走制御装置20の作用は、次の通りである。まず、水中航走体10は、図示しない母船に搭載されて調査海域に搬送される。そして、調査を開始するに際して、水中航走体10を海中に投入する初期位置を地球座標(経度、緯度)によって慣性航法装置50の初期位置設定部52に設定する。水中航走体10の位置は、水中航走体10の中心位置を表す。また、メモリ64の目標点記憶部72には、水中航走体10を航走させる航路上の到達目標点を記憶させる。この到達目標点は、図8に示したように、水中航走体10が重要観測点18を通過するように、重要観測点18を挟んだ水中航走体10を旋回(方向転換)させたい位置を地球座標で記憶させる。さらに、メモリ64の基準潮流記憶部74には、水中航走体10を航走させる海域の、気象庁などが公表している潮流速度を記憶させる。
【0026】
水中航走体10は、航走制御装置20が起動されて海中に投入されると、予め設定された深度または高度(海底からの高さ)まで下降したのち、設定された(目標点記憶部72に記憶させた)最初の到達目標点に向けて水平方向に航走を開始する。そして、航走制御装置20を構成している慣性航法装置50の加速度センサ54は、水中航走体10の航走開始に伴って水中航走体10の三次元方向の加速度を検出する。航走速度演算部56は、加速度センサ54が検出した加速度を所定の時間ごと(例えば、10msecごと)に読み出し、これを積分して水中航走体10の現在の航走速度を求める。また、慣性航法装置50の位置演算部58は、航走速度演算部56が出力する航走速度を所定の時間(例えば、10msec)にわたって積分し、この間の水中航走体10の航走方向と航走距離とを求めるとともに、求めた航走距離を順次積算し、さらに初期位置設定部52に設定された初期位置情報を読み出し、現在の水中航走体10の地球座標における位置を求める。この水中航走体10の現在位置は、図3に示したように、航走制御装置20を構成している制御演算装置60に入力される。また、この慣性航法装置50によって求められた加速度や速度、航走距離、時々刻々の位置などのデータは、メモリ64の図示しないデータ記憶領域に順次書き込まれる。
【0027】
一方、ドップラー式超音波速度計40は、送信・受信部42ににおいて水中に超音波41を放射し、海底または水中浮遊物からの反射波を受信し、水中走行体10の対地速度Veと対水速度Vwを検出し、図3に示したように制御演算装置60に入力する。すなわち、ドップラー式超音波速度計40の対地速度検出部44は、送信・受信部42における超音波41の放射(送信)時刻と海底からの反射波の受信時刻、および図示しない位置検出器の出力する位置情報とにより、海底に対する水中航走体10の速度(対地速度)Veを求め、制御演算装置60に出力する。また、ドップラー式超音波速度計40の対水速度検出部46は、超音波48の送信時刻と海中浮遊物からの反射波の受信時刻などから、水中航走体10の水(海水)に対する速度(対水速度)Vwを検出して制御演算装置60に送出する。
【0028】
制御演算装置60は、図3に示したように、ドップラー式超音波速度計の検出信号に基づいて潮流速度Vtを算出したのち、潮流を考慮した進行方向速度成分V0’の算出、潮流を考慮した進行方向(船首方位)φ0’を算出する。さらに、制御演算装置60は、詳細を後述するように、進行方位のずれ量を補正した船首方位Φ0 を求め、この補正した船首方位Φ0 に基づいて、操舵機構30を制御するための操舵制御量を求める。この操舵制御量を求める具体的手順は、次のようにして行なう。
【0029】
制御演算装置60の潮流速度演算部62は、対地速度検出部44が出力した水中航走体10の対地速度Veと、対水速度検出部46が検出した水中航走体10の対水速度Vwとを読み込み、図4に示したように両者の差を求め、海底に対する水の流れの速度(潮流速度)Vtを演算する。すなわち、潮流速度演算部62は、
【数1】
の演算を行ない、潮流速度Vtを求めて速度補正部66に送出する。
【0030】
次の進行方向速度成分V0’算出は、次のようにして行なわれる。まず、制御演算装置60を構成している速度補正部66の目標点方位演算部76は、慣性航法装置50の位置演算部58が出力する水中航走体10の現在位置を読み込むとともに、メモリ64の目標点記憶部72から、水中航走体10が現在向かっている次の到達目標点の位置を読み出し、水中航走体10の現在位置に対する到達目標点の方位を演算する。
【0031】
例えば、図5に示したように、水中航走体10が到達目標点Aを通過して次の到達目標点Bに向かっているとした場合、目標点方位演算部76は、位置演算部58が出力する水中航走体10の中心の地球座標における現在位置Cと、目標点記憶部72に記憶させてある次の到達目標点Bの経度、緯度とを読み出し、現在位置Cに対する到達目標点Bの方位(現在位置Cと到達目標点Bとを結ぶ線の経度方向Laに対する角度)φ0 を算出する。この目標点方位φ0 は、速度補正部66の目標対地速度演算部78に与えられる。
【0032】
目標対地速度演算部78は、目標点方位演算部76から目標点方位φ0 が入力すると、推進器駆動部82の出力する推進力情報とにより、潮流などの外乱がない場合の、現在位置Cから到達目標点Bに向かう目標対地速度V0 を求め、速度補正部66を構成している進行方向速度成分演算部80に送出する。進行方向速度成分演算部80は、目標対地速度演算部78が求めた目標対地速度V0 を潮流速度Vtによって補正し、水中航走体10を進める方向の速度成分を演算する。
【0033】
すなわち、進行方向速度成分演算部80は、図5に示したように、目標対地速度V0 に対して潮流速度演算部62が求めた潮流速度Vtを相殺できる進行方向速度成分V0’を、
【数2】
のように演算して求める。これにより、水中航走体10を進行方向速度成分V0’の速度をもってこの速度成分の方向に進めることにより、水中航走体10は、潮流速度Vtが相殺されて目標対地速度V0 でもって直線CB上を航走することになる。従って、図8の実線に示したように、水中航走体10の航路19を予め設定した基準の航路12に沿った直線状にすることがでる。このため、水中航走体10を確実に重要観測点18を通過させることが可能となる。しかも、ドップラー式超音波速度計40によって水中航走体10の対地速度、対水速度を求めるようにしているため、正確な船首方位の制御を行なうことができる。また、実施形態においては、到達目標点を地球座標の経度、緯度によって設定しているため、目標物を接地する必要がなく、目標物の係留や回収の手間が省けるばかりでなく、任意の海域を自由に航走させることができる。
【0034】
この進行方向速度成分演算部80が求めた進行方向速度成分V0’は、船首方位演算部68の船首方位算出回路96に入力される。船首方位算出回路96は、進行方向速度成分V0’の方位φ0’、すなわち水中航走体10の先端(船首)を向けて進めるべき方向を算出する。
【0035】
ここに、数式2に示したように、V0’=V0 −Vtである。そして、目標対地速度V0 の速度ベクトルの大きさ(速さ)をUとすると、経度方向の成分と緯度方向の成分との和であるから、
【数3】
と表すことができる。また、速さUは、水中航走体10の推進力に依存する値であり、水中航走体10に搭載した推進器の駆動情報(例えば、推進器の駆動電流値、推進器の回転速度など)から容易に求めることができる。
【0036】
船首方位のずれ量の補正は、次のようにして行なう。例えば、図6に示したように、水中航走体10が到達目標点Aを通過して到達目標点Bに向けて航走しているとする。このとき、船首方位演算部68の基準方位演算部90は、目標点記憶部72に記憶させてある複数の到達目標点から第1到達目標点Aの座標(経度、緯度)と第2到達目標点Bの座標とを読み出し、基準航路となる目標点Aから目標点Bに向かうベクトルVABを求め、さらにこのベクトルVABの経度方向Laに対する傾き(基準航路方位)φABを算出し、方位偏差演算部92に送出する。
【0037】
方位偏差演算部92は、基準方位演算部90が求めた基準航路方位φABと、目標点方位演算部76が求めた目標点方位φ0 とが入力するようになっている。すなわち、目標点方位演算部76は、図6に示した水中航走体10の現在位置Cから到達目標点Bに向かうベクトルVCBの方位を求めて方位偏差演算部92に入力する。そして、方位偏差演算部92は、これらの方位の方位偏差φd を次式により算出する。
【数4】
【0038】
この方位偏差演算部92が求めた方位偏差φd は、方位補正量演算部94に送出される。そして、方位補正量演算部94は、図7に示したような方位偏差φd の大きさに応じた船首方位の補正量を演算し、船首方位計算回路96に入力する。すなわち、方位補正量演算部94は、まず、
【数5】
を判断する。ここに、φthは、予め設定してある方位偏差φd の閾値である。
【0039】
方位補正量演算部94は、方位偏差φd の絶対値が閾値φthより小さく、数式5を満足している場合、
【数6】
を算出して船首方位算出回路96に与える。なお、数式6のKtrは、水中航走体10を基準方位(基準航路)に復帰させる場合のゲインである。
【0040】
船首方位算出回路96は、進行方向速度成分演算部80の求めた速度成分のベクトルから算出した船首方位φ0’と、方位補正量演算部94が求めた方位補正量δとに基づいて、補正後の船首方位Φ0 を次式により算出する。
【数7】
【0041】
この補正後の船首方位Φ0 は、操舵制御部70に与えられる。そして、操舵制御部70は、船首方位算出回路96が求めた補正後の船首方位Φ0 に基づいて、図3に示したように、方向舵または水平首振り式推進器などの操舵機構30を制御し、水中航走体10の船首を船首方位Φ0 に向ける。
【0042】
一方、方位補正量演算部94は、方位偏差演算部92の求めた方位偏差φd が数式5を満足せず、
【数8】
である場合、次式により船首方位の補正量δ’を求め、船首方位算出回路96に送出する。
【数9】
【0043】
ただし、
【数10】
である。すなわち、方位偏差量演算部94は、方位偏差φd の絶対値が閾値φth以上となった場合、図7に示してあるように、一定の大きさの補正量Ktrφthを出力する。なお、図7は、横軸が方位偏差を示し、縦軸が船首方位の補正量を示している。
【0044】
このようにして、実施形態においては、水中航走体10の現在位置に対する目標点方位φ0 が基準航路の方位に対してずれたときに、ずれ量に応じた補正量を加味して水中航走体10の船首方位を求めているため、例えば図8に示したように到達目標点Aにおいて水中航走体10が方向転換のために旋回した場合など、水中航走体10を迅速に基準方位に復帰させることができる。
【0045】
なお、水中航走体10が一定の深度を航走している場合に海底の深い領域を通過するときや、海溝部を航走するときなど、ドップラー式超音波速度計40によって水中航走体10の対地速度を検出することができない場合、速度補正部66の進行方向速度成分演算部80は、潮流速度演算部62が求める潮流速度の代わりに、メモリ64の基準潮流記憶部74に記憶させてある気象庁などが公表している潮流速度を用いて進行方向速度成分を算出する。これにより、上記の海底の深い領域であっても、水中航走体10を容易に基準航路に沿って航走させることができる。
【0046】
上記に説明した実施の形態は、本発明の一態様の説明であって、これに限定されない。例えば、ドップラー式超音波速度計40によって水中航走体10の対地速度と対水速度とを求める場合について説明したが、慣性航法装置50が求めた速度を用いてもよい。そして、前記実施形態においては、海中を航走させる場合について説明したが、湖沼の調査などにも適用することができる。
【0047】
【発明の効果】
以上説明したように、本発明によれば、水底に対する水の流れの速度を求め、
航走体の水底に対する速度を水の流れの速度によって補正し、航走の外乱である潮流などの水の流れを相殺して航走体を航走させるようになっているため、予め定めた航路に沿って航走体を航走させることが可能で、重要観測点などを確実に通過させることができる。
【0048】
また、本発明は、航走体が到達目標点において旋回するときなどにおいて、航走体の船首の方位が基準の航路の方位から外れた場合に、外れた量に応じた大きさの船首方位の補正を行なうため、航走体を速やかに基準の航路に復帰させることができる。さらに、海溝などの海底が深く、航走体の対地速度を検出できない場合に、予め与えた基準の水流速度を用いて速度補正を行なうようにしているため、航走対地速度を得られない場所であっても、確実に到達目標点に向けて航走させることができる。
【図面の簡単な説明】
【図1】 本発明の実施形態に係る自律型水中航走体の航走制御装置のブロック図である。
【図2】 本発明の実施形態に係る自律型水中航走体の航走制御装置の概略ブロック図である。
【図3】 本発明の実施形態に係る自律型水中航走体の航走制御装置の動作を説明するフローチャートである。
【図4】 本発明に実施形態に係る自律型水中航走体の航走制御装置における潮流速度の計算処理を説明するための図である。
【図5】 本発明の実施の形態に係る自律型水中航走体の航走制御装置における進行方向速度成分の求め方を説明する図である。
【図6】 本発明の実施形態に係る自律型水中航走体の航走制御装置における方位偏差の求め方を説明する図である。
【図7】 本発明の実施形態に係る自律型水中航走体の航走制御装置における船首方位の補正上の求め方を説明する図である。
【図8】 本発明の実施形態に係る自律型水中航走体の航走制御装置による航走制御したときの水中航走体の航路と、従来の航走制御とによる水中航走体の航路軌跡とを比較する図である。
【符号の説明】
10………水中航走体、20………航走制御装置、30………操舵機構、40………ドップラー式聴音波速度計、42………対地速と検出手段(対地速度検出部)、44………対水速度検出手段(対水速度検出部)、50………位置検出手段(慣性航法装置)、54………加速度センサ、56………航行速度演算部、58………位置演算部、60………制御演算装置、62………潮流速度演算部、64………メモリ、66………速度補正部、68………船首方位演算部、70………操舵制御部、72………目標点記憶部、74………基準潮流記憶部、76………目標点方位演算部、78………目標対地速度演算部、80………進行方向速度成分演算部、82………推進器駆動部、90………基準方位演算部、92………方位偏差演算部、94………方位補正量演算部、96………船首方位算出回路。
Claims (4)
- 水中を航走する航走体の水底に対する速度を検出する対地速度検出手段と、
前記航走体の水に対する速度を検出する対水速度検出手段と、
この対水速度検出手段が検出した前記航走体の対水速度と、前記対地速度検出手段が検出した航走対地速度とに基づいて、前記水底に対する水の流れの速度を求める水流速度演算部と、
前記航走体を到達させる到達目標点に向かう対地速度である目標対地速度を、前記水流速度演算部が求めた水流速度によって補正する速度補正部と、
この速度補正部が求めた補正後の対地速度に基づいて、前記航走体の向きを求める船首方位演算部と、
この船首方位演算部が求めた船首方位に基づいて操舵機構を制御し、前記航走体の先端を前記船首方位に向ける操舵制御部と、
を有し、
前記速度補正部は、
前記航走体の地球座標における位置を検出する位置検出手段の出力信号と前記到達目標点とから、前記航走体に対する前記到達目標点の方位を求める目標点方位演算部と、
この目標点方位演算部が求めた目標点方位と、前記航走体の推進器の駆動情報とに基づいて、前記目標対地速度を求める目標対地速度演算部と、
この目標対地速度演算部が求めた前記目標対地速度に対して前記水流速度を相殺する速度成分を求める進行方向速度成分演算部と、
を有することを特徴とする自律型水中航走体の航走制御装置。 - 請求項1に記載の自律型水中航走体の航走制御装置において、
前記速度補正部は、前記対地速度検出手段が前記航走対地速度を検出できないときに、予め与えられた基準水流速度を用いて前記補正後の対地速度を求めることを特徴とする自律型水中航走体の航走制御装置。 - 水中を航走する航走体の水底に対する速度を検出する対地速度検出手段と、
前記航走体の水に対する速度を検出する対水速度検出手段と、
この対水速度検出手段が検出した前記航走体の対水速度と、前記対地速度検出手段が検出した航走対地速度とに基づいて、前記水底に対する水の流れの速度を求める水流速度演算部と、
前記航走体を到達させる到達目標点に向かう対地速度である目標対地速度を、前記水流速度演算部が求めた水流速度によって補正する速度補正部と、
この速度補正部が求めた補正後の対地速度に基づいて、前記航走体の向きを求める船首方位演算部と、
この船首方位演算部が求めた船首方位に基づいて操舵機構を制御し、前記航走体の先端を前記船首方位に向ける操舵制御部と、
を有し、
前記速度補正部は、前記対地速度検出手段が前記航走対地速度を検出できないときに、予め与えられた基準水流速度を用いて前記補正後の対地速度を求めることを特徴とする自律型水中航走体の航走制御装置。 - 請求項1に記載の自律型水中航走体の航走制御装置において、
前記船首方位演算部は、
前記進行方向速度成分演算部が求めた前記航走体の進行方向の速度成分に基づいて、前記船首方位を算出する船首方位算出回路と、
前記航走体が通過した第1到達目標点に対する航走体が向かう第2到達目標点の方位を基準方位として求める基準方位演算部と、
この基準方位演算部が求めた基準方位と、前記目標点方位演算部が求めた目標点方位との偏差を求める方位偏差演算部と、
この方位偏差演算部が求めた方位の偏差の大きさに応じて前記航走体の船首方位の補正量を求めて前記船首方位算出回路に与える方位補正量演算部と、
を有し、
前記速度補正部は、前記対地速度検出手段が前記航走対地速度を検出できないときに、予め与えられた基準水流速度を用いて前記補正後の対地速度を求めることを特徴とする自律型水中航走体の航走制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001332809A JP3949932B2 (ja) | 2001-10-30 | 2001-10-30 | 自律型水中航走体の航走制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001332809A JP3949932B2 (ja) | 2001-10-30 | 2001-10-30 | 自律型水中航走体の航走制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2003127983A JP2003127983A (ja) | 2003-05-08 |
JP3949932B2 true JP3949932B2 (ja) | 2007-07-25 |
Family
ID=19148175
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001332809A Expired - Fee Related JP3949932B2 (ja) | 2001-10-30 | 2001-10-30 | 自律型水中航走体の航走制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3949932B2 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105842474A (zh) * | 2016-03-16 | 2016-08-10 | 哈尔滨工程大学 | 一种适用于微小型uuv的组合测速系统 |
CN107544527A (zh) * | 2017-10-23 | 2018-01-05 | 西北工业大学 | 一种用于小型水下航行器的推进器转速转向控制装置 |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4563209B2 (ja) * | 2005-02-18 | 2010-10-13 | 株式会社日立製作所 | 水中航走体の位置姿勢制御装置及び位置姿勢制御方法 |
JP4746349B2 (ja) * | 2005-05-18 | 2011-08-10 | 日本電信電話株式会社 | ロボット行動選択装置及びロボット行動選択方法 |
FR2901364B1 (fr) * | 2006-05-16 | 2008-08-22 | Ixsea Soc Par Actions Simplifi | Systeme d'imagerie sonar a ouverture synthetique |
JP4884303B2 (ja) * | 2007-06-04 | 2012-02-29 | 株式会社日立製作所 | 水中移動体制御システム |
JP5049726B2 (ja) * | 2007-10-11 | 2012-10-17 | 日本無線株式会社 | 潮流測定装置 |
JP5221097B2 (ja) * | 2007-10-11 | 2013-06-26 | 日本無線株式会社 | 潮流測定装置 |
CN103017755B (zh) * | 2012-11-26 | 2016-01-27 | 哈尔滨工程大学 | 一种水下导航姿态测量方法 |
JP6340067B2 (ja) * | 2014-02-25 | 2018-06-06 | 古野電気株式会社 | 表層流推定装置、表層流推定システム、海洋モデル推定装置、及び危険度判定装置 |
JP2016102785A (ja) * | 2014-11-12 | 2016-06-02 | 国立大学法人京都大学 | 流速計測システムおよびプログラム |
JP6761216B2 (ja) | 2015-12-09 | 2020-09-23 | 国立研究開発法人 海上・港湾・航空技術研究所 | 水中航走体の経路設定方法、それを用いた水中航走体の最適制御方法及び水中航走体並びに移動体の経路設定方法 |
CN107065860B (zh) * | 2017-02-24 | 2020-12-22 | 华南理工大学 | 一种面向渔业捕捞的无人船群协同自组织作业系统及方法 |
JP6977440B2 (ja) * | 2017-09-20 | 2021-12-08 | 株式会社Ihi | 水中移動体の制御システム |
KR102112098B1 (ko) * | 2018-01-24 | 2020-05-18 | 경남대학교 산학협력단 | 해양운항체의 자율운항시스템 및 그 방법 |
CN109739249B (zh) * | 2018-09-06 | 2022-04-19 | 中国船舶工业系统工程研究院 | 一种速度状态缺失条件下的多uuv编队协调控制方法 |
JP7235573B2 (ja) * | 2019-04-09 | 2023-03-08 | 三菱重工業株式会社 | 航走体制御システム及び航走体制御方法 |
KR102422561B1 (ko) * | 2020-09-15 | 2022-07-20 | 엘아이지넥스원 주식회사 | 무인잠수정의 경로 제어 장치 및 방법 |
CN112214023B (zh) * | 2020-10-14 | 2021-05-14 | 哈尔滨工程大学 | 考虑波浪推进的自然能驱动无人艇的航线实时优化方法及航行方法 |
CN112014589B (zh) * | 2020-10-19 | 2021-01-12 | 德阳旌卫环保工程有限公司 | 一种智能流速测量装置及河流流量测量方法 |
-
2001
- 2001-10-30 JP JP2001332809A patent/JP3949932B2/ja not_active Expired - Fee Related
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105842474A (zh) * | 2016-03-16 | 2016-08-10 | 哈尔滨工程大学 | 一种适用于微小型uuv的组合测速系统 |
CN105842474B (zh) * | 2016-03-16 | 2018-10-09 | 哈尔滨工程大学 | 一种适用于微小型uuv的组合测速系统 |
CN107544527A (zh) * | 2017-10-23 | 2018-01-05 | 西北工业大学 | 一种用于小型水下航行器的推进器转速转向控制装置 |
CN107544527B (zh) * | 2017-10-23 | 2020-07-14 | 西北工业大学 | 一种用于小型水下航行器的推进器转速转向控制装置 |
Also Published As
Publication number | Publication date |
---|---|
JP2003127983A (ja) | 2003-05-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3949932B2 (ja) | 自律型水中航走体の航走制御装置 | |
US8442710B2 (en) | Method for the computer-supported control of a ship | |
US9223002B2 (en) | System and method for determining the position of an underwater vehicle | |
JPH08249060A (ja) | 自律型水中航走装置 | |
JP2017105306A (ja) | 水中航走体の経路設定方法、それを用いた水中航走体の最適制御方法及び水中航走体並びに移動体の経路設定方法 | |
KR20230011310A (ko) | 선박의 자동 유도 방법, 선박의 자동 유도 프로그램, 선박의 자동 유도 시스템 및 선박 | |
EP3015940B1 (en) | Position-locking for a watercraft using an auxiliary water vessel | |
EP3696078B1 (en) | A method and system for piloting an unmanned surface vessel | |
KR102467138B1 (ko) | 운항체의 자율운항시스템 및 그 제어방법 | |
US11862026B2 (en) | Marine propulsion control system and method with proximity-based velocity limiting | |
KR102617980B1 (ko) | 기상상황이 반영된 자율운항선박의 접이안 시스템 | |
EP0772787B1 (en) | A system for underwater survey operations | |
JPWO2020111044A1 (ja) | 制御目標生成装置及び操船制御装置 | |
JP2006248477A (ja) | 水中航走体の航走制御方法及び水中航走体 | |
JP2001247085A (ja) | 潜水機による深浅計測方法 | |
JP6946865B2 (ja) | 航走制御装置及び航走制御方法 | |
JP6733416B2 (ja) | 水中航走体監視装置および水中航走体監視方法 | |
KR102617988B1 (ko) | 어라운드 뷰를 이용한 자율운항선박의 접이안 시스템 | |
RU2735694C1 (ru) | Способ натурных испытаний безэкипажных судов | |
JP2528833B2 (ja) | 接岸制御装置 | |
Itoh et al. | Development of an underwater robot for detecting shallow water in a port | |
JP6977440B2 (ja) | 水中移動体の制御システム | |
JP3999976B2 (ja) | 操船方法及び装置 | |
US12091141B2 (en) | System for determining automatic docking is complete by collision | |
JP7083049B1 (ja) | 接舷支援システムおよび接舷支援方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040916 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060809 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060829 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061023 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20070409 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070419 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 3949932 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110427 Year of fee payment: 4 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130427 Year of fee payment: 6 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130427 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140427 Year of fee payment: 7 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313115 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
LAPS | Cancellation because of no payment of annual fees |