JP4417812B2 - 船舶姿勢角測定装置 - Google Patents
船舶姿勢角測定装置 Download PDFInfo
- Publication number
- JP4417812B2 JP4417812B2 JP2004289469A JP2004289469A JP4417812B2 JP 4417812 B2 JP4417812 B2 JP 4417812B2 JP 2004289469 A JP2004289469 A JP 2004289469A JP 2004289469 A JP2004289469 A JP 2004289469A JP 4417812 B2 JP4417812 B2 JP 4417812B2
- Authority
- JP
- Japan
- Prior art keywords
- ship
- acceleration
- attitude angle
- azimuth
- satellite
- 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
- 230000001133 acceleration Effects 0.000 claims description 94
- 238000005259 measurement Methods 0.000 claims description 48
- 238000012937 correction Methods 0.000 claims description 7
- 239000013598 vector Substances 0.000 description 26
- 238000012545 processing Methods 0.000 description 15
- 238000011156 evaluation Methods 0.000 description 9
- 239000011159 matrix material Substances 0.000 description 7
- 230000008054 signal transmission Effects 0.000 description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 4
- 239000000284 extract Substances 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000014509 gene expression Effects 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
Images
Landscapes
- Navigation (AREA)
Description
衛星から送信された信号を受信する受信部を含み、当該受信部で受信された信号に基づいて船舶の移動加速度を測定することを特徴とする。
(1)先述のように、衛星に関する情報Iiには、軌道情報、信号送信時刻などが含まれており、これを用いてn個の衛星それぞれについて軌道上を移動する際の速度を算出する。一方、移動速度測定部16は、船舶100の移動速度算出の際の初期値(推定値)、あるいは先に算出した船舶100の移動速度の値を記憶している。
(2)移動速度測定部16は、記憶されていた船舶100の移動速度から、衛星に関する情報Iiに基づいて算出された衛星が軌道上を移動する際の速度を減算し、それを衛星の位置と船舶100の位置とを結ぶ直線上に投影した補正速度を算出する。なお、この補正速度の算出は、n個の衛星それぞれについて行う。
(3)衛星の位置と船舶100の位置とを結ぶ直線上への投影計算は、測位部20から入力された船舶100の位置を表すデータと、衛星に関する情報Iiから算出された衛星の軌道上における位置に基づいて算出される、投影比率を行列の成分とする方向余弦行列を用いて行う。すなわち、移動速度測定部16に記憶されていた船舶100の移動速度から、衛星が軌道上を移動する際の速度を減算した速度ベクトルに、方向余弦行列を乗ずる計算を行う。なお、ここでの方向余弦行列は、n個の衛星に対する投影計算を4次元のベクトル量に対して作用させるものであるため、n行4列の行列となる。ただし、4次元のベクトルのうち3成分は空間座標における速度、変位などの3次元ベクトルであり、残りの1成分は衛星測位システムにおける時間補正に関する成分である。
(4)移動速度測定部16は、n個の衛星それぞれについて算出された、衛星が軌道上を移動する際の速度の影響を取り除いた補正速度に基づいて、船舶の移動速度のみによるドップラ周波数偏移量(以下、補正ドップラ周波数偏移量とする。)を算出する。
(1)船首方位角ψの値をm個仮定し、これを仮定船首方位角ψi(i=1,2・・・,m)とする。
(2)第1の受信部12が信号を受信している衛星の、原点Oから見た方位角および仰角とアンテナ間距離Lとから、仮定船首方位角ψiに対する行路差diを計算により算出する。このようにして算出された行路差diを計算行路差diとする。ここに、diはラジアンなど受信信号の波長で規格化されたもので表すことが好適である。
(3)n個の衛星から送信された信号それぞれに基づいて計算行路差diを算出し、n個算出された計算行路差diに基づいて計算行路差diの評価値δiを定義して算出する。この評価値δiは、例えば仰角の最も大きい衛星に対する計算行路差diを基準値とした、各衛星に対して算出された計算行路差diの当該基準値との差として定義することが好適である。ここで、評価値δiは複数の衛星に対する評価値を要素とするベクトル値としてもよい。
(4)第1の受信部12によって測定された搬送波の位相と、第2の受信部14によって測定された搬送波の位相とから、測定によって算出された行路差である測定行路差dを算出する。
(5)n個の衛星から送信された信号それぞれに基づいて測定行路差dを算出し、n個算出された測定行路差dに基づいて、先の評価値δiを算出したものと同一の定義によって測定行路差dの評価値δを算出する。
(6)評価値δと評価値δiとの差異を表すパラメータσi(i=1,2・・・,m)を算出し、σiが最も小さくなるiの値である、jを検索し、仮定船首方位角ψjを真の船首方位角ψとする。
Claims (7)
- 船舶の姿勢角測定位置に作用する加速度に基づいて船舶の姿勢角を求める姿勢角取得手段と、
船舶に固定された座標系上の基準方向の方位角を測定する方位角測定手段と、
船舶の地球に対する移動加速度を測定する移動加速度測定手段と、
船舶の地球に対する移動加速度に起因して、前記姿勢角取得手段による姿勢角取得値に含まれる誤差を、前記方位角測定手段および前記移動加速度測定手段による各測定値に基づいて低減する誤差低減手段と、
を備え、
前記移動加速度測定手段は、
衛星から送信された信号を受信する受信部を含み、
当該受信部で受信された信号に基づいて船舶の移動加速度を測定することを特徴とする船舶姿勢角測定装置。 - 請求項1に記載の船舶姿勢角測定装置であって、
前記方位角測定手段は、
衛星から送信された信号に基づいて前記基準方向の方位角を測定することを特徴とする船舶姿勢角測定装置。 - 請求項2に記載の船舶姿勢角測定装置であって、
前記方位角測定手段は、
衛星から送信された信号を受信する第1の受信部と、
衛星から送信された信号を受信する第2の受信部と、
を含み、
前記第1の受信部で受信された信号の位相と、前記第2の受信部で受信された信号の位相と、に基づいて前記基準方向の方位角を測定することを特徴とする船舶姿勢角測定装置。 - 請求項2に記載の船舶姿勢角測定装置であって、
前記方位角測定手段は、
衛星から送信された信号を受信して測位を行う第1の測位部と、
衛星から送信された信号を受信して測位を行う第2の測位部と、
を含み、
前記第1の測位部による測位結果と、前記第2の測位部による測位結果と、に基づいて前記基準方向の方位角を測定することを特徴とする船舶姿勢角測定装置。 - 請求項1から請求項4のいずれか1項に記載の船舶姿勢角測定装置であって、
前記移動加速度測定手段は、
前記受信部で受信された信号に観測されるドップラ周波数偏移量に基づいて船舶の移動加速度を測定することを特徴とする船舶姿勢角測定装置。 - 請求項1から請求項5のいずれか1項に記載の船舶姿勢角測定装置であって、
前記姿勢角取得手段は、
前記姿勢角測定位置に作用する加速度を複数方向の各成分について測定する加速度測定手段を備え、
前記誤差低減手段は、
船舶の地球に対する移動加速度が前記複数方向の各加速度成分測定値に寄与する誤差寄与値を、前記方位角測定手段および前記移動加速度測定手段による各測定値に基づいて求め、前記複数方向の各加速度成分測定値から当該誤差寄与値を減算し、
前記姿勢角取得手段は、
誤差寄与値が減算された各加速度成分測定値に基づいて船舶の姿勢角を求めることを特徴とする船舶姿勢角測定装置。 - 請求項6に記載の船舶姿勢角測定装置であって、
前記誤差低減手段は、
誤差寄与値の減算に基づいて求められた修正後の各加速度成分測定値に対し、前記方位角測定手段および前記移動加速度測定手段による各測定値に基づいて新たな誤差寄与値を求め、当該修正後の各加速度成分測定値から当該新たな誤差寄与値を減算し、
前記姿勢角取得手段は、
当該新たな誤差寄与値の減算に基づいて求められた修正後の各加速度成分測定値に基づいて船舶の姿勢角を求めることを特徴とする船舶姿勢角測定装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004289469A JP4417812B2 (ja) | 2004-10-01 | 2004-10-01 | 船舶姿勢角測定装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004289469A JP4417812B2 (ja) | 2004-10-01 | 2004-10-01 | 船舶姿勢角測定装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006105635A JP2006105635A (ja) | 2006-04-20 |
JP4417812B2 true JP4417812B2 (ja) | 2010-02-17 |
Family
ID=36375569
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004289469A Expired - Fee Related JP4417812B2 (ja) | 2004-10-01 | 2004-10-01 | 船舶姿勢角測定装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4417812B2 (ja) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101221929B1 (ko) * | 2012-10-17 | 2013-01-16 | 한국해양과학기술원 | 위성신호 미약 환경에서의 반송파 위상과 관성센서 정보를 이용한 선박의 위성측정치 생성방법 및 장치 |
KR101221931B1 (ko) | 2012-10-17 | 2013-01-15 | 한국해양과학기술원 | 위성신호 미약 환경에서의 관성센서를 이용한 선박의 위성측정치 생성방법 및 장치 |
CN110319838A (zh) * | 2019-07-09 | 2019-10-11 | 哈尔滨工程大学 | 一种自适应的运动姿态参考系统升沉测量方法 |
CN115950395B (zh) * | 2022-08-18 | 2024-08-23 | 武汉科技大学 | 一种船舶姿态预测及船载水炮炮口角度调整方法 |
-
2004
- 2004-10-01 JP JP2004289469A patent/JP4417812B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2006105635A (ja) | 2006-04-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10261176B2 (en) | Rotating attitude heading reference systems and methods | |
US10983206B2 (en) | Low cost high precision GNSS systems and methods | |
US10215564B2 (en) | Automatic compass calibration systems and methods | |
Morgado et al. | Tightly coupled ultrashort baseline and inertial navigation system for underwater vehicles: An experimental validation | |
CA2837179C (en) | Determining spatial orientation information of a body from multiple electromagnetic signals | |
Morgado et al. | Embedded vehicle dynamics aiding for USBL/INS underwater navigation system | |
Vasconcelos et al. | Discrete-time complementary filters for attitude and position estimation: Design, analysis and experimental validation | |
JP6360199B2 (ja) | 状態算出装置、状態算出方法、および状態算出プログラム | |
Pan et al. | Underwater Doppler navigation with self-calibration | |
US20180106619A1 (en) | Mobile Structure Heading and Piloting Systems and Methods | |
CN110793518B (zh) | 一种海上平台的定位定姿方法及系统 | |
CN110133700B (zh) | 一种船载综合导航定位方法 | |
JP2008216062A (ja) | 移動体姿勢計測装置 | |
Vasconcelos et al. | INS/GPS aided by frequency contents of vector observations with application to autonomous surface crafts | |
JP2009085882A (ja) | 方位検出装置 | |
JP5022747B2 (ja) | 移動体の姿勢及び方位検出装置 | |
US10948292B2 (en) | Sensor error calculating device, attitude angle calculating apparatus, method of calculating sensor error and method of calculating attitude angle | |
WO2016036767A2 (en) | Rotating attitude heading reference systems and methods | |
Giorgi | Attitude determination | |
JP4417812B2 (ja) | 船舶姿勢角測定装置 | |
Lammas et al. | 6-DoF navigation systems for autonomous underwater vehicles | |
JP2012202749A (ja) | 方位測定装置 | |
CN112083425A (zh) | 一种引入径向速度的sins/lbl紧组合导航方法 | |
Sollie et al. | Pose estimation of UAVs based on INS aided by two independent low-cost GNSS receivers | |
CN107092027B (zh) | 利用信号接收器计算姿态角的方法及设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20061201 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090616 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090804 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090908 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20091029 |
|
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: 20091124 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20091126 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4417812 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: 20121204 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131204 Year of fee payment: 4 |
|
LAPS | Cancellation because of no payment of annual fees |