JP5046601B2 - 慣性航法を使用した実時間位置測量のための方法及び装置 - Google Patents
慣性航法を使用した実時間位置測量のための方法及び装置 Download PDFInfo
- Publication number
- JP5046601B2 JP5046601B2 JP2006264471A JP2006264471A JP5046601B2 JP 5046601 B2 JP5046601 B2 JP 5046601B2 JP 2006264471 A JP2006264471 A JP 2006264471A JP 2006264471 A JP2006264471 A JP 2006264471A JP 5046601 B2 JP5046601 B2 JP 5046601B2
- Authority
- JP
- Japan
- Prior art keywords
- pos
- point
- inertial navigation
- navigation system
- error state
- 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
Images
Landscapes
- Navigation (AREA)
Description
Φ(POS_A_E,PY)=−cos(Wander_to_Grid)
Φ(POS_A_N,PX)=−cos(Wander_to_Grid)
Φ(POS_A_N,PY)=sin(Wander_to_Grid)
Φ(POS_A_A,PZ)=1.0
H(OBS_POS_A_E,PY)=cos(Wander_To_Grid)、
H(OBS_POS_A_N,PX)=cos(Wander_To_Grid)、
H(OBS_POS_A_N,PY)=−sin(Wander_To_Grid)、
H(OBS_POS_A_A,PZ)=−1.0、
H(OBS_POS_A_E,POS_A_E)=1.0、
H(OBS_POS_A_N,POS_A_N)=1.0、及び
H(OBS_POS_A_A,POS_A_A)=1.0
Claims (9)
- 2以上の地点の相対位置を決定するシステムであって、
経路に沿って位置が移動させられる慣性航法システムであって、前記移動において、前記慣性航法システムは、最初に、第1の慣性航法システム位置である地点Aに置かれ、続いて、前記第1の慣性航法システム位置から、後続する慣性航法システム位置へと第1の移行が行われ、続いて、前記後続する慣性航法システム位置から前記第1の慣性航法システム位置への戻る移行が行われるものである、慣性航法システムと、
前記慣性航法システムと通信するように結合され、前記慣性航法システムの前記移動の経路における少なくとも2つの慣性航法システム位置に対する位置誤差状態及び位置解を推定するように構成されたコンピュータ・ベース・システムであって、フィルタを含み、前記フィルタは、前記慣性航法システムの前記移動における前記後続する慣性航法システム位置から前記第1の慣性航法システム位置への前記戻る移行の間に生成された相関関係に基づいて、前記位置誤差状態の推定値を調整するようにプログラムされたフィルタであり、前記相関関係は、前記慣性航法システムの前記移動の経路上の慣性航法システム位置と関連するデータ間の相関関係であり、前記フィルタは、前記慣性航法システムの位置および速度の実時間の推定値を生成するために前記慣性航法システムからの慣性測定データを処理するものである、コンピュータ・ベース・システムと
を備えるシステム。 - 請求項1に記載のシステムであって、前記フィルタがカルマン・フィルタを含む、システム。
- 請求項2に記載のシステムであって、前記フィルタが、それぞれの慣性航法システム位置に関連するそれぞれの状態推定値における予想誤差と様々な誤差状態の間の相関関係とに関する情報を含む誤差共分散行列を含む、システム。
- 請求項3に記載のシステムであって、前記誤差共分散行列が、P N+1 =ΦP N Φ T +Qにより前記慣性航法システムからの慣性データとして適時に伝播され、上記の式において、Pは誤差共分散行列、Φは状態遷移行列、Qはプラント雑音行列である、システム。
- 請求項4に記載のシステムであって、
前記慣性航法システムの前記第1の慣性航法システム位置である地点Aに対して、前記状態遷移行列Φが、下記の式、
Φ(POS_A_E,PX)=−sin(Wander_to_Grid)
Φ(POS_A_E,PY)=−cos(Wander_to_Grid)
Φ(POS_A_N,PX)=−cos(Wander_to_Grid)
Φ(POS_A_N,PY)=sin(Wander_to_Grid)
Φ(POS_A_A,PZ)=1.0
により前記現在の誤差状態を少なくとも1つの前記追加の誤差状態にコピーするように、前記フィルタの1サイクルに対して調整され、前記慣性航法システムの第2の慣性航法システム位置である地点Bに対して、前記状態遷移行列Φが、下記の式、
Φ(POS_B_E,PX)=−sin(Wander_to_Grid)
Φ(POS_B_E,PY)=−cos(Wander_to_Grid)
Φ(POS_B_N,PX)=−cos(Wander_to_Grid)
Φ(POS_B_N,PY)=sin(Wander_to_Grid)
Φ(POS_B_A,PZ)=1.0
により前記現在の誤差状態を少なくとも1つの前記追加の誤差状態にコピーするように、前記フィルタの1サイクルに対して調整され、上記の式において、POS_A_Eは地点A東方向誤差状態、POS_A_Nは地点A北方向誤差状態、POS_A_Aは地点A高度誤差状態、POS_B_Eは地点B東方向誤差状態、POS_B_Nは地点B北方向誤差状態、POS_B_Aは地点B高度誤差状態、PXはナビゲータ・ワンダ・フレームX誤差状態、PYはナビゲータ・ワンダ・フレームY誤差状態、PZはナビゲータ・ワンダ・フレームZ誤差状態、Wander_to_Gridはワンダ・フレームとグリッド・フレームとの間の現在の方位角である、
システム。 - 請求項5に記載のシステムであって、前記慣性航法システムが地点Aへ戻ると、前記コンピュータ・ベース・システムは前記フィルタに対して測定更新を適用し、前記測定更新は、現在のナビゲーション位置と、前記慣性航法システムが前記地点Aに最初に訪れたときに記録された位置との間の差分を含む、システム。
- 請求項6に記載のシステムであって、前記差分が、下記の式
H(OBS_POS_A_E,PX)=sin(Wander_To_Grid)、
H(OBS_POS_A_E,PY)=cos(Wander_To_Grid)、
H(OBS_POS_A_N,PX)=cos(Wander_To_Grid)、
H(OBS_POS_A_N,PY)=−sin(Wander_To_Grid)、
H(OBS_POS_A_A,PZ)=−1.0、
H(OBS_POS_A_E,POS_A_E)=1.0、
H(OBS_POS_A_N,POS_A_N)=1.0、及び
H(OBS_POS_A_A,POS_A_A)=1.0
により地点A位置の前記更新のための観測行列エントリを生じ、上記の式において、OBS_POS_A_Eは東方向位置における前記差分の観測値、OBS_POS_A_Nは北方向位置における前記差分の観測値、OBS_POS_A_Aは垂直位置における前記差分の観測値である、システム。 - 請求項1に記載のシステムであって、前記フィルタが、G=PH T (HPH T +R) −1 に従って位置更新に対するゲインを計算するようにプログラムされ、上記の式において、Rは測定値更新についての前記誤差共分散行列であり、前記車両を地点Aに正確に戻す際の誤差を表す、システム。
- 請求項1に記載のシステムであって、前記コンピュータ・ベース・システムが下記の式、
システム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006264471A JP5046601B2 (ja) | 2006-09-28 | 2006-09-28 | 慣性航法を使用した実時間位置測量のための方法及び装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006264471A JP5046601B2 (ja) | 2006-09-28 | 2006-09-28 | 慣性航法を使用した実時間位置測量のための方法及び装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008082931A JP2008082931A (ja) | 2008-04-10 |
JP5046601B2 true JP5046601B2 (ja) | 2012-10-10 |
Family
ID=39353944
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2006264471A Expired - Fee Related JP5046601B2 (ja) | 2006-09-28 | 2006-09-28 | 慣性航法を使用した実時間位置測量のための方法及び装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5046601B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11079236B2 (en) * | 2016-11-14 | 2021-08-03 | Volkswagen Aktiengesellschaft | Estimation of an individual position |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101851853B1 (ko) * | 2016-05-11 | 2018-04-24 | 세종대학교산학협력단 | 항체 사이의 상대 위치 결정시스템 및 이의 방법 |
JP6928306B2 (ja) | 2017-03-28 | 2021-09-01 | 愛知製鋼株式会社 | 磁気マーカの施工方法及び作業システム |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0814494B2 (ja) * | 1987-06-15 | 1996-02-14 | 株式会社トキメック | 位置検出装置 |
JPH01316607A (ja) * | 1988-03-30 | 1989-12-21 | Furuno Electric Co Ltd | 航法装置 |
JPH04203931A (ja) * | 1990-11-29 | 1992-07-24 | Mitsubishi Electric Corp | 走行情報表示装置 |
JPH04203932A (ja) * | 1990-11-29 | 1992-07-24 | Mitsubishi Electric Corp | 走行情報表示装置 |
JPH05248882A (ja) * | 1992-03-06 | 1993-09-28 | Japan Aviation Electron Ind Ltd | 慣性装置 |
JPH0634379A (ja) * | 1992-07-20 | 1994-02-08 | Hitachi Ltd | ナビゲーション装置 |
JP2000055678A (ja) * | 1998-08-04 | 2000-02-25 | Denso Corp | 車両用現在位置検出装置 |
-
2006
- 2006-09-28 JP JP2006264471A patent/JP5046601B2/ja not_active Expired - Fee Related
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11079236B2 (en) * | 2016-11-14 | 2021-08-03 | Volkswagen Aktiengesellschaft | Estimation of an individual position |
Also Published As
Publication number | Publication date |
---|---|
JP2008082931A (ja) | 2008-04-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11105633B2 (en) | Navigation system utilizing yaw rate constraint during inertial dead reckoning | |
US8718937B2 (en) | Methods and apparatus for real time position surveying using inertial navigation | |
CA2530903C (en) | Method and system for improving accuracy of inertial navigation measurements using measured and stored gravity gradients | |
US7193559B2 (en) | Inertial GPS navigation system with modified kalman filter | |
KR100520166B1 (ko) | 네비게이션시스템에서 이동체의 위치검출장치 및 그 방법 | |
EP4303630A2 (en) | Gnss and inertial navigation system utilizing relative yaw as an observable for an ins filter | |
CN104736963A (zh) | 测绘系统和方法 | |
JP2007064853A (ja) | 複合測位による移動体の測位制御装置、システムおよびプログラム | |
US9864067B2 (en) | Method for determining a current position of a motor vehicle in a geodetic coordinate system and motor vehicle | |
CN110146075A (zh) | 一种增益补偿自适应滤波的sins/dvl组合定位方法 | |
CN110146076A (zh) | 一种无逆矩阵自适应滤波的sins/dvl组合定位方法 | |
WO2019009103A1 (ja) | 測位装置 | |
JP2012173190A (ja) | 測位システム、測位方法 | |
US8949027B2 (en) | Multiple truth reference system and method | |
JP2021038989A (ja) | 車載装置、状態推定方法及びプログラム | |
KR20160143438A (ko) | 추측 항법 시스템에서의 밀결합 측위 방법 및 그 장치 | |
JP2016206149A (ja) | 勾配推定装置及びプログラム | |
JP2011127939A (ja) | 移動体位置推定追尾装置、移動体位置推定追尾方法、及び移動体位置推定追尾プログラム | |
JP5046601B2 (ja) | 慣性航法を使用した実時間位置測量のための方法及び装置 | |
JP4884109B2 (ja) | 移動軌跡算出方法、移動軌跡算出装置及び地図データ生成方法 | |
Nassar et al. | Accurate INS/GPS positioning with different inertial systems using various algorithms for bridging GPS outages | |
JP5058594B2 (ja) | 測位点推定装置および測位点推定方法ならびにそのプログラムと記録媒体 | |
Fernández et al. | Development of a simulation tool for collaborative navigation systems | |
CN112161634A (zh) | 基于rtb的线控底盘地图构建与同时定位方法 | |
CN118112623A (zh) | 一种间断gnss信号下的车辆融合定位方法及相关设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20090526 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110603 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110905 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20110913 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120306 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120606 |
|
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: 20120621 |
|
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: 20120717 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150727 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5046601 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
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 |
|
LAPS | Cancellation because of no payment of annual fees |