Top > Search of Japanese Patents > METHOD OF DETECTING POSITION OF UNDERWATER SAILING BODY > Specification

Specification :(In Japanese)水中航走体における位置検出方法

Country (In Japanese)日本国特許庁(JP)
Gazette (In Japanese)特許公報(B2)
Patent Number P3863043
Publication number P2003-279374A
Date of registration Oct 6, 2006
Date of issue Dec 27, 2006
Date of publication of application Oct 2, 2003
Title of the invention, or title of the device (In Japanese)水中航走体における位置検出方法
IPC (International Patent Classification) G01C  21/16        (2006.01)
B63H  25/04        (2006.01)
FI (File Index) G01C 21/16 Z
B63H 25/04 C
Number of claims or invention 1
Total pages 6
Application Number P2002-081617
Date of filing Mar 22, 2002
Date of request for substantive examination Mar 25, 2002
Patentee, or owner of utility model right (In Japanese)【識別番号】390014306
【氏名又は名称】防衛庁技術研究本部長
【識別番号】000203634
【氏名又は名称】多摩川精機株式会社
Inventor, or creator of device (In Japanese)【氏名】篠原 研司
【氏名】山下 貴裕
【氏名】熊谷 秀夫
Representative (In Japanese)【識別番号】100057874、【弁理士】、【氏名又は名称】曾我 道照
【識別番号】100110423、【弁理士】、【氏名又は名称】曾我 道治
【識別番号】100071629、【弁理士】、【氏名又は名称】池谷 豊
【識別番号】100084010、【弁理士】、【氏名又は名称】古川 秀利
【識別番号】100094695、【弁理士】、【氏名又は名称】鈴木 憲七
【識別番号】100111648、【弁理士】、【氏名又は名称】梶並 順
【識別番号】100109287、【弁理士】、【氏名又は名称】白石 泰三
【識別番号】100116953、【弁理士】、【氏名又は名称】中村 礼
Examiner (In Japanese)【審査官】本庄 亮太郎
Document or reference (In Japanese)特開平07-234235(JP,A)
特開昭59-056108(JP,A)
特開平06-317428(JP,A)
特開昭62-283099(JP,A)
Field of search G01C 21/16
B63H 25/04
Scope of claims (In Japanese)【請求項1】
水中航走体のスクリュウのスクリュウ速度(13)及び角速度計(11A)と加速度計(12A)とストラップダウン演算部(14)とからなる慣性航法装置(30)の速度信号(14a)に基づき、水流に含まれる少なくとも潮流の速度成分、前記スクリュウに含まれる少なくともスリップの速度成分及び前記慣性航法装置(30)に含まれる誤差速度成分を推定し、前記水中航走体の位置を検出するようにした水中航走体における位置検出方法において、
前記慣性航法装置(30)からの角速度信号(11)と加速度信号(12)が前記ストラップダウン演算部(14)でストラップダウン演算されて前記速度信号(14a)が得られ、
前記速度信号(14a)は前記ストラップダウン演算部(14)に接続された速度演算部(15)で演算された後に位置演算部(16)に入力され、
前記スクリュウ速度(13)はスクリュウ潮流演算部(17)にて誤差補正された後に前記速度信号(14a)と比較器(18)比較され、前記比較器(18)で検出された差(18a)がカルマンフィルター(10)に観測値として入力され、
前記カルマンフィルター(10)から演算された速度誤差(10a)は前記速度演算部(15)に、姿勢誤差(10b)は前記ストラップダウン演算部(14)に、ジャイロバイアス(10c)は前記角速度信号(11)に、加速度バイアス(10d)は前記加速度信号(12)に、スクリュウ/潮流誤差(10e)は前記スクリュウ潮流演算部(17)に、位置/方位誤差(10f)は前記位置演算部(16)に各々帰還されて制御され、
前記潮流を前記水中航走体の主軸方向と慣性座標方向に分け、前記水中航走体の主軸方向の潮流は前記スクリュウ速度のスクリュウ速度誤差に含めて推定することを特徴とする水中航走体における位置検出方法。
Detailed description of the invention (In Japanese)
【0001】
【発明の属する技術分野】
本発明は、水中航走体における位置検出方法に関し、特に、高精度な慣性航法装置又はドップラーソーナー等を用いることなく、中精度程度の慣性航法装置とスクリュウからなる比較的安価な設備のみを用いて水中航走体の位置を高精度に検出するための新規な改良に関する。
【0002】
【従来の技術】
従来、用いられていたこの種の水中航走体における位置検出方法としては、一般に2種類の方法が行われてきた。
すなわち、第1従来例としては、水中航走体の姿勢及び方位のみを検出し、特にはその位置精度に言及しない方法であり、例えば、ワイヤーで地上と通信し、カメラ画像を地上で認知することによって検出を行う方法である。
第2従来例としては、この第1従来例よりも位置計測に主眼を置いた方法である。すなわち、高精度な慣性航法装置を用いる潜水艦か、又は、ドップラーソーナーにより対地(海底)速度を検出し、慣性航法装置と共に位置の計測を行う方法である。
【0003】
【発明が解決しようとする課題】
従来の水中航走体における位置検出方法は、以上のように構成されていたため、次のような課題が存在していた。
すなわち、第1従来例の場合、ワイヤーによって水中と地上とを連結し、カメラ画像の認知で行っているため、位置検出精度は限られたものであると共に、ワイヤーの使用により水中航走体の移動範囲が極めて限られることになっていた。
また、第2従来例の場合、極めて高精度な慣性航法装置を用いると、装置自体が極めて高価でかつ大型となり、小型の水中航走体には適用が不可能であった。
また、ドップラーソーナーによる方法の場合には、ドップラーソーナーの音波の届く範囲の海域での運用を前提としているため、運用制限を受けることが多く、自由に用いることは不可能であった。
【0004】
本発明は、以上のような課題を解決するためになされたもので、特に、高精度な慣性航法装置又はドップラーソーナー等を用いることなく、中精度程度の慣性航法装置とスクリュウからなる比較的安価な設備のみを用いて水中航走体の位置を高精度に検出するようにした水中航走体における位置検出方法を提供することを目的とする。
【0005】
【課題を解決するための手段】
本発明による水中航走体における位置検出方法は、水中航走体のスクリュウのスクリュウ速度及び角速度計と加速度計とストラップダウン演算部とからなる慣性航法装置の速度信号に基づき、水流に含まれる少なくとも潮流の速度成分、前記スクリュウに含まれる少なくともスリップの速度成分及び前記慣性航法装置に含まれる誤差速度成分を推定し、前記水中航走体の位置を検出するようにした水中航走体における位置検出方法において、前記慣性航法装置からの角速度信号と加速度信号が前記ストラップダウン演算部でストラップダウン演算されて前記速度信号が得られ、前記速度信号は前記ストラップダウン演算部に接続された速度演算部で演算された後に位置演算部に入力され、前記スクリュウ速度はスクリュウ潮流演算部にて誤差補正された後に前記速度信号と比較器比較され、前記比較器で検出された差がカルマンフィルターに観測値として入力され、前記カルマンフィルターから演算された速度誤差は前記速度演算部に、姿勢誤差は前記ストラップダウン演算部に、ジャイロバイアスは前記角速度信号に、加速度バイアスは前記加速度信号に、スクリュウ/潮流誤差は前記スクリュウ潮流演算部に、位置/方位誤差は前記位置演算部に各々帰還されて制御され、前記潮流を前記水中航走体の主軸方向と慣性座標方向に分け、前記水中航走体の主軸方向の潮流は前記スクリュウ速度のスクリュウ速度誤差に含めて推定する方法である。
【0006】
【発明の実施の形態】
以下、図面と共に本発明による水中航走体における位置検出方法の好適な実施の形態について説明する。
まず、図1においては本発明による水中航走体における位置検出方法の概念的な説明を行う。まず、図1における符号N、Eは、緯度・経度を基準にした慣性座標であり、Xc,Yc,Zcは、真北からαだけ偏角した慣性航法装置の計算の基準となる慣性座標である。また、Xb,Yb,Zbは、XcからYαw角だけ偏角した図示しない水中航走体の基準座標である。
また、Vstは、真のスクリュウ速度であり、スクリュウ速度誤差εsを導入することで検出されたスクリュウ速度Vsとの間に以下の関係が成り立つ。
Vst=(1+εs)Vs
今、これらの慣性空間にVcと云う潮流が存在したとすると、前記水中航走体の移動方向は、
Vt=Vst+Vc
と表現される。Vtは、真の水中航走体の速度である。本発明は、未知の変数 εs(スクリュウ速度誤差),Vc(潮流速度成分)さらには、慣性航法装置の本質的速度誤差δVbx,δVbyをそれぞれ推定するのではなく、潮流Vcを水中航走体の主軸方向と慣性座標Yc方向に分け、水中航走体の主軸方向の潮流はスクリュウ速度誤差に含めて推定することを特徴とする。これは、潮流という変数の特性が、慣性航法装置の速度誤差の特性と似ているために分離した変数として処理することが難しいことに起因する。この操作によって真の速度に関する運動方程式は次の数1の(1)式のように記述できる。
【0007】
【数1】
JP0003863043B2_000002t.gif
【0008】
従って、本発明において推定する変数は、前記スクリュウ速度誤差と潮流速度成分と前記慣性航法装置の変数で次の数2の(2)、(3)及び(4)式の通りである。
【0009】
【数2】
JP0003863043B2_000003t.gif
【0010】
図2は本発明による位置検出方法を示す実施例としてのブロック図である。
図2において、入力データとしては3軸の角速度計11Aからの角速度信号11と3軸の加速度計12Aからの加速度信号12並びにスクリュウの速度を検出したスクリュウ速度13である。
前記角速度信号11と加速度信号12は、初期値を用いてストラップダウン演算部14でストラップダウン演算され、姿勢と速度が演算される。尚、前述の角速度計11A、加速度計12A及びストラップダウン演算部14により慣性航法装置30を構成している。
この速度を表す速度信号14aは速度演算部15で演算されて位置演算部16に入力されている。前記スクリュウ速度13は、スクリュウ潮流演算部17にて誤差補正された後に、前記速度演算部15からすなわち慣性航法装置30からの速度と比較器18比較され、この比較器18で検出された差18aがカルマンフィルター10の観測値としてフィルター演算動作に入力される。
【0011】
前記カルマンフィルター10におけるフィルター演算では、その状態変数の分散値を用いて、逐次、状態量を推定し、次の観測量に帰還入力されている。
従って、カルマンフィルター10から演算された速度誤差10aは速度演算部15に、姿勢誤差10bはストラップダウン演算部14に、ジャイロバイアス10cは角速度信号11に、加速度バイアス10dは加速度信号12に、スクリュウ/潮流誤差10eはスクリュウ潮流演算部17に、位置/方位誤差10fは位置演算部16に、各々帰還されて制御されている。
前記カルマンフィルター10のフィルター演算では、その状態変数の分散値の初期値を用いて、逐次状態量を推定し、次の観測量に帰還入力されている。
尚、前述のスクリュウに含まれるスリップの速度成分については、前記スクリュウ速度誤差は前記スリップの速度成分のことである。
【0012】
【発明の効果】
本発明による水中航走体における位置検出方法は、以上のように構成されているため、次のような効果を得ることができる。
すなわち、スクリュウのスクリュウ速度と慣性航法装置の速度信号に基づき、スクリュウ速度に含まれるスリップ並びに潮流、さらに慣性座標の任意方向に含まれる本質的誤差が推定され、結果として高精度な位置を計測することができる。
【図面の簡単な説明】
【図1】本発明による水中航走体における位置検出方法の概念を示す説明図である。
【図2】本発明による水中航走体における位置検出方法を示すブロック図である。
【符号の説明】
13 スクリュウ速度
14a 速度信号
30 慣性航法装置
Drawing
(In Japanese)【図1】
0
(In Japanese)【図2】
1