JP2002540389A - 高度推定装置 - Google Patents
高度推定装置Info
- Publication number
- JP2002540389A JP2002540389A JP2000606957A JP2000606957A JP2002540389A JP 2002540389 A JP2002540389 A JP 2002540389A JP 2000606957 A JP2000606957 A JP 2000606957A JP 2000606957 A JP2000606957 A JP 2000606957A JP 2002540389 A JP2002540389 A JP 2002540389A
- Authority
- JP
- Japan
- Prior art keywords
- altitude
- error
- vehicle
- vertical
- estimate
- 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
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/005—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels altimeters for aircraft
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Radar Systems Or Details Thereof (AREA)
- Navigation (AREA)
Abstract
(57)【要約】
第1の基準表面(3)上のビークル(2)の第1の高度(1)を推定するための装置であって、該ビークルの垂直方向の特定の力を示す出力信号(5)を送出するように動作可能な少くとも1つのセンシング手段(4b)を組込んだ、位置、速度及び姿勢を判断するためのシステム(4)と、入力信号として該ビークル(2)の水平基準速度と位置(4a)と、第2の基準表面(8)上の該ビークル(2)の第2の高度(1b)についてのレーダ高度計測定値(7)とを受領して、該センシング手段出力信号(5)と関係した誤差の出力信号推定を送出するための誤差推定手段(6)と、該センシング手段と誤差推定手段との出力信号(5,9)を受領して、垂直方向の特定の力を示す該信号から該誤差推定を減算しながらこの減算の結果の二重積分を実行して、所用の推定された第1の高度(1)を示す出力を送出するための積分手段(10)とを含む装置。
Description
【0001】
この発明は高度推定用の装置と方法とに係り、これに限定するのではないがと
くに第1の基準表面の上のビークルの第1の高度を推定するための装置と方法と
に関する。
くに第1の基準表面の上のビークルの第1の高度を推定するための装置と方法と
に関する。
【0002】
通常の装置として航空機航法システムにおいて固定基準表面上の航空機の高度
を推定するために使用されているものは、バロアルチメータ(気圧式高度計)の
ような計器を含んでいて海面上の高度を推定したり、レーダ高度計のような計器
を含んでいて地面上の高さを推定したりしており、また航空機に対する妨害物か
らの高度を推定するためにレーザ及びレーダ装置の各種の構成を含んでいる。バ
ロアルチメータ測定値は航空機の航法システムからの各種の出力と組合されて、
気圧・慣性(バロ・イナーシャル)高度を与え、これが海面上の航空機の高度の
推定値となる。気圧・慣性高度は上述した各種の高度測定値の中で精度の低いも
のであり、その理由は気圧高度計の性能が大気状態と航空機の飛行力学とに依存
していることによる。
を推定するために使用されているものは、バロアルチメータ(気圧式高度計)の
ような計器を含んでいて海面上の高度を推定したり、レーダ高度計のような計器
を含んでいて地面上の高さを推定したりしており、また航空機に対する妨害物か
らの高度を推定するためにレーザ及びレーダ装置の各種の構成を含んでいる。バ
ロアルチメータ測定値は航空機の航法システムからの各種の出力と組合されて、
気圧・慣性(バロ・イナーシャル)高度を与え、これが海面上の航空機の高度の
推定値となる。気圧・慣性高度は上述した各種の高度測定値の中で精度の低いも
のであり、その理由は気圧高度計の性能が大気状態と航空機の飛行力学とに依存
していることによる。
【0003】
各種のシステムが海面上の高度を推定するための代替えとして使用可能であり
、これらのシステムは気圧高度計入力の一部もしくは全体に依存してはいない。
こういったものには二次サーベイランス(探査)レーダを使用することを含んで
いて、その場合に航空機外の本体が航空機についての測定した高度を無線により
報告することとしているが、これはその高度をその航空機に向けて誰かもしくは
何かが通信することを必要とし、また関連のサーベイランス計装を航空機上の航
法用計装に加えて測定を実行するために必要としているということの制約を受け
ることになる。別な代替には衛星測距三角測量システムからの高度出力を用いる
ことを含み、このシステムの例にはグローバルポジショニングシステム(GPS
)としてNATOの無分類報告書であるSTANAG 4294(Military Age
ncy for Standardisation刊)に記載されたものがあるが、これは利用可能な衛
星信号に依存していたり、レーダ高度計測定を用いたりするものであって、これ
は大地レベル上の高さを測定するものであるから、海から著しい距離に大地レベ
ルがある山岳地帯用としては不適切なものである。
、これらのシステムは気圧高度計入力の一部もしくは全体に依存してはいない。
こういったものには二次サーベイランス(探査)レーダを使用することを含んで
いて、その場合に航空機外の本体が航空機についての測定した高度を無線により
報告することとしているが、これはその高度をその航空機に向けて誰かもしくは
何かが通信することを必要とし、また関連のサーベイランス計装を航空機上の航
法用計装に加えて測定を実行するために必要としているということの制約を受け
ることになる。別な代替には衛星測距三角測量システムからの高度出力を用いる
ことを含み、このシステムの例にはグローバルポジショニングシステム(GPS
)としてNATOの無分類報告書であるSTANAG 4294(Military Age
ncy for Standardisation刊)に記載されたものがあるが、これは利用可能な衛
星信号に依存していたり、レーダ高度計測定を用いたりするものであって、これ
は大地レベル上の高さを測定するものであるから、海から著しい距離に大地レベ
ルがある山岳地帯用としては不適切なものである。
【0004】
そこで改良された高度推定用装置が必要とされ、この装置は飛行力学と大気状
態とから実質的に独立していて、また海面上の高度を推定できるものである。
態とから実質的に独立していて、また海面上の高度を推定できるものである。
【0005】 この発明の第1の特徴によると、第1の基準表面上のビークルの第1の高度を
推定するための装置が提供されていて、該装置は、該ビークルの垂直方向の特定
の力を示す出力信号を送出するように動作可能な少くとも1つのセンシング手段
を組込んだ、位置、速度及び姿勢を判断するためのシステムと、入力信号として
該ビークルの水平基準速度と位置と、第2の基準表面上の該ビークルの第2の高
度についてのレーダ高度計測定値とを受領して、該センシング手段出力信号と関
係した誤差の出力信号推定を送出するための誤差推定手段と、該センシング手段
と誤差推定手段との出力信号を受領して、垂直方向の特定の力を示す該信号から
該誤差推定を減算しながらこの減算の結果の二重積分を実行して、所用の推定さ
れた第1の高度を示す出力を送出するための積分手段とを含んでいる。
推定するための装置が提供されていて、該装置は、該ビークルの垂直方向の特定
の力を示す出力信号を送出するように動作可能な少くとも1つのセンシング手段
を組込んだ、位置、速度及び姿勢を判断するためのシステムと、入力信号として
該ビークルの水平基準速度と位置と、第2の基準表面上の該ビークルの第2の高
度についてのレーダ高度計測定値とを受領して、該センシング手段出力信号と関
係した誤差の出力信号推定を送出するための誤差推定手段と、該センシング手段
と誤差推定手段との出力信号を受領して、垂直方向の特定の力を示す該信号から
該誤差推定を減算しながらこの減算の結果の二重積分を実行して、所用の推定さ
れた第1の高度を示す出力を送出するための積分手段とを含んでいる。
【0006】 好ましいのは、前記少くとも1つのセンシング手段が、前記ビークルの垂直方
向の特定の力を示す出力信号を送出するように動作可能な慣性垂直方向特定力セ
ンサであることである。
向の特定の力を示す出力信号を送出するように動作可能な慣性垂直方向特定力セ
ンサであることである。
【0007】 便利なのは、前記第1の基準表面が海面レベルであり、また前記第2の基準表
面は大地レベルであることである。
面は大地レベルであることである。
【0008】 好都合なのは、前記誤差推定手段がカルマンフィルタと重力補正器とを含んで
いることである。
いることである。
【0009】 好ましいのは、第1,第2,及び第3の推定器ステーションを含み、そこには
前記センシング手段出力信号と関係する誤差の出力信号推定が記憶されているこ
とである。
前記センシング手段出力信号と関係する誤差の出力信号推定が記憶されているこ
とである。
【0010】 便利なのは、前記積分手段が第1と第2の減算器と第1と第2の積分器とを含
むことである。
むことである。
【0011】 好都合なのは、前記カルマンフィルタへの入力を形成するビークルの水平速度
と位置とが前記位置、速度及び姿勢を判断するためのシステムにより与えられて
いることである。
と位置とが前記位置、速度及び姿勢を判断するためのシステムにより与えられて
いることである。
【0012】 この発明の別な特徴によると、第1の基準表面上のビークルの第1の高度を推
定するための方法が提供されていて、この方法は、該ビークルの垂直方向の特定
の力を示す出力信号を用意するためにビークルの位置と速度と高度とを判断する
ためのシステムの一部を形成している少くとも1つのセンシング手段を動作させ
る段階と、該ビークルの水平速度と位置と第2の基準表面上の該ビークルの第2
の高さについてのレーダ高度計測定値とを誤差推定手段に入力する段階と、該誤
差手段内に該センシング手段出力信号と関係する誤差の推定を設定する段階と、
該センシング手段出力信号から該誤差の推定を減算しながら減算の結果の二重積
分を実行して所要の推定された第1の高度を用意する段階とを含んでいる。
定するための方法が提供されていて、この方法は、該ビークルの垂直方向の特定
の力を示す出力信号を用意するためにビークルの位置と速度と高度とを判断する
ためのシステムの一部を形成している少くとも1つのセンシング手段を動作させ
る段階と、該ビークルの水平速度と位置と第2の基準表面上の該ビークルの第2
の高さについてのレーダ高度計測定値とを誤差推定手段に入力する段階と、該誤
差手段内に該センシング手段出力信号と関係する誤差の推定を設定する段階と、
該センシング手段出力信号から該誤差の推定を減算しながら減算の結果の二重積
分を実行して所要の推定された第1の高度を用意する段階とを含んでいる。
【0013】 好ましいのは、前記二重積分が第1の積分として垂直方向速度を与えるために
垂直方向の特定の力を積分する第1の積分と、第2の積分として所要の推定され
た第1の高度を用意するために垂直方向の速度を積分する第2の積分とを含んで
いることである。
垂直方向の特定の力を積分する第1の積分と、第2の積分として所要の推定され
た第1の高度を用意するために垂直方向の速度を積分する第2の積分とを含んで
いることである。
【0014】 便利なのは、前記少くとも1つのセンシング手段は垂直方向の特定の力のセン
サであり、カルマンフィルタにより用意される垂直方向の特定の力と関係したバ
イアスの推定値とともに、垂直速度誤差の推定値と、位置、速度及び姿勢を判断
するためのシステムと関係する垂直高度誤差の推定値をも伴うものである。
サであり、カルマンフィルタにより用意される垂直方向の特定の力と関係したバ
イアスの推定値とともに、垂直速度誤差の推定値と、位置、速度及び姿勢を判断
するためのシステムと関係する垂直高度誤差の推定値をも伴うものである。
【0015】 好都合なのは、前記誤差の推定の減算では、第1の減算が第1の積分を実行し
ながら進められ、かつ特定の力のセンサと関係したバイアスの推定と重力補正器
により供給された重力の補正を前記垂直の特定の力から連続ベースで減算し、併
せて離散的な間隔で垂直方向の速度誤差の減算し、また、第2の減算が離散的な
間隔で第2の積分を進めて垂直の高度誤差推定を減算して所要の推定された第1
の高度を送出することを含むことである。
ながら進められ、かつ特定の力のセンサと関係したバイアスの推定と重力補正器
により供給された重力の補正を前記垂直の特定の力から連続ベースで減算し、併
せて離散的な間隔で垂直方向の速度誤差の減算し、また、第2の減算が離散的な
間隔で第2の積分を進めて垂直の高度誤差推定を減算して所要の推定された第1
の高度を送出することを含むことである。
【0016】 好ましいのは、前記二重積分は実質的に50Hzの処理サイクル周波数で進め
られて、所要の推定された第1の高度を実質的に50Hzの出力レートで出力し
、第2の基準表面上のビークルの第2の高度のレーダ高度計測定値は実質的に1
2.5Hzの入力レートで推定手段に入力され、またここでは垂直方向の特定の
力のセンサのバイアスの推定と、重力の推定と、垂直方向の速度誤差推定と垂直
方向の高さ誤差推定とが2ないし4Hz範囲の補正サイクル周波数をもって二重
積分を補正するために使用されることである。
られて、所要の推定された第1の高度を実質的に50Hzの出力レートで出力し
、第2の基準表面上のビークルの第2の高度のレーダ高度計測定値は実質的に1
2.5Hzの入力レートで推定手段に入力され、またここでは垂直方向の特定の
力のセンサのバイアスの推定と、重力の推定と、垂直方向の速度誤差推定と垂直
方向の高さ誤差推定とが2ないし4Hz範囲の補正サイクル周波数をもって二重
積分を補正するために使用されることである。
【0017】
この発明をよりよく理解するためにまたどのように実効をあげるかを示すため
に添付の図面を参照して例を挙げて行く。
に添付の図面を参照して例を挙げて行く。
【0018】 この発明の装置は図1と2とに示すように第1の基準表面上のビークルの第1
の高度を推定するためのものであり、第1の高度の推定が大気及び力学的条件の
変動と実質的に独立していることを求められる状態で使用することが意図されて
いる。このような装置はしたがって、飛行しているビークルの航法システムでの
使用にとくに適していて、ことに気圧高度計のような標準高度測定装置に対する
置換用として適しており、大気条件と航空機の飛行力学とに感度を有しているも
のに置換される。
の高度を推定するためのものであり、第1の高度の推定が大気及び力学的条件の
変動と実質的に独立していることを求められる状態で使用することが意図されて
いる。このような装置はしたがって、飛行しているビークルの航法システムでの
使用にとくに適していて、ことに気圧高度計のような標準高度測定装置に対する
置換用として適しており、大気条件と航空機の飛行力学とに感度を有しているも
のに置換される。
【0019】 添付の図1と2とに示したように、第1の基準面3上のビークル2の第1の高
度を推定するための装置は、位置、速度及び姿勢を判断するためのシステムを含
み、そこにはビークル2の垂直方向の特定の力を示す出力信号5を送出するよう
に動作する少くとも1つのセンシング手段4bが組込まれている。この装置はま
た誤差推定用の手段として、好ましいのは重力補正器19とカルマンフィルタ6
とを含んでいる。カルマンフィルタ6は入力信号として第2の基準表面8上のビ
ークル2の第2の高度1bのレーダ高度測定値7を受入れ、またシステム4によ
って与えることができる水平面内の基準速度と位置とを受入れて、出力信号とし
てセンシング手段出力信号5と関係した誤差の推定を送出するようにしている。
出力信号9の誤差の推定は第1,第2,及び第3の推定器ステーション15,1
6,17で記憶される。
度を推定するための装置は、位置、速度及び姿勢を判断するためのシステムを含
み、そこにはビークル2の垂直方向の特定の力を示す出力信号5を送出するよう
に動作する少くとも1つのセンシング手段4bが組込まれている。この装置はま
た誤差推定用の手段として、好ましいのは重力補正器19とカルマンフィルタ6
とを含んでいる。カルマンフィルタ6は入力信号として第2の基準表面8上のビ
ークル2の第2の高度1bのレーダ高度測定値7を受入れ、またシステム4によ
って与えることができる水平面内の基準速度と位置とを受入れて、出力信号とし
てセンシング手段出力信号5と関係した誤差の推定を送出するようにしている。
出力信号9の誤差の推定は第1,第2,及び第3の推定器ステーション15,1
6,17で記憶される。
【0020】 積分用手段10はこの装置の別の部分を形成していて、この積分用手段は前記
センシング手段と誤差推定手段の出力信号5,9を受領して処理するものである
。この処理は第1と第2の減算器20,21における垂直方向の特定の力を示す
信号5から誤差の推定を減算しながら、減算の結果について第1と第2の積分器
11,12において二重積分を実行することを含んでいて、それにより所要の推
定された第1の高度1を示す出力を送出する。
センシング手段と誤差推定手段の出力信号5,9を受領して処理するものである
。この処理は第1と第2の減算器20,21における垂直方向の特定の力を示す
信号5から誤差の推定を減算しながら、減算の結果について第1と第2の積分器
11,12において二重積分を実行することを含んでいて、それにより所要の推
定された第1の高度1を示す出力を送出する。
【0021】 少くとも1つのセンシング手段4bは慣性垂直方向特定力センサであるのがよ
く、それがビークルに働く垂直方向の特定の力を示す出力信号5を送出するよう
に動作するものとする。図1に示すように、第1の基準表面3は海面レベルであ
り、第2の基準表面は大地レベル8であって、第1の高度推定1はそこで海面レ
ベル上のビークルの高度の推定を与えている。
く、それがビークルに働く垂直方向の特定の力を示す出力信号5を送出するよう
に動作するものとする。図1に示すように、第1の基準表面3は海面レベルであ
り、第2の基準表面は大地レベル8であって、第1の高度推定1はそこで海面レ
ベル上のビークルの高度の推定を与えている。
【0022】 この発明の装置で上記したものはこの発明の方法を実施することによって、第
1の基準表面3の上のビークル2の第1の高度1を推定するように動作する。こ
の発明の方法は少くとも1つのセンシング手段4bを動作してビークル2の垂直
方向の特定の力を示す出力信号を送出するようにする段階と、レーダ高度計測定
値7を誤差推定用手段6に入力する段階とを含んでいる。誤差推定用手段への別
の入力は水平位置と速度4aを含んでいて、それがシステム4によって位置と速
度と姿勢とを判断するために用意されるのが好ましい。
1の基準表面3の上のビークル2の第1の高度1を推定するように動作する。こ
の発明の方法は少くとも1つのセンシング手段4bを動作してビークル2の垂直
方向の特定の力を示す出力信号を送出するようにする段階と、レーダ高度計測定
値7を誤差推定用手段6に入力する段階とを含んでいる。誤差推定用手段への別
の入力は水平位置と速度4aを含んでいて、それがシステム4によって位置と速
度と姿勢とを判断するために用意されるのが好ましい。
【0023】 この方法では、積分用手段10が誤差の推定値をセンシング手段出力信号5か
ら減算をしながらこの減算結果を二重積分する段階を結合している。二重積分は
第1の積分器11による第1の積分を含み、この第1の積分は垂直方向の特定の
力を積分して垂直方向速度を与えるようにし、また第2の積分器12による第2
の積分を含み、この第2の積分は所要の第1の高度1の推定値を与えるために垂
直方向の速度を積分する。誤差の推定は、垂直方向(の)特定(の)力(の)セ
ンサと関係したバイアスの推定を含んでいて、これは推定器ステーション15に
記憶されており、また垂直方向の速度誤差の推定を含んでいて、これは推定器ス
テーション16に記憶されていて、さらに垂直の高度誤差を含んでいてこれが推
定器ステーション17に記憶されていて、こういったもののすべてが図2に示し
たカルマンフィルタ6によって与えられている。
ら減算をしながらこの減算結果を二重積分する段階を結合している。二重積分は
第1の積分器11による第1の積分を含み、この第1の積分は垂直方向の特定の
力を積分して垂直方向速度を与えるようにし、また第2の積分器12による第2
の積分を含み、この第2の積分は所要の第1の高度1の推定値を与えるために垂
直方向の速度を積分する。誤差の推定は、垂直方向(の)特定(の)力(の)セ
ンサと関係したバイアスの推定を含んでいて、これは推定器ステーション15に
記憶されており、また垂直方向の速度誤差の推定を含んでいて、これは推定器ス
テーション16に記憶されていて、さらに垂直の高度誤差を含んでいてこれが推
定器ステーション17に記憶されていて、こういったもののすべてが図2に示し
たカルマンフィルタ6によって与えられている。
【0024】 推定器ステーション15,16,17に記憶された誤差の推定についての減算
は第1の減算器20における第1の減算と、第2の減算器21における第2の減
算を含んでいる。第1の減算は連続ベースで実行され、またその間に第1の積分
が実行され、さらに特定の力センサと関係したバイアスの推定と、重力補正器1
9により供給された重力に対する補正とが前記垂直方向の特定の力から減算され
る。第1の減算はまた垂直方向の速度誤差を離散的な間隔で第1の積分から減算
することを含み、これが模式的に図2の第1のスイッチ13によって示されてい
て、それ故に垂直方向の速度誤差の減算は減算器20に間欠的に影響を与えてい
る。こういった誤差の推定で推定器ステーション15,16と重力補正器19か
ら出力されたものは、減算器20への総合的入力18aとして示されていて、収
集ステーション18bで先ず同期がとられている。第2の減算は第2の積分とし
て離散的な間隔で実行され、それが図2の第2のスイッチ14により示されてい
る。重力19に対する補正は地球表面上の赤道における重力に関して緯度と高度
について補正をし、別なセンシング手段(図示せず)からの出力を第1の高度1
についての推定値と一緒に使用して推定されるのがよい。
は第1の減算器20における第1の減算と、第2の減算器21における第2の減
算を含んでいる。第1の減算は連続ベースで実行され、またその間に第1の積分
が実行され、さらに特定の力センサと関係したバイアスの推定と、重力補正器1
9により供給された重力に対する補正とが前記垂直方向の特定の力から減算され
る。第1の減算はまた垂直方向の速度誤差を離散的な間隔で第1の積分から減算
することを含み、これが模式的に図2の第1のスイッチ13によって示されてい
て、それ故に垂直方向の速度誤差の減算は減算器20に間欠的に影響を与えてい
る。こういった誤差の推定で推定器ステーション15,16と重力補正器19か
ら出力されたものは、減算器20への総合的入力18aとして示されていて、収
集ステーション18bで先ず同期がとられている。第2の減算は第2の積分とし
て離散的な間隔で実行され、それが図2の第2のスイッチ14により示されてい
る。重力19に対する補正は地球表面上の赤道における重力に関して緯度と高度
について補正をし、別なセンシング手段(図示せず)からの出力を第1の高度1
についての推定値と一緒に使用して推定されるのがよい。
【0025】 上記の方法が成功する動作は積分用手段10への各種入力の同期にかかってお
り、好ましいタイミング計画は次のようなものである。積分用手段10が実質的
に50Hzの処理サイクル周波数で行なわれて、実質的に50Hzで第1の高度
の推定を出力する。第2の高度1bの推定が誤差推定用手段6に約12.5Hz
のレートで入力されて、誤差推定出力で推定器ステーション15,16,17か
らのものが2ないし4Hzの間のレートで積分用手段を更新するために送られる
。更新が一旦行なわれると、推定器ステーション15,16,17からの積分用
手段に向けた入力が零にリセットされて、誤差推定は更新サイクルについて一度
限り適用されるようにする。
り、好ましいタイミング計画は次のようなものである。積分用手段10が実質的
に50Hzの処理サイクル周波数で行なわれて、実質的に50Hzで第1の高度
の推定を出力する。第2の高度1bの推定が誤差推定用手段6に約12.5Hz
のレートで入力されて、誤差推定出力で推定器ステーション15,16,17か
らのものが2ないし4Hzの間のレートで積分用手段を更新するために送られる
。更新が一旦行なわれると、推定器ステーション15,16,17からの積分用
手段に向けた入力が零にリセットされて、誤差推定は更新サイクルについて一度
限り適用されるようにする。
【図1】 飛行しているビークルの典型的な軌跡に対する第1と第2の基準表面の斜視図
。
。
【図2】 図1の2つの基準表面のうちの第1のものの上でのビークルの第1の高度を推
定する本発明の方法を実行する本発明の装置を示すブロック図。
定する本発明の方法を実行する本発明の装置を示すブロック図。
───────────────────────────────────────────────────── フロントページの続き (81)指定国 EP(AT,BE,CH,CY, DE,DK,ES,FI,FR,GB,GR,IE,I T,LU,MC,NL,PT,SE),OA(BF,BJ ,CF,CG,CI,CM,GA,GN,GW,ML, MR,NE,SN,TD,TG),AP(GH,GM,K E,LS,MW,SD,SL,SZ,TZ,UG,ZW ),EA(AM,AZ,BY,KG,KZ,MD,RU, TJ,TM),AE,AG,AL,AM,AT,AU, AZ,BA,BB,BG,BR,BY,CA,CH,C N,CR,CU,CZ,DE,DK,DM,DZ,EE ,ES,FI,GB,GD,GE,GH,GM,HR, HU,ID,IL,IN,IS,JP,KE,KG,K P,KR,KZ,LC,LK,LR,LS,LT,LU ,LV,MA,MD,MG,MK,MN,MW,MX, NO,NZ,PL,PT,RO,RU,SD,SE,S G,SI,SK,SL,TJ,TM,TR,TT,TZ ,UA,UG,US,UZ,VN,YU,ZA,ZW
Claims (12)
- 【請求項1】 第1の基準表面上のビークルの第1の高度を推定するための
装置であって、 該ビークルの垂直方向の特定の力を示す出力信号を送出するように動作可能な少
くとも1つのセンシング手段を組込んだ、位置、速度及び姿勢を判断するための
システムと、 入力信号として該ビークルの水平基準速度と位置と、第2の基準表面上の該ビー
クルの第2の高度についてのレーダ高度計測定値とを受領して、該センシング手
段出力信号と関係した誤差の出力信号推定を送出するための誤差推定手段と、 該センシング手段と誤差推定手段との出力信号を受領して、垂直方向の特定の力
を示す該信号から該誤差推定を減算しながらこの減算の結果の二重積分を実行し
て、所用の推定された第1の高度を示す出力を送出するための積分手段とを含む
装置。 - 【請求項2】 前記少くとも1つのセンシング手段は、前記ビークルの垂直
方向の特定の力を示す出力信号を送出するように動作可能な慣性垂直方向特定力
センサである請求項1記載の装置。 - 【請求項3】 前記第1の基準表面は海面レベルであり、また前記第2の基
準表面は大地レベルである請求項1又は2記載の装置。 - 【請求項4】 前記誤差推定手段はカルマンフィルタと重力補正器とを含む
請求項3記載の装置。 - 【請求項5】 第1,第2,及び第3の推定器ステーションを含み、そこに
は前記センシング手段出力信号と関係する誤差の出力信号推定が記憶されている
請求項4記載の装置。 - 【請求項6】 前記積分手段は第1と第2の減算器と第1と第2の積分器と
を含む請求項5記載の装置。 - 【請求項7】 前記カルマンフィルタへの入力を形成するビークルの水平速
度と位置とが前記位置、速度及び姿勢を判断するためのシステムにより与えられ
ている請求項6記載の装置。 - 【請求項8】 第1の基準表面上のビークルの第1の高度を推定するための
方法であって、 該ビークルの垂直方向の特定の力を示す出力信号を用意するためにビークルの位
置と速度と高度とを判断するためのシステムの一部を形成している少くとも1つ
のセンシング手段を動作させる段階と、 該ビークルの水平速度と位置と第2の基準表面上の該ビークルの第2の高さにつ
いてのレーダ高度計測定値とを誤差推定手段に入力する段階と、 該誤差推定手段内に該センシング手段出力信号と関係する誤差の推定を設定する
段階と、 該センシング手段出力信号から該誤差の推定を減算しながら減算の結果の二重積
分を実行して所要の推定された第1の高度を用意する段階とを含む方法。 - 【請求項9】 前記二重積分は第1の積分として垂直方向速度を与えるため
に垂直方向の特定の力を積分する第1の積分と、第2の積分として所要の推定さ
れた第1の高度を用意するために垂直方向の速度を積分する第2の積分とを含む
請求項8記載の方法。 - 【請求項10】 前記少くとも1つのセンシング手段は垂直方向の特定の力
のセンサであり、カルマンフィルタにより用意される垂直方向の特定の力と関係
したバイアスの推定値とともに、垂直速度誤差の推定値と、位置、速度及び姿勢
を判断するためのシステムと関係する垂直高度誤差の推定値をも伴うものである
請求項9記載の方法。 - 【請求項11】 前記誤差の推定の減算では、第1の減算が第1の積分を実
行しながら進められ、かつ特定の力のセンサと関係したバイアスの推定と重力補
正器により供給された重力の補正を前記垂直の特定の力から連続ベースで減算し
、併せて離散的な間隔で垂直方向の速度誤差の減算し、また、第2の減算が離散
的な間隔で第2の積分を進めて垂直の高度誤差推定を減算して所要の推定された
第1の高度を送出することを含む請求項10記載の方法。 - 【請求項12】 前記二重積分は実質的に50Hzの処理サイクル周波数で
進められて、所要の推定された第1の高度を実質的に50Hzの出力レートで出
力し、第2の基準表面上のビークルの第2の高度のレーダ高度計測定値は実質的
に12.5Hzの入力レートで推定手段に入力され、またここでは垂直方向の特
定の力のセンサのバイアスの推定と、重力の推定と、垂直方向の速度誤差推定と
垂直方向の高さ誤差推定とが2ないし4Hz範囲の補正サイクル周波数をもって
二重積分を補正するために使用される請求項11記載の方法。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
GBGB9906781.1A GB9906781D0 (en) | 1999-03-24 | 1999-03-24 | Height estimating apparatus |
GB9906781.1 | 1999-03-24 | ||
PCT/GB2000/001057 WO2000057130A1 (en) | 1999-03-24 | 2000-03-21 | Height estimating apparatus |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2002540389A true JP2002540389A (ja) | 2002-11-26 |
Family
ID=10850267
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000606957A Pending JP2002540389A (ja) | 1999-03-24 | 2000-03-21 | 高度推定装置 |
Country Status (8)
Country | Link |
---|---|
US (1) | US6366835B1 (ja) |
EP (1) | EP1137910A1 (ja) |
JP (1) | JP2002540389A (ja) |
AU (1) | AU767537B2 (ja) |
CA (1) | CA2361112A1 (ja) |
GB (1) | GB9906781D0 (ja) |
NO (1) | NO20013779D0 (ja) |
WO (1) | WO2000057130A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003536082A (ja) * | 2000-06-06 | 2003-12-02 | リットン システムズ インコーポレイテッド | 3d自律型インテグリティ監視外挿航法 |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7266446B1 (en) * | 2003-05-13 | 2007-09-04 | Pelosi Michael J | Helmet mounted tracking system and method |
US8374804B2 (en) * | 2010-02-12 | 2013-02-12 | Honeywell International Inc. | Aircraft dynamic pressure estimation system and method |
FR2956491B1 (fr) * | 2010-02-15 | 2012-09-28 | Airbus Operations Sas | Procede et dispositif de surveillance de hauteurs radioaltimetriques d'un aeronef. |
FR2976661B1 (fr) * | 2011-06-17 | 2013-07-05 | Thales Sa | Systeme compact de mesure altimetrique de haute precision. |
CN104316920A (zh) * | 2014-11-11 | 2015-01-28 | 上海无线电设备研究所 | 一种雷达高度计小入射角干涉的海面高度高精度提取方法 |
CN105700550B (zh) * | 2016-01-26 | 2018-06-26 | 深圳市大疆创新科技有限公司 | 无人机及其飞行控制方法与*** |
GB2555806A (en) | 2016-11-09 | 2018-05-16 | Atlantic Inertial Systems Ltd | A navigation system |
CN106647777A (zh) * | 2017-03-09 | 2017-05-10 | 腾讯科技(深圳)有限公司 | 一种飞行控制方法及飞行器 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3296422A (en) | 1962-02-12 | 1967-01-03 | Honeywell Inc | Apparatus for computing true vertical position, velocity and acceleration for aircraft |
US4495580A (en) | 1981-03-30 | 1985-01-22 | E-Systems, Inc. | Navigation system |
DE3677018D1 (de) | 1986-11-12 | 1991-02-21 | Litef Gmbh | Verfahren zur bestimmung der flughoehe eines fluggeraets. |
US5136512A (en) | 1988-06-26 | 1992-08-04 | Cubic Defense Systems, Inc. | Ground collision avoidance system |
DE4013570C2 (de) | 1990-04-27 | 1998-09-10 | Aero Data Flugmestechnik Gmbh | Verfahren und Schaltungsanordnung zur Ermittlung des Erdschwerefeldes |
FR2689668B1 (fr) | 1992-04-07 | 1994-05-20 | Dassault Electronique | Procede et dispositif d'anti-collisions terrain pour aeronef. |
FR2697627B1 (fr) | 1992-11-02 | 1995-01-06 | Aerospatiale | Procédé et dispositif pour l'estimation de l'altitude d'un aéronef. |
US5657232A (en) | 1993-03-17 | 1997-08-12 | Aisin Seiki Kabushiki Kaisha | Onboard positioning system |
US5349347A (en) | 1993-03-29 | 1994-09-20 | Alliedsignal Inc. | Method and apparatus for correcting dynamically induced errors in static pressure, airspeed and airspeed rate |
DE4403190C1 (de) * | 1994-02-02 | 1995-07-27 | Deutsche Forsch Luft Raumfahrt | Verfahren zum Bestimmen der Position eines Flugzeugs aus Beschleunigungsdaten eines Inertialsystems sowie aus Ausgabedaten eines Navigationssystems und Einrichtung zur Durchführung des Verfahrens |
GB2293452B (en) | 1994-09-26 | 1998-07-29 | Sagem | Method for adjusting the altitude given by an altimeter on board an aircraft |
US5657025A (en) | 1995-08-07 | 1997-08-12 | Litton Systems, Inc. | Integrated GPS/inertial navigation apparatus providing improved heading estimates |
US5730394A (en) * | 1995-12-20 | 1998-03-24 | Sikorsky Aircraft Corporation | Vertical performance limit compensator |
US5901927A (en) * | 1996-07-18 | 1999-05-11 | Honeywell Inc. | Ground strike protection function for aircraft autopilot |
US6253166B1 (en) * | 1998-10-05 | 2001-06-26 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Stable algorithm for estimating airdata from flush surface pressure measurements |
-
1999
- 1999-03-24 GB GBGB9906781.1A patent/GB9906781D0/en not_active Ceased
-
2000
- 2000-03-21 EP EP00911110A patent/EP1137910A1/en not_active Withdrawn
- 2000-03-21 AU AU33103/00A patent/AU767537B2/en not_active Ceased
- 2000-03-21 JP JP2000606957A patent/JP2002540389A/ja active Pending
- 2000-03-21 CA CA002361112A patent/CA2361112A1/en not_active Abandoned
- 2000-03-21 WO PCT/GB2000/001057 patent/WO2000057130A1/en not_active Application Discontinuation
- 2000-03-21 US US09/530,875 patent/US6366835B1/en not_active Expired - Fee Related
-
2001
- 2001-08-01 NO NO20013779A patent/NO20013779D0/no not_active Application Discontinuation
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003536082A (ja) * | 2000-06-06 | 2003-12-02 | リットン システムズ インコーポレイテッド | 3d自律型インテグリティ監視外挿航法 |
JP4832703B2 (ja) * | 2000-06-06 | 2011-12-07 | ノースロップ グラマン ガイダンス アンド エレクトロニクス カンパニー インコーポレイテッド | 3d自律型インテグリティ監視外挿航法 |
Also Published As
Publication number | Publication date |
---|---|
NO20013779L (no) | 2001-08-01 |
WO2000057130A1 (en) | 2000-09-28 |
EP1137910A1 (en) | 2001-10-04 |
AU767537B2 (en) | 2003-11-13 |
CA2361112A1 (en) | 2000-09-28 |
GB9906781D0 (en) | 1999-05-19 |
US6366835B1 (en) | 2002-04-02 |
AU3310300A (en) | 2000-10-09 |
NO20013779D0 (no) | 2001-08-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6401036B1 (en) | Heading and position error-correction method and apparatus for vehicle navigation systems | |
US6577952B2 (en) | Position and heading error-correction method and apparatus for vehicle navigation systems | |
JP4014642B2 (ja) | Gps/irsグローバル位置決定方法およびインテグリティ損失の対策を講じた装置 | |
EP0870174B1 (en) | Improved vehicle navigation system and method using gps velocities | |
TW518422B (en) | Positioning and proximity warning method and system thereof for vehicle | |
JP3390794B2 (ja) | 全世界配置システム(gps)衛星を用いた車両追跡システム | |
US5862511A (en) | Vehicle navigation system and method | |
US6512976B1 (en) | Method and system for terrain aided navigation | |
US8600660B2 (en) | Multipath modeling for deep integration | |
EP1582840A1 (en) | Inertial navigation system error correction | |
US10365109B2 (en) | Travel distance estimation device | |
EP1865286A2 (en) | Object locating in restricted environments using personal navigation | |
WO1997024584A1 (en) | A zero motion detection system for improved vehicle navigation system | |
TW591241B (en) | Improved positioning and data integrating method and system thereof | |
JP2000512018A (ja) | 衛星位置決定システムのためのスプーフィング検出システム | |
WO2001020360A9 (en) | Solution separation method and apparatus for ground-augmented global positioning system | |
US20040036650A1 (en) | Remote velocity sensor slaved to an integrated GPS/INS | |
US10732299B2 (en) | Velocity estimation device | |
CN111947681B (zh) | 一种gnss与惯导组合导航位置输出的滤波校正方法 | |
EP0870172B1 (en) | Improved vehicle navigation system and method using a multiple axes accelerometer | |
US20040267444A1 (en) | Hybrid intertial navigation unit with improved altitude integrity | |
US20020188386A1 (en) | GPS based terrain referenced navigation system | |
JPH06341847A (ja) | ナビゲーション装置 | |
JP2002540389A (ja) | 高度推定装置 | |
US5928295A (en) | Method and apparatus for automatic calibration of the wheel track of a movable vehicle |