JP3863043B2 - 水中航走体における位置検出方法 - Google Patents
水中航走体における位置検出方法 Download PDFInfo
- Publication number
- JP3863043B2 JP3863043B2 JP2002081617A JP2002081617A JP3863043B2 JP 3863043 B2 JP3863043 B2 JP 3863043B2 JP 2002081617 A JP2002081617 A JP 2002081617A JP 2002081617 A JP2002081617 A JP 2002081617A JP 3863043 B2 JP3863043 B2 JP 3863043B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- screw
- underwater vehicle
- calculator
- error
- 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 - Lifetime
Links
Images
Description
【発明の属する技術分野】
本発明は、水中航走体における位置検出方法に関し、特に、高精度な慣性航法装置又はドップラーソーナー等を用いることなく、中精度程度の慣性航法装置とスクリュウからなる比較的安価な設備のみを用いて水中航走体の位置を高精度に検出するための新規な改良に関する。
【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】
【0008】
従って、本発明において推定する変数は、前記スクリュウ速度誤差と潮流速度成分と前記慣性航法装置の変数で次の数2の(2)、(3)及び(4)式の通りである。
【0009】
【数2】
【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 慣性航法装置
Claims (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)に各々帰還されて制御され、
前記潮流を前記水中航走体の主軸方向と慣性座標方向に分け、前記水中航走体の主軸方向の潮流は前記スクリュウ速度のスクリュウ速度誤差に含めて推定することを特徴とする水中航走体における位置検出方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002081617A JP3863043B2 (ja) | 2002-03-22 | 2002-03-22 | 水中航走体における位置検出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002081617A JP3863043B2 (ja) | 2002-03-22 | 2002-03-22 | 水中航走体における位置検出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2003279374A JP2003279374A (ja) | 2003-10-02 |
JP3863043B2 true JP3863043B2 (ja) | 2006-12-27 |
Family
ID=29230180
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002081617A Expired - Lifetime JP3863043B2 (ja) | 2002-03-22 | 2002-03-22 | 水中航走体における位置検出方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3863043B2 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102495645B (zh) * | 2011-11-28 | 2013-08-28 | 西北工业大学 | 一种用于高速滚转载体的陀螺稳定平台及其控制方法 |
CN103017755B (zh) * | 2012-11-26 | 2016-01-27 | 哈尔滨工程大学 | 一种水下导航姿态测量方法 |
CN103411603B (zh) * | 2013-07-22 | 2015-08-05 | 中国人民解放军92537部队 | 船舶电场防护中电场传感器姿态位置测量方法 |
-
2002
- 2002-03-22 JP JP2002081617A patent/JP3863043B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JP2003279374A (ja) | 2003-10-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109324330B (zh) | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 | |
CN109737956B (zh) | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 | |
CN107588769B (zh) | 一种车载捷联惯导、里程计及高程计组合导航方法 | |
CN107990891B (zh) | 基于长基线和信标在线标定的水下机器人组合导航方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
EP1510832A1 (en) | GPS/dead reckoning combination system and operating method thereof | |
WO2014070683A1 (en) | System and method for water column aided navigation | |
CN106679662A (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
CN111982105B (zh) | 一种基于sins/lbl紧组合的水下导航定位方法及系统 | |
CN104280024B (zh) | 一种深水机器人组合导航装置和方法 | |
CN109387198B (zh) | 一种基于序贯检测的惯性/视觉里程计组合导航方法 | |
Lee et al. | An integrated navigation system for autonomous underwater vehicles with two range sonars, inertial sensors and Doppler velocity log | |
CN112197765B (zh) | 一种实现水下机器人精细导航的方法 | |
CN110873813B (zh) | 一种水流速度估算方法、组合导航方法及装置 | |
US8566055B1 (en) | Gyro indexing compensation method and system | |
JP3863043B2 (ja) | 水中航走体における位置検出方法 | |
JP3935828B2 (ja) | 航海支援装置及び航海支援システム | |
RU2539131C1 (ru) | Бесплатформенная интегрированная навигационная система средней точности для мобильного наземного объекта | |
JP4343581B2 (ja) | 移動体の姿勢検出装置 | |
CN111736195B (zh) | 一种水下智能脐带缆定位系统及对潜水员进行定位的方法 | |
CN112924999B (zh) | 一种无人机的定位方法、系统、装置及介质 | |
CN109737950B (zh) | 基于vio和动力学模型的水下机器人定位系统及方法 | |
KR20170091199A (ko) | Ins 및 gps를 이용한 무인 자동차 제어 장치 및 방법 | |
CN111964684A (zh) | 一种基于sins/lbl紧组合的水下导航混合定位方法及系统 | |
CN112325770B (zh) | 一种车端单目视觉测量相对精度置信度评估方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20050519 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050531 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050720 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060627 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060817 |
|
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: 20060919 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20060927 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 3863043 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
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 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091006 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101006 Year of fee payment: 4 |
|
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: 20111006 Year of fee payment: 5 |
|
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: 20111006 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121006 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: 20121006 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131006 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 |
|
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 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
EXPY | Cancellation because of completion of term |