JPS5956107A - 航法装置 - Google Patents

航法装置

Info

Publication number
JPS5956107A
JPS5956107A JP16737382A JP16737382A JPS5956107A JP S5956107 A JPS5956107 A JP S5956107A JP 16737382 A JP16737382 A JP 16737382A JP 16737382 A JP16737382 A JP 16737382A JP S5956107 A JPS5956107 A JP S5956107A
Authority
JP
Japan
Prior art keywords
speed
water
ship
water speed
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.)
Pending
Application number
JP16737382A
Other languages
English (en)
Inventor
Takashi Morimoto
隆 森本
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yokogawa Electric Corp
Original Assignee
Yokogawa Hokushin Electric Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yokogawa Hokushin Electric Corp filed Critical Yokogawa Hokushin Electric Corp
Priority to JP16737382A priority Critical patent/JPS5956107A/ja
Publication of JPS5956107A publication Critical patent/JPS5956107A/ja
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 この発明は対水速度信号及び方位信号とから測位計算を
行う航法装置に関する。
〈従来技術〉 従来のこの種の航法装置は第1図に示すように、船首尾
軸方向(この説明ではX一方向、船のロール軸)に取り
付けられた電磁速度計のような対水速度センサ11によ
り船首尾軸方向の船速度を検出して推測航法計算部12
に供給される。一方ジャイロコンパス13よ沙の方位角
信号も推測航法計算部12に供給され、推測航法計算部
12で前記船速度は北方向成分と東方向成分とに分解さ
れる。これら各成分はそれぞれ積分されて船の位置が計
算される。この測位計算結果は位置信号14として出力
される。また北方向、東方向に分解された速度信号は人
工衛星による測位装置、いわゆるNN5S位置センサ受
信装置15に入力され、船の移動速度補正に用いられる
。NN5S位置センザ受1言装置15は位置リセット信
号に用いられるが、このリセットは1時間毎にしか行わ
れない。このため対水速度センサのバイアス誤差、潮流
、ジャイロコンパス13の誤差等による測位誤差がこの
1時間の間に増大してしまう。
この増大を押えるためにロラン−C受信装置16よりの
位置信号をNN5S位置センサ受信装置15の位置信号
と同様に位置リセット信号として用いている。しかしロ
ラン−C受信装置16による位置信号も、時間の経過と
ともに誤差が増大する。この位置誤差の増大を押えるの
はNN5S位置センザ受信装置15の位置リセット信号
の役目である。しかしこの位置リセット信号は1時間毎
であって時間間隔が比較的長い。まだNN5S位置信号
が受1言された時、この信号と推測位置信号との差を1
時間で割った値を、対水速度センサ11の誤差、 i?
I]流速度、更にジャイロコンパスの誤差等の総合平均
速度誤差として平均速度誤差計算部17で計算し、次の
1時間の時間帯での速度修正信号として推測航法計算部
12へ供給している。
この従来の航法装置は次の欠点があった。即ちロラン−
Cの信号、 NN5Sの信号はあくまで位置リセット信
号として用いられているだめに、潮流の父化、風、波浪
、船の運動変化等の外乱入力が6111位誤差へ大きく
影響している。更に最大1時間前の平均速度誤差を用い
て次の1時間の速度誤差を修正しているだめ、次の1時
間の速度誤差の特性(極性)が変化した時の影昏が測位
誤差を発生する。またこの特性変化は例えば第2図に示
すように、潮流の方向変化により測位誤差ΔPが生じ、
また船の旋回の影響により誤差の傾向が大きく変化する
。第2図において時間軸上のIH、2HでNN5S位置
リセットされることを示している。またロラン−Cの信
号を連続的に取シ込む必要があった。
更にこの航法装置はオーブンループで構成されているた
め、ロラン−C信号、NN5S位置信号、対水速度セン
サ、ジャイロコンパス、潮流の各誤差の周波数成分およ
び不規則成分をP波する能力がなかつことにより測位誤
差が大きくなった。
従来においては、先に述べたように対水速度センサは船
首尾軸方向の速度を検出するのみであるだめ、潮流や風
などにより、船が首尾軸方向に進まず多少ずれた方向に
進む場合、この横流れ速度は対水速度センサ11では検
出されない。このため大きな測位誤差が発生した。
〈発明の概要〉 この発明の目的は、潮流や風などによる横流れによる誤
差を伴うことなく、正しく位置を演算することができる
航法装置を提供することにある。
この発明によれば、船のピッチ軸方向の対水速度Vyを
も検出する速度センサを設ける。この速度号と、船首尾
軸方向の速度vXと、方位角ψとから北方向速度VN 
、東方向速度VEを次により演算する。
VN = vXcas F −Vy sinψVE ”
” VXsinψ+VXcosFこれらvN、 VEを
積分して航法計算を行う。
このようにピッチ軸方向の速度を検出してその影響を考
慮しているため、横流れによる誤差を除去することがで
きる。
〈実施例〉 第3図は、この発明による航法装置の一例を示し、第1
図と対応する部分に同一符号を付けである。この発明の
詳細な説明する前に、この発明を適用して好ましい航法
装置の概要を先ず説明する。
対水速度センサ11から船首尾軸方向(ロール軸方向)
の対水速度が検出されると共に、対水速度センサ18か
ら船のピッチ軸方向の対水速度(潮流。
風等による横流れ速度成分)が検出され、これら対水速
度は推測航法計算部12に供給される。ジャイロコンパ
ス13からの方位角信号も推測航法計算部12へ供給さ
れ、対水速度の北方向速度成分と東方向速度成分とが計
算される。これら速度成分はそれぞれ積分されて船の測
位決定が行われる。この推測位置と、ロラン−C受信機
16およびNN5S位置センサ受信機15からの各位置
信号とがその位置信号が得られるごとに位置比較計算部
19で比較される。その比較結果の信号は予測推定計算
部21で沢波されて、前記比較出力中に埋もれている対
水速度センサ11 、18のバイアス誤差、ジャイロコ
ンパス13の誤差、潮流速度などがそれぞれ推定され、
更に位置誤差が推定される。この位置誤差推定値より位
置誤差制御量が制御量計算部22で計算され、その位置
誤差制御量は推測航法計算部12に帰逮される。
この推定は下記式で表現される。
ここで、 y=AX+v  −+ 9=A9    −−(2)X −−−=FX 十GW十BU           ・
・  ・(3)t Xは推定すべき誤差パラメータ、yはロラン−C受信機
16やNN5S位置センサ受信機15の観ホ1]データ
、Uは制御量でu−4である。交はXの推定値、■は観
測雑音でへはその分散、Wは/ステム入力雑音でσゆは
予測誤差(x−交、>の分散である4、F、A、G、B
は定数である。
ロラン−C受信機16はほとんと連続的にデータを受信
できるが、この発明で1は予測計算機能を有しているた
め、データは30秒〜数分間隔で取り込めば充分である
。そしてNN5S位置センサ受信機15からのデータが
1時間毎に受信されるたびに、ロラン−C受信機16で
得られた位置信号のドリフトがロラン−C補正計算部2
3で推定し補正される。
観測データ間の予測式は次式である。
△ U=−KXp             ・・・・・・
・・・・・・(5)Kは定数である。
この予測区間決定は船の力学的環境で決められる。例え
ば7ノツト程度の巡航で、波も静かな状態では5分〜1
0分程度のロランデータ受信で充分で、予測区間は10
分間となる。
以上のように誤差の推定計算を例えば比較的簡単なデジ
タル計算機により行うことにより高い精度の測位が可能
となるが、この発明では特に船首尾軸方向と水平面内で
直角な方向、いわゆるピッチ軸方向の対水速度センサ1
8をも装備して、直進中の潮流、風等による横流れ速度
、更には旋回中における横流れ速度を検出して、船の真
の北方向。
東方向の各対地速度を計算する。これによってあらゆる
海域で高精度な測位決定を行うことを可能とする。
対水速度センサ11が検出した船首尾軸方向速度Vxと
、対水速度センサ18が検出した船のピッチ軸方向速度
■と、北方向速度VNと、東方向速度VEと船の速度V
Sと、ジャイロコンパス1.3が検出した方位角Wとの
関係は第4図に示す関係となる。従って北方向、東方向
の速度計算式は下記で表わされる。
VN = VxcosF−Vys= F       
−・叩−−−(6)VE = VXSIII ’l’ 
+ VXcO5F        ・””・”””・−
(7)VX = V3 cosα、vy=vs画αでα
が横流れ角である。
横流れが存在しないときは号−oで(α=o)y方向対
水速度センサ18の出力は零となる。
このようにして横流れも考慮して船の北方向速度、東方
向速度が演算され、これらを積分することにより高精度
な測位が可能となる。
く効果〉 以上のようにこの発明の航法装置によれば、直進中の潮
流、風等による横流れ津度誤差による測位誤差の発生を
防ぐことができる。また旋回中の横流れ速度誤差による
測位誤差の発生を防ぐことができる。このため例えば従
来装置において、第2図に示したような測位誤差の傾向
に対して、この発明の適用により第5図に実線で示すよ
うに旋回中の誤差の傾向が増大せず、また潮流による誤
差ΔPが除去される。第5図中点線で第2図の曲線を比
較のために示した。
更にこの発明の航法装置によれば、あらゆる船の運動に
も使用でき、またあらゆる海域でも使用可能である。第
3図に示した実施例のように、補正演算を行うことによ
って高精度測位が可能となる0 なお、この発明は第1図に示した従来装置にも通用でき
る。また対水速度センサ11 、18としては、電磁速
度計(いわゆる電磁ログ)のみならず音波を利用した速
度計、その他の速度計でもよく、更に速度検出は加速度
を検出し、その加速度を積分して求めてもよい。壕だ1
つの速度計あるいは可速度計でX方向、Y方向の両速度
を検出してもよい。
【図面の簡単な説明】
第1図は従来の航法装置を示すブロック図、第2図は従
来の航法装置の測位誤差の傾向を示す図、第3図はこの
発明による航法装置の一例を示すブロック図、第4図は
各種速度成分の関係を示す図、第5図は第3図に示した
航法装置の測位誤差の傾向を示す図である。 11:航首尾軸用対水速度セ/ザ、12:推測航法計算
部、13:ジャイロコンパス、15:衛星航法位置セン
サ受信機、18:ビノテ軸用対水速度センサ。 特許出願人  株式会社北辰電機製作所代理人 草野 
卓 す 3 図 1ク オ 4 図 15 図

Claims (1)

    【特許請求の範囲】
  1. (1)船の対水速度を検出し、その速度の北方向成分と
    東方向成分とを計算し、これら北方向速度成分と、東方
    向速度成分とをそれぞれ積分して自船の位置を計算する
    航法装置において、船首尾軸方向の対水速度Vヶを検出
    する第1速度センサと、ピッチ軸方向の対水速度■、を
    検出する第2速度セ/すと、これら速度V、 、vyと
    方位信号ψとから上記北方向速度成分V、、東方向速度
    成分■Eとして、 VN = VX cosψ−Vy sin FVE =
     Vxsin ’l” 十VX CO”φを演算する手
    段とを設けたことを特徴とする航法装置。
JP16737382A 1982-09-24 1982-09-24 航法装置 Pending JPS5956107A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP16737382A JPS5956107A (ja) 1982-09-24 1982-09-24 航法装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP16737382A JPS5956107A (ja) 1982-09-24 1982-09-24 航法装置

Publications (1)

Publication Number Publication Date
JPS5956107A true JPS5956107A (ja) 1984-03-31

Family

ID=15848506

Family Applications (1)

Application Number Title Priority Date Filing Date
JP16737382A Pending JPS5956107A (ja) 1982-09-24 1982-09-24 航法装置

Country Status (1)

Country Link
JP (1) JPS5956107A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5452216A (en) * 1993-08-02 1995-09-19 Mounce; George R. Microprocessor-based navigational aid system with external electronic correction
CN102721418A (zh) * 2012-06-20 2012-10-10 惠州市德赛西威汽车电子有限公司 一种基于航位推算技术的车载定位系统

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5452216A (en) * 1993-08-02 1995-09-19 Mounce; George R. Microprocessor-based navigational aid system with external electronic correction
CN102721418A (zh) * 2012-06-20 2012-10-10 惠州市德赛西威汽车电子有限公司 一种基于航位推算技术的车载定位系统

Similar Documents

Publication Publication Date Title
WO2020062791A1 (zh) 一种深海潜航器的sins/dvl水下抗晃动对准方法
US11754400B2 (en) Motion constraint-aided underwater integrated navigation method employing improved Sage-Husa adaptive filtering
CA2097822C (en) Display system
US5077700A (en) Doppler velocity profiler
CN110567454B (zh) 一种复杂环境下sins/dvl紧组合导航方法
US6382022B1 (en) Shipboard wave measurement system
JPS5936208B2 (ja) 航空機の慣性台を迅速に整列させる方法および装置
CN112747748A (zh) 一种基于逆向解算的领航auv导航数据后处理方法
JPH10104015A (ja) 航法装置
Godhavn High quality heave measurements based on GPS RTK and accelerometer technology
JPS5956107A (ja) 航法装置
US4335433A (en) Method for correcting navigation errors due to water currents
JPS5956108A (ja) 航法装置
CN110057383B (zh) 一种auv推位导航系统杆臂误差标校方法
JPH0949737A (ja) 航法信号出力方法
JP3192448B2 (ja) 潮流計
JPS63302317A (ja) 移動体の位置速度測定装置
Lu et al. Ocean vehicle inertial navigation method based on dynamic constraints
Ånonsen et al. Water Referenced Doppler Velocity Aiding for AUV Navigation
JPH0785019B2 (ja) 船首方位計測装置
JPH10160746A (ja) 潮流計測装置
JPS5956106A (ja) 航法装置
CN118129747B (zh) 水下载体导航方法及系统
JPS6238314A (ja) 船位推測装置
Yuan et al. Research on train positioning system based on map matching and multi-information fusion