JP2008216062A - 移動体姿勢計測装置 - Google Patents
移動体姿勢計測装置 Download PDFInfo
- Publication number
- JP2008216062A JP2008216062A JP2007054288A JP2007054288A JP2008216062A JP 2008216062 A JP2008216062 A JP 2008216062A JP 2007054288 A JP2007054288 A JP 2007054288A JP 2007054288 A JP2007054288 A JP 2007054288A JP 2008216062 A JP2008216062 A JP 2008216062A
- Authority
- JP
- Japan
- Prior art keywords
- positional relationship
- antenna
- coordinate system
- relative positional
- moving body
- 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.)
- Granted
Links
Landscapes
- Traffic Control Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
【解決手段】 姿勢算出部13は、記憶部12に記憶している各アンテナの相対的位置関係から船体の姿勢を算出する。位置関係算出部14は、基準アンテナから見た各アンテナの相対的位置関係を算出する。座標系変換部15は、位置関係算出部14で算出した各アンテナの相対的位置関係を移動体座標系に変換する。補正部16は、移動体座標系に変換後の各アンテナの相対的位置関係についてフィルタリングにより誤差を補正する。更新部17は、記憶部12に記憶されている各アンテナの相対的位置関係を補正後の各アンテナの相対的位置関係により更新する。
【選択図】図4
Description
まず、2つの座標系、局所座標系と移動体座標系を次のように定義する。「局所座標系」は、移動体の位置において、x-y平面を水平面と平行させ、x軸を真北に向けた右手系直交座標系である。「移動体座標系」は、移動体に固定された右手系直交座標系である。
次に、前述のように表される方位、ピッチ、ロールからなる移動体の姿勢を計測する移動体姿勢計測装置の装置構成例を、図1、図2を参照して説明する。
移動体姿勢計測装置1では、衛星航法システムを利用して各アンテナα,β,γ間の基線ベクトルを算出すれば、その算出値から船舶Sの姿勢を算出することができる。
と表すことができる。
である。なお、数1において、arg(・)は複素数の偏角を求める関数であり、添え字x,y,zは、ベクトルの座標系における各軸方向の成分を意味する。
前述のとおり、基線ベクトルを求めることにより、船舶Sの姿勢を算出することができる。ここで、基線ベクトルを求めるには、次のようにする。
図3を参照して、一重位相差とは基準アンテナ101及びユーザアンテナ102における、同一衛星105からの信号の搬送波位相の差分である。この差分と基準アンテナ101(その信号は基準受信機103で受信する)及びユーザアンテナ102(その信号は基準受信機104で受信する)により構成される基線ベクトルの間には行路差から、
が成り立つ。なお、yは位相差、hは衛星への単位方向ベクトル、bは基線ベクトル、aは整数の値、Δtは受信機の位相差の取得タイミングのズレを表す時計誤差、eは観測誤差、であり、これらのy,b,a,Δt,eの単位は波数とする。また、添え字sは一重位相差についての値であることを意味する。
と表される。
を意味する。なお、添え字dは二重位相差に関する値であることを表している。二重位相差を用いる利点は、時計誤差を打ち消すことができることである。
複数の衛星を受信すれば、基線ベクトルbに関する連立方程式を立てることができ、この連立方程式を最小二乗法により解けば基線ベクトルbを算出できる。
と表される。
である。
と推定できる。
と設定するのが普通である。ここでσ2は規格化係数である。
と表され、整数値アンビギュイティが既知であるとすれば、基線と時計誤差の推定値b(bにハット)は、
と求めることができる。
前述の手法とは異なる次の手法を用いても船舶Sの姿勢を算出することができる。これは各アンテナの配置が既知であることを利用した姿勢の計測法で、前述の手法に比べて姿勢の測定精度が良いという利点がある。
の関係がある。
と表される。
と表される。
と表される。ここで、
である。上記の(15)式を観測モデル式と呼び、(16)式を状態変数ベクトルと呼ぶ。
を収束させることで、推定できる。
である。
とすることで同様に求めることができる。
のように、bv(l)(bにハット)の一定時間の平均を求めるか(ここでAv(-)は、平均を求める操作を意味する)、あるいは、
のように、得られた各アンテナα,β,γの相対的位置関係を、記憶部12に記憶されている各アンテナα,β,γの相対的位置関係と係数qとによりローパスフィルタリングする方法が挙げられる。このフィルタリングすることでより正確な各アンテナα,β,γの相対的位置関係を示す基線ベクトルbF v(l)を算出することができる。
と更新する。ここで、「A←B」はAにBを代入することを意味する。
のように、前述のフィルタリング後の移動体座標系における各アンテナα,β,γ間の相対位置を適切な変換行列Tを用いて適切な値に修正した相対位置関係を移動体座標系に対するアンテナα,β,γ間の配置関係の設計値として記憶部12の値を更新してもよい。
4 受信機
11 位相差計算部
12 記憶部
13 姿勢算出部
14 位置関係算出部
15 座標系変換部
16 補正部
17 更新部
21 傾斜計
α,β,γ アンテナ
S 移動体
Claims (2)
- 移動体に設置されて衛星の信号を受信するn個(nは3以上の整数)のアンテナと、
前記各アンテナで受信した衛星の信号から当該アンテナと前記衛星との位置関係を算出する第1の位置関係算出手段と、
前記各アンテナで受信した衛星信号の搬送波位相を測定する搬送波位相測定手段と、
前記搬送波位相測定手段で測定した搬送波位相から一重位相差又は二重位相差を計算する位相差計算手段と、
前記各アンテナの移動体座標系における相対的位置関係を記憶する記憶手段と、
前記第1の位置関係算出手段で算出した前記アンテナと前記衛星との位置関係と前記一重位相差又は二重位相差とを用いて、前記記憶手段に記憶している各アンテナの相対的位置関係から前記移動体の姿勢を算出する姿勢算出手段と、
前記第1の位置関係算出手段で算出した前記アンテナと前記衛星との位置関係と前記一重位相差又は二重位相差とを用いて、前記各アンテナの局所座標系における相対的位置関係を算出する第2の位置関係算出手段と、
前記姿勢算出手段で算出した移動体の姿勢を用いて、前記第2の位置関係算出手段で算出した前記各アンテナの局所座標系における相対的位置関係を移動体座標系における相対的位置関係に変換する座標系変換手段と、
前記座標系変換手段で移動体座標系に変換後の前記各アンテナの移動体座標系における相対的位置関係について誤差を補正する補正手段と、
前記記憶手段に記憶されている各アンテナの移動体座標系における相対的位置関係を前記補正手段で補正後の各アンテナの相対的位置関係により更新する更新手段と、
を備えている移動体姿勢計測装置。 - 前記移動体の姿勢のうちロール及びピッチを計測する傾斜計をさらに備え、
前記座標系変換手段は、前記姿勢算出手段で算出した移動体の姿勢のうちの方位を用い、又、前記姿勢算出手段で算出した移動体の姿勢のうちのロール及びピッチに代えて前記計測手段で計測したロール及びピッチを用いて、前記位置関係算出手段で算出した前記各アンテナの相対的位置関係を移動体座標系における相対的位置関係に変換する、
請求項1に記載の移動体姿勢計測装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007054288A JP5084303B2 (ja) | 2007-03-05 | 2007-03-05 | 移動体姿勢計測装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007054288A JP5084303B2 (ja) | 2007-03-05 | 2007-03-05 | 移動体姿勢計測装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008216062A true JP2008216062A (ja) | 2008-09-18 |
JP5084303B2 JP5084303B2 (ja) | 2012-11-28 |
Family
ID=39836270
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007054288A Active JP5084303B2 (ja) | 2007-03-05 | 2007-03-05 | 移動体姿勢計測装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5084303B2 (ja) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010216822A (ja) * | 2009-03-13 | 2010-09-30 | Japan Radio Co Ltd | 姿勢計測装置 |
KR101266826B1 (ko) | 2012-09-10 | 2013-05-27 | 에스티엑스엔진 주식회사 | 선박용 위성안테나 이중화제어시스템에서 음영각에 따른 이중화 절체방법 |
JP2013228318A (ja) * | 2012-04-26 | 2013-11-07 | Ono Sokki Co Ltd | キャリブレーション良否判定装置及び方法 |
JP2014145614A (ja) * | 2013-01-28 | 2014-08-14 | Furuno Electric Co Ltd | 回頭角速度検出装置、移動体、回頭角速度検出方法、および、回頭角速度検出プログラム |
WO2015037319A1 (ja) * | 2013-09-13 | 2015-03-19 | 日立建機株式会社 | ダンプトラック |
WO2016104032A1 (ja) * | 2014-12-26 | 2016-06-30 | 古野電気株式会社 | 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム |
JP2017146173A (ja) * | 2016-02-17 | 2017-08-24 | 古野電気株式会社 | 観測データ解析装置、観測データ解析システム、および、観測データ解析方法 |
JP2018072244A (ja) * | 2016-11-01 | 2018-05-10 | 三菱重工業株式会社 | 移動体観測システム、移動体観測方法及びプログラム |
JP6445206B1 (ja) * | 2018-07-06 | 2018-12-26 | Terra Drone株式会社 | 移動体の位置及び姿勢を推定する装置とそのプログラム、移動体の位置及び姿勢を推定するシステムとその方法 |
WO2021064939A1 (ja) * | 2019-10-03 | 2021-04-08 | 三菱電機株式会社 | 衛星信号受信装置及び位置測定装置 |
CN113763751A (zh) * | 2021-03-17 | 2021-12-07 | 苏州臻迪智能科技有限公司 | 一种无人船保持通信的方法、装置、无人船及存储介质 |
WO2022044651A1 (ja) * | 2020-08-27 | 2022-03-03 | 古野電気株式会社 | 船舶航行支援装置 |
CN114236585A (zh) * | 2021-12-09 | 2022-03-25 | 国网思极神往位置服务(北京)有限公司 | 基于北斗导航卫星系统的目标运动监测方法及存储介质 |
JP7506238B1 (ja) | 2023-09-22 | 2024-06-25 | Kddi株式会社 | 情報処理装置、情報処理方法及びプログラム |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001264406A (ja) * | 2000-03-21 | 2001-09-26 | Japan Radio Co Ltd | 移動体方位検出装置 |
JP2002054946A (ja) * | 2000-06-01 | 2002-02-20 | Furuno Electric Co Ltd | 物体の姿勢検出装置および整数バイアス再決定方法 |
JP2003050273A (ja) * | 2001-08-03 | 2003-02-21 | Furuno Electric Co Ltd | サイクルスリップ発生有無検出装置およびその方法 |
JP2005009970A (ja) * | 2003-06-18 | 2005-01-13 | Anten Corp | 移動体通信ナビゲーションシステム |
JP2006126181A (ja) * | 2004-10-01 | 2006-05-18 | Mitsubishi Electric Corp | 移動体姿勢検出装置 |
JP2006153816A (ja) * | 2004-12-01 | 2006-06-15 | Furuno Electric Co Ltd | 物体の方位および姿勢検出装置 |
JP2006267042A (ja) * | 2005-03-25 | 2006-10-05 | Furuno Electric Co Ltd | 移動体速度検出装置 |
-
2007
- 2007-03-05 JP JP2007054288A patent/JP5084303B2/ja active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001264406A (ja) * | 2000-03-21 | 2001-09-26 | Japan Radio Co Ltd | 移動体方位検出装置 |
JP2002054946A (ja) * | 2000-06-01 | 2002-02-20 | Furuno Electric Co Ltd | 物体の姿勢検出装置および整数バイアス再決定方法 |
JP2003050273A (ja) * | 2001-08-03 | 2003-02-21 | Furuno Electric Co Ltd | サイクルスリップ発生有無検出装置およびその方法 |
JP2005009970A (ja) * | 2003-06-18 | 2005-01-13 | Anten Corp | 移動体通信ナビゲーションシステム |
JP2006126181A (ja) * | 2004-10-01 | 2006-05-18 | Mitsubishi Electric Corp | 移動体姿勢検出装置 |
JP2006153816A (ja) * | 2004-12-01 | 2006-06-15 | Furuno Electric Co Ltd | 物体の方位および姿勢検出装置 |
JP2006267042A (ja) * | 2005-03-25 | 2006-10-05 | Furuno Electric Co Ltd | 移動体速度検出装置 |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010216822A (ja) * | 2009-03-13 | 2010-09-30 | Japan Radio Co Ltd | 姿勢計測装置 |
JP2013228318A (ja) * | 2012-04-26 | 2013-11-07 | Ono Sokki Co Ltd | キャリブレーション良否判定装置及び方法 |
KR101266826B1 (ko) | 2012-09-10 | 2013-05-27 | 에스티엑스엔진 주식회사 | 선박용 위성안테나 이중화제어시스템에서 음영각에 따른 이중화 절체방법 |
JP2014145614A (ja) * | 2013-01-28 | 2014-08-14 | Furuno Electric Co Ltd | 回頭角速度検出装置、移動体、回頭角速度検出方法、および、回頭角速度検出プログラム |
CN105074382B (zh) * | 2013-09-13 | 2017-08-04 | 日立建机株式会社 | 自卸卡车 |
WO2015037319A1 (ja) * | 2013-09-13 | 2015-03-19 | 日立建機株式会社 | ダンプトラック |
JP2015055603A (ja) * | 2013-09-13 | 2015-03-23 | 日立建機株式会社 | ダンプトラック |
CN105074382A (zh) * | 2013-09-13 | 2015-11-18 | 日立建机株式会社 | 自卸卡车 |
US9605959B2 (en) | 2013-09-13 | 2017-03-28 | Hitachi Construction Machinery Co., Ltd. | Dump truck |
JPWO2016104032A1 (ja) * | 2014-12-26 | 2017-09-21 | 古野電気株式会社 | 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム |
CN107110979A (zh) * | 2014-12-26 | 2017-08-29 | 古野电气株式会社 | 姿态角计算装置、姿态角计算方法及姿态角计算程序 |
WO2016104032A1 (ja) * | 2014-12-26 | 2016-06-30 | 古野電気株式会社 | 姿勢角算出装置、姿勢角算出方法、および姿勢角算出プログラム |
US10514469B2 (en) | 2014-12-26 | 2019-12-24 | Furuno Electric Co., Ltd. | Attitude angle calculating device, method of calculating attitude angle, and attitude angle calculating program |
CN107110979B (zh) * | 2014-12-26 | 2020-10-30 | 古野电气株式会社 | 姿态角计算装置、姿态角计算方法及存储介质 |
JP7044459B2 (ja) | 2016-02-17 | 2022-03-30 | 古野電気株式会社 | 観測データ解析装置、観測データ解析システム、および、観測データ解析方法 |
JP2017146173A (ja) * | 2016-02-17 | 2017-08-24 | 古野電気株式会社 | 観測データ解析装置、観測データ解析システム、および、観測データ解析方法 |
JP2018072244A (ja) * | 2016-11-01 | 2018-05-10 | 三菱重工業株式会社 | 移動体観測システム、移動体観測方法及びプログラム |
JP6445206B1 (ja) * | 2018-07-06 | 2018-12-26 | Terra Drone株式会社 | 移動体の位置及び姿勢を推定する装置とそのプログラム、移動体の位置及び姿勢を推定するシステムとその方法 |
JP2020008420A (ja) * | 2018-07-06 | 2020-01-16 | Terra Drone株式会社 | 移動体の位置及び姿勢を推定する装置とそのプログラム、移動体の位置及び姿勢を推定するシステムとその方法 |
WO2021064939A1 (ja) * | 2019-10-03 | 2021-04-08 | 三菱電機株式会社 | 衛星信号受信装置及び位置測定装置 |
JPWO2021064939A1 (ja) * | 2019-10-03 | 2021-04-08 | ||
JP7154433B2 (ja) | 2019-10-03 | 2022-10-17 | 三菱電機株式会社 | 衛星信号受信装置及び位置測定装置 |
WO2022044651A1 (ja) * | 2020-08-27 | 2022-03-03 | 古野電気株式会社 | 船舶航行支援装置 |
CN113763751A (zh) * | 2021-03-17 | 2021-12-07 | 苏州臻迪智能科技有限公司 | 一种无人船保持通信的方法、装置、无人船及存储介质 |
CN114236585A (zh) * | 2021-12-09 | 2022-03-25 | 国网思极神往位置服务(北京)有限公司 | 基于北斗导航卫星系统的目标运动监测方法及存储介质 |
CN114236585B (zh) * | 2021-12-09 | 2023-04-14 | 国网思极位置服务有限公司 | 基于北斗导航卫星系统的目标运动监测方法及存储介质 |
JP7506238B1 (ja) | 2023-09-22 | 2024-06-25 | Kddi株式会社 | 情報処理装置、情報処理方法及びプログラム |
Also Published As
Publication number | Publication date |
---|---|
JP5084303B2 (ja) | 2012-11-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5084303B2 (ja) | 移動体姿勢計測装置 | |
CN108680942B (zh) | 一种惯性/多天线gnss组合导航方法及装置 | |
JP5301762B2 (ja) | キャリア位相相対測位装置 | |
JP4199553B2 (ja) | ハイブリッド航法装置 | |
US8930047B2 (en) | Systems and methods for determining a positional state of an airborne array antenna using distributed accelerometers | |
US7076342B2 (en) | Attitude sensing apparatus for determining the attitude of a mobile unit | |
US20160069681A1 (en) | Automatic compass calibration systems and methods | |
JP2002040124A (ja) | キャリア位相相対測位装置 | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 | |
US20130238269A1 (en) | Apparatuses and methods for dynamic tracking and compensation of magnetic near field | |
KR101211703B1 (ko) | 시선벡터를 이용한 자장계 오차 보정방법 및 이를 이용한 통합 항법 시스템 | |
JP4729197B2 (ja) | 物体の姿勢検出装置および整数バイアス再決定方法 | |
JP2013507619A (ja) | 超短基線gnss受信機 | |
JP5052845B2 (ja) | 移動体姿勢計測装置 | |
CN114485641A (zh) | 一种基于惯导卫导方位融合的姿态解算方法及装置 | |
JP2019120587A (ja) | 測位システム及び測位方法 | |
CN110793518A (zh) | 一种海上平台的定位定姿方法及系统 | |
JP2007163335A (ja) | 姿勢標定装置、姿勢標定方法および姿勢標定プログラム | |
JP4563157B2 (ja) | 物体の方位および姿勢検出装置 | |
KR20190068935A (ko) | 정밀 복합항법 측위 검증 장치 | |
JP2012202749A (ja) | 方位測定装置 | |
JP5180447B2 (ja) | キャリア位相相対測位装置及び方法 | |
CN107228683B (zh) | 一种多星敏感器间慢变误差实时在轨修正方法 | |
JP2004045385A (ja) | 移動体の姿勢検出装置 | |
JP2010216822A (ja) | 姿勢計測装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100302 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110802 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110803 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110929 |
|
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: 20120904 |
|
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: 20120904 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5084303 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: 20150914 Year of fee payment: 3 |