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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; 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時間の間に増大してしまう。
軸方向(この説明では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へ供給している。
位置信号を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の信号はあくまで位置リセット信
号として用いられているだめに、潮流の父化、風、波浪
、船の運動変化等の外乱入力が6111位誤差へ大きく
影響している。更に最大1時間前の平均速度誤差を用い
て次の1時間の速度誤差を修正しているだめ、次の1時
間の速度誤差の特性(極性)が変化した時の影昏が測位
誤差を発生する。またこの特性変化は例えば第2図に示
すように、潮流の方向変化により測位誤差ΔPが生じ、
また船の旋回の影響により誤差の傾向が大きく変化する
。第2図において時間軸上のIH、2HでNN5S位置
リセットされることを示している。またロラン−Cの信
号を連続的に取シ込む必要があった。
更にこの航法装置はオーブンループで構成されているた
め、ロラン−C信号、NN5S位置信号、対水速度セン
サ、ジャイロコンパス、潮流の各誤差の周波数成分およ
び不規則成分をP波する能力がなかつことにより測位誤
差が大きくなった。
め、ロラン−C信号、NN5S位置信号、対水速度セン
サ、ジャイロコンパス、潮流の各誤差の周波数成分およ
び不規則成分をP波する能力がなかつことにより測位誤
差が大きくなった。
従来においては、先に述べたように対水速度センサは船
首尾軸方向の速度を検出するのみであるだめ、潮流や風
などにより、船が首尾軸方向に進まず多少ずれた方向に
進む場合、この横流れ速度は対水速度センサ11では検
出されない。このため大きな測位誤差が発生した。
首尾軸方向の速度を検出するのみであるだめ、潮流や風
などにより、船が首尾軸方向に進まず多少ずれた方向に
進む場合、この横流れ速度は対水速度センサ11では検
出されない。このため大きな測位誤差が発生した。
〈発明の概要〉
この発明の目的は、潮流や風などによる横流れによる誤
差を伴うことなく、正しく位置を演算することができる
航法装置を提供することにある。
差を伴うことなく、正しく位置を演算することができる
航法装置を提供することにある。
この発明によれば、船のピッチ軸方向の対水速度Vyを
も検出する速度センサを設ける。この速度号と、船首尾
軸方向の速度vXと、方位角ψとから北方向速度VN
、東方向速度VEを次により演算する。
も検出する速度センサを設ける。この速度号と、船首尾
軸方向の速度vXと、方位角ψとから北方向速度VN
、東方向速度VEを次により演算する。
VN = vXcas F −Vy sinψVE ”
” VXsinψ+VXcosFこれらvN、 VEを
積分して航法計算を行う。
” VXsinψ+VXcosFこれらvN、 VEを
積分して航法計算を行う。
このようにピッチ軸方向の速度を検出してその影響を考
慮しているため、横流れによる誤差を除去することがで
きる。
慮しているため、横流れによる誤差を除去することがで
きる。
〈実施例〉
第3図は、この発明による航法装置の一例を示し、第1
図と対応する部分に同一符号を付けである。この発明の
詳細な説明する前に、この発明を適用して好ましい航法
装置の概要を先ず説明する。
図と対応する部分に同一符号を付けである。この発明の
詳細な説明する前に、この発明を適用して好ましい航法
装置の概要を先ず説明する。
対水速度センサ11から船首尾軸方向(ロール軸方向)
の対水速度が検出されると共に、対水速度センサ18か
ら船のピッチ軸方向の対水速度(潮流。
の対水速度が検出されると共に、対水速度センサ18か
ら船のピッチ軸方向の対水速度(潮流。
風等による横流れ速度成分)が検出され、これら対水速
度は推測航法計算部12に供給される。ジャイロコンパ
ス13からの方位角信号も推測航法計算部12へ供給さ
れ、対水速度の北方向速度成分と東方向速度成分とが計
算される。これら速度成分はそれぞれ積分されて船の測
位決定が行われる。この推測位置と、ロラン−C受信機
16およびNN5S位置センサ受信機15からの各位置
信号とがその位置信号が得られるごとに位置比較計算部
19で比較される。その比較結果の信号は予測推定計算
部21で沢波されて、前記比較出力中に埋もれている対
水速度センサ11 、18のバイアス誤差、ジャイロコ
ンパス13の誤差、潮流速度などがそれぞれ推定され、
更に位置誤差が推定される。この位置誤差推定値より位
置誤差制御量が制御量計算部22で計算され、その位置
誤差制御量は推測航法計算部12に帰逮される。
度は推測航法計算部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
は定数である。
・ ・(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で推定し補正される。
できるが、この発明で1は予測計算機能を有しているた
め、データは30秒〜数分間隔で取り込めば充分である
。そしてNN5S位置センサ受信機15からのデータが
1時間毎に受信されるたびに、ロラン−C受信機16で
得られた位置信号のドリフトがロラン−C補正計算部2
3で推定し補正される。
観測データ間の予測式は次式である。
△
U=−KXp ・・・・・・
・・・・・・(5)Kは定数である。
・・・・・・(5)Kは定数である。
この予測区間決定は船の力学的環境で決められる。例え
ば7ノツト程度の巡航で、波も静かな状態では5分〜1
0分程度のロランデータ受信で充分で、予測区間は10
分間となる。
ば7ノツト程度の巡航で、波も静かな状態では5分〜1
0分程度のロランデータ受信で充分で、予測区間は10
分間となる。
以上のように誤差の推定計算を例えば比較的簡単なデジ
タル計算機により行うことにより高い精度の測位が可能
となるが、この発明では特に船首尾軸方向と水平面内で
直角な方向、いわゆるピッチ軸方向の対水速度センサ1
8をも装備して、直進中の潮流、風等による横流れ速度
、更には旋回中における横流れ速度を検出して、船の真
の北方向。
タル計算機により行うことにより高い精度の測位が可能
となるが、この発明では特に船首尾軸方向と水平面内で
直角な方向、いわゆるピッチ軸方向の対水速度センサ1
8をも装備して、直進中の潮流、風等による横流れ速度
、更には旋回中における横流れ速度を検出して、船の真
の北方向。
東方向の各対地速度を計算する。これによってあらゆる
海域で高精度な測位決定を行うことを可能とする。
海域で高精度な測位決定を行うことを可能とする。
対水速度センサ11が検出した船首尾軸方向速度Vxと
、対水速度センサ18が検出した船のピッチ軸方向速度
■と、北方向速度VNと、東方向速度VEと船の速度V
Sと、ジャイロコンパス1.3が検出した方位角Wとの
関係は第4図に示す関係となる。従って北方向、東方向
の速度計算式は下記で表わされる。
、対水速度センサ18が検出した船のピッチ軸方向速度
■と、北方向速度VNと、東方向速度VEと船の速度V
Sと、ジャイロコンパス1.3が検出した方位角Wとの
関係は第4図に示す関係となる。従って北方向、東方向
の速度計算式は下記で表わされる。
VN = VxcosF−Vys= F
−・叩−−−(6)VE = VXSIII ’l’
+ VXcO5F ・””・”””・−
(7)VX = V3 cosα、vy=vs画αでα
が横流れ角である。
−・叩−−−(6)VE = VXSIII ’l’
+ VXcO5F ・””・”””・−
(7)VX = V3 cosα、vy=vs画αでα
が横流れ角である。
横流れが存在しないときは号−oで(α=o)y方向対
水速度センサ18の出力は零となる。
水速度センサ18の出力は零となる。
このようにして横流れも考慮して船の北方向速度、東方
向速度が演算され、これらを積分することにより高精度
な測位が可能となる。
向速度が演算され、これらを積分することにより高精度
な測位が可能となる。
く効果〉
以上のようにこの発明の航法装置によれば、直進中の潮
流、風等による横流れ津度誤差による測位誤差の発生を
防ぐことができる。また旋回中の横流れ速度誤差による
測位誤差の発生を防ぐことができる。このため例えば従
来装置において、第2図に示したような測位誤差の傾向
に対して、この発明の適用により第5図に実線で示すよ
うに旋回中の誤差の傾向が増大せず、また潮流による誤
差ΔPが除去される。第5図中点線で第2図の曲線を比
較のために示した。
流、風等による横流れ津度誤差による測位誤差の発生を
防ぐことができる。また旋回中の横流れ速度誤差による
測位誤差の発生を防ぐことができる。このため例えば従
来装置において、第2図に示したような測位誤差の傾向
に対して、この発明の適用により第5図に実線で示すよ
うに旋回中の誤差の傾向が増大せず、また潮流による誤
差ΔPが除去される。第5図中点線で第2図の曲線を比
較のために示した。
更にこの発明の航法装置によれば、あらゆる船の運動に
も使用でき、またあらゆる海域でも使用可能である。第
3図に示した実施例のように、補正演算を行うことによ
って高精度測位が可能となる0 なお、この発明は第1図に示した従来装置にも通用でき
る。また対水速度センサ11 、18としては、電磁速
度計(いわゆる電磁ログ)のみならず音波を利用した速
度計、その他の速度計でもよく、更に速度検出は加速度
を検出し、その加速度を積分して求めてもよい。壕だ1
つの速度計あるいは可速度計でX方向、Y方向の両速度
を検出してもよい。
も使用でき、またあらゆる海域でも使用可能である。第
3図に示した実施例のように、補正演算を行うことによ
って高精度測位が可能となる0 なお、この発明は第1図に示した従来装置にも通用でき
る。また対水速度センサ11 、18としては、電磁速
度計(いわゆる電磁ログ)のみならず音波を利用した速
度計、その他の速度計でもよく、更に速度検出は加速度
を検出し、その加速度を積分して求めてもよい。壕だ1
つの速度計あるいは可速度計でX方向、Y方向の両速度
を検出してもよい。
第1図は従来の航法装置を示すブロック図、第2図は従
来の航法装置の測位誤差の傾向を示す図、第3図はこの
発明による航法装置の一例を示すブロック図、第4図は
各種速度成分の関係を示す図、第5図は第3図に示した
航法装置の測位誤差の傾向を示す図である。 11:航首尾軸用対水速度セ/ザ、12:推測航法計算
部、13:ジャイロコンパス、15:衛星航法位置セン
サ受信機、18:ビノテ軸用対水速度センサ。 特許出願人 株式会社北辰電機製作所代理人 草野
卓 す 3 図 1ク オ 4 図 15 図
来の航法装置の測位誤差の傾向を示す図、第3図はこの
発明による航法装置の一例を示すブロック図、第4図は
各種速度成分の関係を示す図、第5図は第3図に示した
航法装置の測位誤差の傾向を示す図である。 11:航首尾軸用対水速度セ/ザ、12:推測航法計算
部、13:ジャイロコンパス、15:衛星航法位置セン
サ受信機、18:ビノテ軸用対水速度センサ。 特許出願人 株式会社北辰電機製作所代理人 草野
卓 す 3 図 1ク オ 4 図 15 図
Claims (1)
- (1)船の対水速度を検出し、その速度の北方向成分と
東方向成分とを計算し、これら北方向速度成分と、東方
向速度成分とをそれぞれ積分して自船の位置を計算する
航法装置において、船首尾軸方向の対水速度Vヶを検出
する第1速度センサと、ピッチ軸方向の対水速度■、を
検出する第2速度セ/すと、これら速度V、 、vyと
方位信号ψとから上記北方向速度成分V、、東方向速度
成分■Eとして、 VN = VX cosψ−Vy sin FVE =
Vxsin ’l” 十VX CO”φを演算する手
段とを設けたことを特徴とする航法装置。
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)
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 | 惠州市德赛西威汽车电子有限公司 | 一种基于航位推算技术的车载定位系统 |
-
1982
- 1982-09-24 JP JP16737382A patent/JPS5956107A/ja active Pending
Cited By (2)
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 |