JPS63302317A - 移動体の位置速度測定装置 - Google Patents

移動体の位置速度測定装置

Info

Publication number
JPS63302317A
JPS63302317A JP13827587A JP13827587A JPS63302317A JP S63302317 A JPS63302317 A JP S63302317A JP 13827587 A JP13827587 A JP 13827587A JP 13827587 A JP13827587 A JP 13827587A JP S63302317 A JPS63302317 A JP S63302317A
Authority
JP
Japan
Prior art keywords
error
speed
kalman filter
output
reference device
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
JP13827587A
Other languages
English (en)
Inventor
Tomohisa Konishi
小西 朝久
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.)
Mitsubishi Heavy Industries Ltd
Original Assignee
Mitsubishi Heavy Industries Ltd
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 Mitsubishi Heavy Industries Ltd filed Critical Mitsubishi Heavy Industries Ltd
Priority to JP13827587A priority Critical patent/JPS63302317A/ja
Publication of JPS63302317A publication Critical patent/JPS63302317A/ja
Pending legal-status Critical Current

Links

Abstract

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

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、航空機、船舶、ロケット、自動車等の移動体
に搭載される位は速度の測定装置に関する。
〔従来の技術〕
従来、移動体の位置、速度、姿勢角を測定する装置とし
ては、慣性基準装置がよく用いられている。しかし、慣
性基準装置が出力する位置、速度、姿勢角には誤差が含
まれており、特に位置誤差は装置の作動時間の経過につ
れて増大していく。そこで、慣性基準装置の出力に含ま
れる誤差を軽減し、長時間精度の良い位置速度測定装置
とすることを目的として、慣性基準装置と他の位置速髪
測定装fit()”ツプラ航法装置や全地球測位システ
ム(GxobalPositioning Syste
m (本明細書では以下これをGPSと呼ぶことにする
)受信機など)を組合せることが考案されている。
この場合、第6図に示すように、位置誤差、速度誤差な
どを要素とする誤差ベクトルをカルマンフィルタ計算に
より推定し、これによって誤差を補正する方法がよく用
いられている。このカルマンフィルタでは、慣性基準装
置が出力する位置、速度信号と他の位置、速度測定装置
が出力する位置、速度信号との差を観測ベクトルとして
入力しこれに基づいて誤差ベクトルを出力するようにな
っている。
上記他の位置速度測定装置が出力する位置、速度信号に
は誤差が含まれており、これが観測ベクトルの誤差とな
るために、通常この誤差をカルマンフィルタに観測雑音
として盛込むことが行われており、この観測雑音の値と
しては誤差の平均的な値力≦用いられている。
〔発明が解決しようとする問題点〕
慣性基準装置と組合せる他の位置速度測定装置としてG
PS受信機を用い、第6図に示すような方法で誤差を補
正する場合、GPS受信機が出力する位置、速度の誤差
は、GPS受信機の地球上での位置とGPS受信機がそ
の電波を受信しているGPS用の衛星の位置との相対的
な位置関係に応じて変化する。
この相対的な位置関係は、GPS受信機を搭載した移動
体の移動及びGPS用の衛星の移動によって、時々刻々
変化する。したがって、カルマン・フィルタに盛込まれ
た観測雑音の値が平均的な値では、実際の観測ベクトル
に含まれる観測誤差がカルマンフィルタに盛込まれた観
測雑音と合わなくなることがあり、推定する誤差ベクト
ルの精度 。
が劣化することがある。これは結果的に慣性基準装置の
誤差を補正する精度を劣化させることとなり、組合せた
装置としての性能の低下を招く。
本発明は、このような従来のもの〜欠点を解消しようと
するものである。
〔問題点を解決するための手段〕
この問題を解決するために、本発明では、移動体の位置
、速度信号を出力する、慣性基準装置、衛星から送信さ
れる電波を捕捉し移動体の位置、速度信号を出力するG
PS=i信機、上記慣性基準装置とGPS受信機との出
力を受は両出力の差である観測はクトルに基づいて慣性
基準装置の出力を補正する誤差ベクトルを出力するカル
マンフィルタ及び上記カルマンフィルタにGPS受信機
で検知された移動体の位置と衛星の位置との相対関係に
応じた観測雑音の誤差修正出力を出力する手段とを設け
た。
〔作用〕
慣性基準装置からの出力を補正する誤差はクトルは、慣
性基準装置の出力とGPS受信機の出力の差である観測
ベクトルに基づいてカルマン・フィルタ計算によって出
力されるが、更にこのカルマン・フィルタに盛込まれた
観測雑音はGPS受信機で検知された移動体と衛星との
位置との相対的位置関係に応じた誤差修正出力によって
修正される。
従って、GPS受信機が出力する位置・速度信号の誤差
は移動体の位置に応じて正確に修正される。
このように実際に合った観測誤差を表わす誤差修正出力
を用いて正確に観測雑音を修正することによって、慣性
基準装置が出力する位置、速度に含まれる誤差を精度が
劣化することなく補正することが可能である。
〔実施例〕
航空機に適用された本発明の一実施例を第1図〜第4図
によって説明する。第2図に示すように、慣性基準装置
1は、ジャイロ、加速度計を備えたセンサブロック11
と計算機部12を備えていて、ジャイロ、加速度計の検
出値に基づいて航空機の位置n、速度n及び姿勢角21
についての信号を出力する。
第3図に示すように、GPS受信機は航空機Pに搭載さ
れていて、4コの衛星A、 B、 C,D、  ・・・
・から送信される電波を受信する。衛星からの電波は、
時刻、衛星位置等のデータを含んでいて、GP8受信機
はこれを捕捉して航空機の3次元位置が測定され位置及
び速度信号が出力される。
第1図に示すように、慣性基準装置1及びGPS受信機
2の位置・速度信号がカルマンフィルタ3ニ入力され、
カルマンフィルタではこの両信号の差であるH 1ff
l+ベクトルを計算し、これに基づいて誤差ベクトルを
出力する。
更に本実施例においては、誤差修正計算部2aがGPS
受信機2に設けられる。同計算部2aにおいては、例え
ば航空機の位置と衛星の位置との相対関係によるGPS
受信機の位置誤差の劣化の度合いを表わす値として用い
られる誤差修正(PDOP;  Po5ition D
ilution of Precision)を計算す
る機能等航空機の位置と衛星との位置の相対関係によっ
て生ずるGPS受信機の観測誤差を計算する機能を有し
ている。即ち、第4図に示すように、GPS受信機で検
出した時刻及び自機の位置(緯度、経度) 2a−1,
2a−2を入力して、4個の衛星A、B、C,D を還
択してそれらの視線(Line  of Sight、
  LO8)−?クトル(BA 、+23.、(B。。
■、を得る。次に、これら視線ベクトルの転置行列(a
、T を行列の要素としたIHとその転置行列出7との
積の逆行列により、配置にともなう誤差であるGPS誤
差共分散6を求めるっ誤差修正は、このGPS誤差共分
散Gの対角成分を二乗和したものの平方根として求めら
れる7 この誤差修正が、第1図の誤差修正部2aからの出力と
してカルマンフィルタ3に入力され誤差ベクトルの生成
を行う。ここでカルマンフィルタ3は、第5図のフロー
チャートに従って、時々開側誤差修正PDOP  を入
力しつつカルマンゲインIKn及び観測雑音IRnを演
算し、慣性基準装置t1とGPS受信機2とから構成さ
れる装置の差及び速度の差からなる観測ベクトル、zn
を入力して前記のカルマンゲインIKnとから誤差ベク
トル9n(+1を演算し、これを第1図の慣性基準装[
11の補正部1aに時々刻々出力する。
この補正部1aは第2図に示すように前記の誤差ベクト
ル(姿勢角、位置、速度)を、それぞれ方向余弦行列更
新器1位置計算器及び速度計算器に入力して計算を行い
、誤差の少ない姿勢角21、位1f22、速度n信号を
出力する。
本実施例は以上のように構成されているので。
航空機と衛星との相対的位置関係に応じた誤差修正信号
によってカルマンフィルタ3においてGPS受信機出力
と慣性基準装置出力の差である観測ベクトルを入力し、
修正された観測雑音に基づいて誤差ベクトルが出力され
て慣性基準装置の出力が補正されることになる。
従って、カルマンフィルタには航空機の位置と衛星位置
の相対関係に応じ常に実際に合った誤差修正信号が入力
されて観測雑音が修正され、その修正された観測雑音に
基いて誤差ベクトルが補正されること〜なるので、精度
面で常時安定した性能をもつ位置速度測定装置を実現す
ることができる。
〔発明の効果〕
以上実施例について具体的に説明したように、本発明は
次の効果を挙げることができる。
即ち、GPS受信機出力と慣性基準装置の出力との差で
ある観測ベクトルをもとに、カルマンフィルタにおいて
林動体の位置と衛星の位置の相対関係に応じた誤差修正
信号によって修正された観測雑音に基づいて計算された
誤差ベクトルによって慣性基準装置の出力が補正される
こと〜なるので、航空機と衛星との相対的位置関係によ
って時々刻々変化するGPS受信機出力の誤差を正確に
修正することができ、従って、位置速度測定装置の精度
を上げ、かつこれを常時安定させることができる。
【図面の簡単な説明】
第1図は本発明の一実施例の説明図。 第2図は上記実施例に用いられる慣性基準装置の説明図
、 第3図は上記実施例に用いられるGPS受信機による測
位の説明図、 第4図は上記実施例における誤差修正計算部の説明図、 第5図はカルマン・フィルタでの計算の説明図、第6図
は従来の位置速度測定装置の説明図である。 図面中、 1は慣性基準装置、 1aは慣性基準装置に設けられた補正部、2はGPS受
信機、 2aはGPS受信機に設けられた誤差修正部、3はカル
マンフィルタ をそれぞれ示す。 代理人 弁理士 坂 間  暁 外2名第1図 11)、1(−):観測更祈泊の訣矛共分散行列lr;
)n(+>:観、測更tr夜の捩基共分敢行列IKn 
 :カルマンゲイン IFn:訣基モデルの状態遷移行列 Q:W!、モデルのシステム雑音 jR:観測錐肯 jH:観、測行列 足 ;単位行列 Jon(−):観測更♀片前の談基推定値父n(十):
観測更新後の誤差推定値 Zn ;観瀝り1皇〔 たた゛し、帰字几1コn番目の値な表わす。 第5図 躍?。 ! ズ諸(4)

Claims (1)

    【特許請求の範囲】
  1.  移動体の位置と速度の信号を出力する慣性基準装置、
    衛星から送信される電波を捕捉し移動体の位置と速度の
    信号を出力する全地球測位システム受信機、上記慣性基
    準装置と全地球測位システム受信機との出力を受けこの
    両出力の差である観測ベクトルに基づいて慣性基準装置
    の出力を補正する誤差ベクトルを出力するカルマンフィ
    ルタ、及び全地球測位システム受信機で検知された移動
    体の位置と衛星の位置との相対的位置関係に応じた観測
    雑音の誤差修正出力をカルマンフィルタに出力する手段
    を有することを特徴とする移動体の位置速度測定装置。
JP13827587A 1987-06-03 1987-06-03 移動体の位置速度測定装置 Pending JPS63302317A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP13827587A JPS63302317A (ja) 1987-06-03 1987-06-03 移動体の位置速度測定装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP13827587A JPS63302317A (ja) 1987-06-03 1987-06-03 移動体の位置速度測定装置

Publications (1)

Publication Number Publication Date
JPS63302317A true JPS63302317A (ja) 1988-12-09

Family

ID=15218106

Family Applications (1)

Application Number Title Priority Date Filing Date
JP13827587A Pending JPS63302317A (ja) 1987-06-03 1987-06-03 移動体の位置速度測定装置

Country Status (1)

Country Link
JP (1) JPS63302317A (ja)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2680886A1 (fr) * 1991-08-30 1993-03-05 Realisa Electroniques Et Procede de determination de la situation de l'organe terminal d'un robot et agencement pour la mise en óoeuvre du procede.
WO1997008514A1 (fr) * 1995-08-28 1997-03-06 Data Tec Co., Ltd. Detecteur de mouvement
WO1998018016A1 (en) * 1996-10-23 1998-04-30 Honeywell Inc. Gps/irs global position determination method and apparatus with integrity loss provisions
US6081230A (en) * 1994-11-29 2000-06-27 Xanavi Informatics Corporation Navigation system furnished with means for estimating error of mounted sensor
WO2007148546A1 (ja) * 2006-06-21 2007-12-27 Toyota Jidosha Kabushiki Kaisha 測位装置
JP2012193965A (ja) * 2011-03-15 2012-10-11 Mitsubishi Electric Corp 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム
WO2020021867A1 (ja) 2018-07-24 2020-01-30 日本航空電子工業株式会社 ジオイド測定方法、ジオイド測定装置、ジオイド推定装置、ジオイド計算用データ収集装置

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2680886A1 (fr) * 1991-08-30 1993-03-05 Realisa Electroniques Et Procede de determination de la situation de l'organe terminal d'un robot et agencement pour la mise en óoeuvre du procede.
US6081230A (en) * 1994-11-29 2000-06-27 Xanavi Informatics Corporation Navigation system furnished with means for estimating error of mounted sensor
WO1997008514A1 (fr) * 1995-08-28 1997-03-06 Data Tec Co., Ltd. Detecteur de mouvement
US5828987A (en) * 1995-08-28 1998-10-27 Data Tec Co., Ltd. Movement detecting device
WO1998018016A1 (en) * 1996-10-23 1998-04-30 Honeywell Inc. Gps/irs global position determination method and apparatus with integrity loss provisions
JP2008002906A (ja) * 2006-06-21 2008-01-10 Toyota Motor Corp 測位装置
WO2007148546A1 (ja) * 2006-06-21 2007-12-27 Toyota Jidosha Kabushiki Kaisha 測位装置
JP4600357B2 (ja) * 2006-06-21 2010-12-15 トヨタ自動車株式会社 測位装置
US8725412B2 (en) 2006-06-21 2014-05-13 Toyota Jidosha Kabushiki Kaisha Positioning device
JP2012193965A (ja) * 2011-03-15 2012-10-11 Mitsubishi Electric Corp 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム
WO2020021867A1 (ja) 2018-07-24 2020-01-30 日本航空電子工業株式会社 ジオイド測定方法、ジオイド測定装置、ジオイド推定装置、ジオイド計算用データ収集装置
US11378397B2 (en) 2018-07-24 2022-07-05 Japan Aviation Electronics Industry, Limited Geoid measurement method, geoid measurement apparatus, geoid estimation device, and geoid calculation data collection device
EP4033204A1 (en) 2018-07-24 2022-07-27 Japan Aviation Electronics Industry, Limited Geoid estimation device, and geoid calculation data collection device
US11585657B2 (en) 2018-07-24 2023-02-21 Japan Aviation Electronics Industry, Limited Geoid measurement method, geoid measurement apparatus, geoid estimation device, and geoid calculation data collection device

Similar Documents

Publication Publication Date Title
US5787384A (en) Apparatus and method for determining velocity of a platform
US7328104B2 (en) Systems and methods for improved inertial navigation
US8311739B2 (en) Inertial navigation system error correction
JP5237723B2 (ja) 動的に較正されるセンサデータと、ナビゲーションシステム内の繰り返し拡張カルマンフィルタとを使用する、ジャイロコンパスの整合用のシステム及び方法
US6622091B2 (en) Method and system for calibrating an IG/GP navigational system
US5757316A (en) Attitude determination utilizing an inertial measurement unit and a plurality of satellite transmitters
US5543804A (en) Navagation apparatus with improved attitude determination
JP4199553B2 (ja) ハイブリッド航法装置
CN110133700B (zh) 一种船载综合导航定位方法
JP2000502803A (ja) 改良された車両ナビゲーションシステム用ゼロ運動検出システム
JPS5936208B2 (ja) 航空機の慣性台を迅速に整列させる方法および装置
JP2000502801A (ja) 多重軸加速度計を使用する改良された車両ナビゲーションシステム及びその方法
JPS63302317A (ja) 移動体の位置速度測定装置
JP3044357B2 (ja) ジャイロ装置
JP3421706B2 (ja) 車上測位装置
JP2012202749A (ja) 方位測定装置
RU2754396C1 (ru) Адаптивный способ коррекции углов ориентации БИНС
JPH0949737A (ja) 航法信号出力方法
JP2946051B2 (ja) ジャイロ装置
JP2618051B2 (ja) 移動体用ナビゲーション装置
JP2711931B2 (ja) ジャイロ装置
RU2428659C2 (ru) Способ спутниковой коррекции гироскопических навигационных систем морских объектов
RU2178147C1 (ru) Комплексная навигационная система
JPH0785019B2 (ja) 船首方位計測装置
KR102093888B1 (ko) 보조 항법 장치 및 보조 항법 장치의 제어 방법