JP5517389B2 - 相互補完ナビゲーションシステム - Google Patents

相互補完ナビゲーションシステム Download PDF

Info

Publication number
JP5517389B2
JP5517389B2 JP2005189032A JP2005189032A JP5517389B2 JP 5517389 B2 JP5517389 B2 JP 5517389B2 JP 2005189032 A JP2005189032 A JP 2005189032A JP 2005189032 A JP2005189032 A JP 2005189032A JP 5517389 B2 JP5517389 B2 JP 5517389B2
Authority
JP
Japan
Prior art keywords
navigation
component
measurement data
sensor
components
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.)
Active
Application number
JP2005189032A
Other languages
English (en)
Other versions
JP2006017713A (ja
Inventor
ジェイ、ミレッリ ロザリオ
エフ、ストラッヘン ヴィクター
エイチ、フォーク チャールズ
エイ、タザルテス ダニエル
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.)
Northrop Grumman Systems Corp
Original Assignee
Northrop Grumman Systems Corp
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 Northrop Grumman Systems Corp filed Critical Northrop Grumman Systems Corp
Publication of JP2006017713A publication Critical patent/JP2006017713A/ja
Application granted granted Critical
Publication of JP5517389B2 publication Critical patent/JP5517389B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • G08G1/0962Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0968Systems involving transmission of navigation instructions to the vehicle
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Medical Treatment And Welfare Office Work (AREA)

Description

本発明は、相互補完ナビゲーションシステムに関する。
移動体、例えば、飛行機、陸上移動車、あるいは宇宙船は、マルチセンシングシステムを備えている。センシングシステムは、1つ又は複数のナビゲーションコンポーネントと1つ又は複数のセンサを備えている。一例として、ナビゲーションコンポーネントは1つ又は複数のセンサの出力を打ち消すように動作する。例えば、ナビゲーションコンポーネントは、姿勢、速度、及び位置などのセンサに対するナビゲーションパラメータを決定し、これらのナビゲーションパラメータに基づいてセンサの出力を相殺する。ナビゲーションコンポーネントに1つ又は複数の故障があると、センサの出力は不正に相殺され、間違ったナビゲーション情報が得られる。
例えば、開口合成レーダでは、レーダが移動中に一定の時間にわたって受け取られた信号を結合して像が形成される。ナビゲーションコンポーネントはセンサに対するナビゲーションパラメータを決定する。ナビゲーションコンポーネントは、センサからの信号を相殺するためにナビゲーションパラメータを用いる。ナビゲーションコンポーネントが、センサのためのナビゲーションパラメータを決定できない場合、センサは、誤った信号を発し、間違った像が得られる結果となる。
他の例として、ナビゲーションコンポーネントは、ナビゲーションパラメータ、例えば、参照座標系に対する移動体の姿勢、速度、及び位置などを決定する。ナビゲーションコンポーネントが移動体のナビゲーションパラメータを計算できない場合、移動体はナビゲーションすることができない。例えば、ロケットは、ロケットの飛行経路を計算するために地球に対するロケットの位置を決定するGPS(global positioning system:全地球測位システム)ユニットを用いる。ナビゲーションコンポーネントの故障が発生したとき、ロケットは飛行経路を正確に計算できなくて不測の位置へと進んでクラッシュする。
そこで、センシングシステムにおける1つ又は複数のナビゲーションコンポーネントの故障に際して、移動体上のセンシングシステムのセンサの出力を相殺する必要性が存在する。本発明は、移動体における相互補完ナビゲーションシステムを提供する。
上記課題を達成するために、本発明は、移動体用の装置において、移動体の第1の位置に設置された第1のセンサを有し、この第1のセンサが出力値を生じるために必要な入力値として、センサの向き、位置、または速度を含む第1のナビゲーションパラメタ決定し、この第1のナビゲーションパラメタに基づいて第1のナビゲーション測定データを計算する第1のナビゲーションコンポーネントと;移動体の前記第1の位置の前記第1のセンサから所定距離だけ離れた第2の位置に設置された第2のセンサを有し、この第2のセンサの動作のための、前記第1のナビゲーションパラメタと同じ種類の第2のナビゲーションパラメタ決定し、この第2のナビゲーションパラメタに基づいて第1のナビゲーション測定データと同じ種類の第2のナビゲーション測定データを計算する第2のナビゲーションコンポーネントと;予め定めた参照位置で確立された座標系で表した第1の位置での前記移動体の構造の撓み又は曲げを記述するフレクシュラルモデルコンポーネントを有するナビゲーションネットワークプロセッサコンポーネントと;を備え、前記第1、第2のセンサは、1つ又は複数の開口合成レーダ、1つ又は複数の光学センサ、あるいは1つ又は複数の音響センサを備え、前記ナビゲーションネットワークプロセッサコンポーネントは、(a)(a−1)前記参照位置で確立された座標系で表した第1のセンサの位置に関する出力と、(a−2)(i)前記第1のナビゲーション測定データと(ii)第1のセンサの前記参照位置及び前記フレクシュラルモデルコンポーネントによって得られる、前記移動体の構造が撓み又は曲がっている間の第1のセンサの位置と第1のセンサの前記参照位置との間の距離を表す第1のダイナミックレバーアームのデータとによって定められる、第1の位置で前記移動体の構造が撓み又は曲がっている間の第1のセンサの位置に関する出力と、を比較して前記第1のナビゲーション測定データと同じ種類の第1の修正されたナビゲーション測定データを演算し、
(b)(b−1)前記参照位置で確立された座標系で表した前記第1の修正されたナビゲーション測定データと、(b−2)前記第2のナビゲーション測定データに基づいて定められる第2のセンサの位置に関する出力と、を比較して、前記第1のナビゲーション測定データと同じ種類の、第2の修正されたナビゲーション測定データを演算し、前記第2の修正されたナビゲーション測定データは、第1の位置での移動体の撓み又は曲げに起因する、第2のセンサに対する第1のセンサの位置の変化を含み、
前記第2の修正されたナビゲーション測定データは、第2のセンサの位置に対する第1のセンサの位置の前記移動体の構造の撓み又は曲げによる差を考慮していない測定値データに比べて精度が改善されていることを特徴とするものである。
また、前記ナビゲーションネットワークプロセッサコンポーネントは、ニューラルネットワークを備えるのが好ましい。
また、前記ナビゲーションネットワークプロセッサコンポーネントは、カルマンフィルタを備えるのが好ましい。
図1を参照する。装置100は、一例として、1つ又は複数の移動体105,1つ又は複数のナビゲーションネットワークプロセッサコンポーネント110(以下、ナビゲーションネットワークコンポーネントとも記す)、1つ又は複数のナビゲーションコンポーネント115,120,125,130、1つ又は複数のナビゲーションシステムコンポーネント152,153,154、及び1つ又は複数の外部位置決めコンポーネント155,160を備えている。移動体105は、一例として、車両、戦車、飛行機、飛行船、あるいは宇宙船である。ナビゲーションネットワークコンポーネント110は、移動体105の座標系を確立する。一例として、ナビゲーションネットワークコンポーネント110は、ナビゲーションコンポーネント115,120,125,130のための1つ又は複数のナビゲーションソリューションを決定する。一例として、移動体105は、1つ又は複数のセンサ135,140,145,150を備えている。ナビゲーションネットワークコンポーネント110は、センサ135,140,145,150用に、1つ又は複数のナビゲーションパラメタ、例えば、姿勢、位置、及び速度を決定する。他の一例として、ナビゲーションネットワークコンポーネント110は、ナビゲーションコンポーネント115,120,125,130に対するナビゲーションソリューションと、ナビゲーションパラメタ、例えば、センサ135,140,145,150に対する姿勢、位置、及び速度を決定する。
ナビゲーションコンポーネント115,120,125,130は、センサ135,140,145,150ナビゲーションパラメタ(例えば、姿勢、位置、速度)を決定するために、一例として、1つ又は複数の慣性センサ、例えば、3つの線形加速度計、3つのジャイロを備えている。一例として、ナビゲーションコンポーネント115,120,125,130は、1つ又は複数の慣性ナビゲーションシステムコンポーネントINS(Inertial Navigation System)を備えている。他の一例として、ナビゲーションコンポーネント115,120,125,130は、熟練技術者に容易に理解されるように、1つ又は複数の慣性計測ユニットIMUs(Inertial Measurement Units)を備えている。ナビゲーションコンポーネント115,120,125,130は、一例として、精度を変えたものを備える。例えば、ナビゲーションコンポーネント115,120は、高性能ナビゲーションシステムコンポーネント、例えば、毎時1海里の慣性ナビゲーションシステムコンポーネント、又は、1つ又は複数のGPSユニットによって増強したナビゲーションシステムコンポーネント、そして、ナビゲーションコンポーネント125,130は、低性能ナビゲーションシステムコンポーネント、例えば、低精度慣性測定ユニットを備える。ナビゲーションコンポーネント115,120,125,130は、ナビゲーションコンポーネント115,120,125,130に対するナビゲーション測定データを得て、センサ135,140,145,150用のナビゲーションパラメタ(すなわち、姿勢、位置、及び速度)を決定する。
1つ又は複数のセンサ135,140,145,150は、一例として、1つ又は複数の開口合成レーダ、1つ又は複数の光学センサ、あるいは1つ又は複数の音響センサを備える。一例として、1つ又は複数のセンサ135,140,145,150は、ナビゲーションコンポーネント115,120,125,130の位置にある。他の例として、1つ又は複数のセンサ135,140,145,150は、ナビゲーションコンポーネント115,120,125,130から離れた位置にある。例えば、センサ135,140,145,150は1つ又は複数のナビゲーションコンポーネント115,120,125,130の間にある。ナビゲーションシステムコンポーネント152,153,154は、一例として、1つ又は複数の内蔵されたGPS慣性(EGI:embedded GPS−inertial)ナビゲーションシステムコンポーネントを備えている。例えば、ナビゲーションシステムコンポーネント152,153,154は、ノースロップグルムマン(Northrop Grumman Corporation Corporate Headquarters, 1840 Century Park East, Los Angeles, California 90067−2199,(310)553−6262;http://www.northropgrumman.com)の提供しているLN100sを備えている。外部位置決めコンポーネント155,160は、GPS(全地球測位システム)レシーバと重力高度計とを備えている。ナビゲーションネットワークプロセッサコンポーネント110とナビゲーションコンポーネント115,120,125,130は、本明細書中に示すように、記録可能記憶メディア101を備えている(図2、図3)。
ナビゲーションネットワークプロセッサコンポーネント110は、一例として、ナビゲーションコンポーネント115,120,125,130からのナビゲーション測定データを受け取る。ナビゲーションネットワークプロセッサコンポーネント110は、座標系、例えば、移動体105の第1
座標系を確立するためにナビゲーションコンポーネント115,120,125,130からのナビゲーション測定データを用いる。ナビゲーションネットワークプロセッサコンポーネント110は、座標系、例えば、第1座標系を参照して移動体105の参照位置を確立する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションコンポーネント115,120,125,130に対する1つ又は複数のナビゲーションソリューション、及び/又は、センサ135,140,145,150用の1つ又は複数のナビゲーションパラメタ(すなわち、姿勢、位置、及び速度)を決定するために、熟練技術者に容易に認識できるように、移動体105の参照位置を用いる。ナビゲーションネットワークプロセッサコンポーネント110は、センサ135,140,145,150用のナビゲーションパラメタ(すなわち、姿勢、位置、及び速度)を、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系、例えば、第1座標系に関連して決定する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系におけるセンサ135,140,145,150の変換されたナビゲーションパラメタを、出力182,184,186,188として示されるように供給する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系の姿勢を出力190として供給する。
ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションコンポーネント115,120,125,130のためのナビゲーションソリューションを、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系、例えば、第1座標系に関連して決定する。ナビゲーションネットワークプロセッサコンポーネント110は、出力192,194,196,198として、ナビゲーションコンポーネント115,120,125,130に対する1つ又は複数のナビゲーションソリューションを、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系に関連して送信する。ナビゲーションコンポーネント115,120,125,130に対するナビゲーションソリューションは、本明細書中で述べるように、1つ又は複数のスタンダードナビゲーションソリューションと、1つ又は複数のリプレースメントナビゲーションソリューションとからなる(図2)。
ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対するナビゲーション測定データを決定するために1つ又は複数のナビゲーションセンサを用いる。移動体105のためのナビゲーション測定データは、一例として、慣性測定データ、位置測定データ、空気速度測定データ、及び/又は、圧力高度測定データを含む。一例として、ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対する慣性測定データを決定するために、1つ又は複数の慣性センサを用いる。他の一例として、ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対する圧力高度測定データを決定するために、1つ又は複数の圧力高度センサを用いる。さらに他の一例として、ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対するGPS測定を決定するために、1つ又は複数のGPSユニットを用いる。さらに他の一例として、ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対する空気速度測定を決定するために、1つ又は複数の空気速度センサを用いる。ナビゲーションネットワークプロセッサコンポーネント110は、参照座標系、例えば、地球に関連して、移動体105の位置/配置を記述する移動体105に対するナビゲーション及び姿勢の解を決定するために、ナビゲーション測定データを用いる。
ナビゲーションネットワークプロセッサコンポーネント110は、熟練技術者に容易に理解できるように、移動体105に対するナビゲーション測定データに基づいて参照座標系に関連して、座標系、例えば、第1座標系を確立する。一例として、ナビゲーションネットワークプロセッサコンポーネント110は、熟練技術者に容易に認識できるように、座標系を確立するために、外部位置決めコンポーネント155からのデータ、例えば、GPSデータ、圧力高度、又は、空気データを用いる。他の一例として、ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対する座標系を確立するために、ナビゲーションコンポーネント115,120,125,130からの測定データ、及び外部位置決めコンポーネント155,160からの位置情報を用いる。さらに他の一例として、ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対してナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系をより高精度化するために、ナビゲーションコンポーネント115,120,125,130からのナビゲーション測定データを用いる。ナビゲーションネットワークプロセッサコンポーネント110は、移動体105の姿勢を時間の関数として記述するために、移動体105に対する座標系とナビゲーション測定データを用いる。
ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系に関連してセンサ135,140,145,150の姿勢を記述するために、ナビゲーションコンポーネント115,120,125,130と通信を行う。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションコンポーネント115,120,125,130から、ナビゲーション測定データ、例えば、センサ135,140,145,150の位置に対するナビゲーション測定データを時間の関数として取得する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションコンポーネント115,120,125,130のナビゲーション測定データにおける1つ又は複数のエラーを評価するために、1つ又は複数のエラー評価手段、例えば、1つ又は複数のカルマンフィルタを備えている。ナビゲーションネットワークプロセッサコンポーネント110は、1つ又は複数のエラーの評価に基づいてナビゲーションコンポーネント115,120,125,130のナビゲーション測定データを修正する。ナビゲーションネットワークプロセッサコンポーネント110は、出力165,170,175,180で示すように、修正されたナビゲーション測定データをナビゲーションコンポーネント115,120,125,130に供給する。ナビゲーションコンポーネント115,120,125,130は、センサ135,140,145,150用のナビゲーションパラメタ(すなわち、姿勢、位置、及び速度)の評価を改善するために、修正されたナビゲーション測定データを用いる。
ナビゲーションネットワークプロセッサコンポーネント110は、熟練技術者に容易に認識できるように、ナビゲーションコンポーネント115,120,125,130によって確立された座標系、例えば、1つ又は複数の第2座標系から、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系、例えば、第1座標系へと、ナビゲーションコンポーネント115,120,125,130のナビゲーション測定データを変換する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションネットワークプロセッサコンポーネント110用のナビゲーションパラメタを、出力182として供給する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系におけるナビゲーションコンポーネント115,120,125,130に対する変換されたナビゲーションパラメタを、出力182,184,186,188として供給する。ナビゲーションネットワークプロセッサコンポーネント110は、座標参照系を出力190として供給する。
ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された参照位置とナビゲーションコンポーネント115との間、ナビゲーションネットワークプロセッサコンポーネント110によって確立された参照位置とナビゲーションコンポーネント120との間、ナビゲーションネットワークプロセッサコンポーネント110によって確立された参照位置とナビゲーションコンポーネント125との間、及び、ナビゲーションネットワークプロセッサコンポーネント110によって確立された参照位置とナビゲーションコンポーネント130との間で、1つ又は複数のレバーアーム(すなわち、3次元距離ベクトルをモデル化するために用いられるパラメタ)を評価する。ナビゲーションコンポーネント115,120,125,130は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系に相対的に動くセンサ135,140,145,150の動きを決定するために、レバーアームの評価結果を用いる。
ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションコンポーネント115,120,125,130、ナビゲーションシステムコンポーネント152,153,154、及び、外部位置決めコンポーネント155,160から、ナビゲーション測定データを時間の関数として受け取る。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーション測定データのための時間ベースを確立する。ナビゲーションネットワークプロセッサコンポーネント110は、熟練技術者に容易に認識できるように、ナビゲーション測定データを時間ベースと同調させる。一例として、ナビゲーションコンポーネント115は、ナビゲーションコンポーネント115に対するナビゲーション測定データとともにタイムスタンプを供給する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションコンポーネント115のためのナビゲーション測定データを、ナビゲーションネットワークプロセッサコンポーネント110の時間ベースに合わせる。例えば、ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーションコンポーネント115からのタイムスタンプを、ナビゲーションネットワークプロセッサコンポーネント110の時間ベースと比較する。ナビゲーションネットワークプロセッサコンポーネント110は、ナビゲーション測定データを適切な時間に合わせるために、一例として、データ内挿、及び/又はデータ外挿を用いる。他の一例として、ナビゲーションネットワークプロセッサコンポーネント110とナビゲーションコンポーネント115,120,125,130、及び、ナビゲーションシステムコンポーネント152,153,154と外部位置決めコンポーネント155,160は、同期したクロック、例えば、クロック162に基づいて動作する。さらに他の一例として、ナビゲーションネットワークプロセッサコンポーネント110とナビゲーションコンポーネント115,120,125,130、及び、ナビゲーションシステムコンポーネント152,153,154と外部位置決めコンポーネント155,160は、それぞれのナビゲーション測定データをナビゲーションネットワークプロセッサコンポーネント110の時間ベースに同期させるために、タイミングパルスを用いる。
ナビゲーションコンポーネント115,120,125,130は、センサ135,140,145,150のナビゲーションパラメタ(すなわち、姿勢、位置、及び速度)を決定する。ナビゲーションコンポーネント115,120,125,130は、センサ135,140,145,150の姿勢、位置、及び/又は速度に基づいて、センサ135,140,145,150の出力を相殺する。ナビゲーションコンポーネント115,120,125,130は、ナビゲーションネットワークプロセッサコンポーネント110にナビゲーションコンポーネント115,120,125,130のナビゲーション測定データを供給するために、ナビゲーションネットワークプロセッサコンポーネント110と通信を行う。ナビゲーションコンポーネント115,120,125,130は、ナビゲーションコンポーネント115,120,125,130の修正されたナビゲーション測定データを、ナビゲーションネットワークプロセッサコンポーネント110から(例えば、出力165,170,175,180を)入力として受け取る。ナビゲーションコンポーネント115,120,125,130は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系に関連してセンサ135,140,145,150の位置を記述するために、ナビゲーションコンポーネント115,120,125,130の修正されたナビゲーション測定データを用いる。例えば、ナビゲーションコンポーネント115は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された座標系に対するセンサ135の動きを決定するために、ナビゲーションコンポーネント115の修正されたナビゲーション測定データを用いる。
図2を参照する。ナビゲーションネットワークプロセッサコンポーネント110は、1つ又は複数の参照座標コンポーネント205、1つ又は複数のヘルスモニタコンポーネント210、1つ又は複数のスタンダードナビゲーションソリューションコンポーネント215、1つ又は複数のリプレースメントナビゲーションソリューションコンポーネント220、及び、1つ又は複数のフレクシュラルモデルコンポーネント225を備えている。参照座標コンポーネント205は、一例として、移動体105の座標系を確立する。ヘルスモニタコンポーネント210は、一例として、以下で述べられるように、ナビゲーションコンポーネント115,120,125,130から得られたナビゲーション測定データから、状態の悪いナビゲーションコンポーネントを特定する。スタンダードナビゲーションソリューションコンポーネント215は、一例として、ナビゲーションコンポーネント115,120,125,130に対するナビゲーションソリューションを決定する。リプレースメントナビゲーションソリューションコンポーネント220は、一例として、ナビゲーションコンポーネント115,120,125,130に対するリプレースメントナビゲーションソリューションを決定する。フレクシュラルモデルコンポーネント225は、一例として、1つ又は複数のナビゲーションコンポーネント115,120,125,130に対する、1つ又は複数のダイナミックレバーアームを決定する。
スタンダードナビゲーションソリューションコンポーネント215は、1つ又は複数のナビゲーションコンポーネント115,120,125,130に対する1つ又は複数の有効ナビゲーションソリューションを、出力260,261,262,263として供給する。スタンダードナビゲーションソリューションコンポーネント215は、リプレースメントナビゲーションソリューションコンポーネント220に出力260,261,262,263を供給する。リプレースメントナビゲーションソリューションコンポーネント220は、1つ又は複数のナビゲーションコンポーネント115,120,125,130に対する1つ又は複数のリプレースメントナビゲーションソリューションを、出力265,266,267,268として供給する。フレクシュラルモデルコンポーネント225は、1つ又は複数のナビゲーションコンポーネント115,120,125,130に対する1つ又は複数のダイナミックレバーアームを、リプレースメントナビゲーションソリューションコンポーネント220に、出力259として供給する。
参照座標コンポーネント205は、ナビゲーションコンポーネント115,120,125,130のそれぞれから、出力230,235,240,245を入力として取得する。出力230,235,240,245は、一例として、1つ又は複数の物理パラメタ、例えば、加速度、角速度、及び温度を含む。参照座標コンポーネント205は、スタンダードナビゲーションソリューションコンポーネント215に、移動体105の姿勢情報を出力250として供給する。ヘルスモニタコンポーネント210は、出力230,235,240,245を入力として取得する。ヘルスモニタコンポーネント210は、ナビゲーションコンポーネント115,120,125,130の出力230,235,240,245と、ナビゲーションコンポーネント115,120,125,130の1つ又は複数のノミナルな出力との、1つ又は複数の比較を行う。ヘルスモニタコンポーネント210は、ナビゲーションコンポーネント115,120,125,130に対する1つ又は複数の比較に基づいて、スタンダードナビゲーションソリューションコンポーネント215とリプレースメントナビゲーションソリューションコンポーネント220に、ナビゲーションコンポーネントヘルスインジケータを、それぞれ出力252、254として供給する。
ヘルスモニタコンポーネント210は、一例として、ナビゲーションコンポーネント115,120,125,130に対する1つ又は複数のヘルスインジケータを決定する。ヘルスモニタコンポーネント210は、一例として、1つ又は複数のナビゲーションソリューションデターミネーションコンポーネント275、及び1つ又は複数のエクスペクティッドバリューコンポーネント280を備える。ナビゲーションソリューションデターミネーションコンポーネント275は、一例として、ナビゲーションコンポーネント115,120,125,130に関連してナビゲーションコンポーネントの動きを時間の関数として記述する、ナビゲーションコンポーネント115,120,125,130に対する1つ又は複数の函数関係(リレーションシップ、関数関係と同意義である)を創出する。例えば、ナビゲーションソリューションデターミネーションコンポーネント275は、ナビゲーションコンポーネント115に対する1つ又は複数の方程式を、ナビゲーションコンポーネント120,125を用いて、時間の関数として創出する。他の一例として、ナビゲーションソリューションデターミネーションコンポーネント275は、ナビゲーションコンポーネント120のナビゲーションコンポーネント115,130に対する函数関係を、時間の関数として創出する。例えば、ナビゲーションソリューションデターミネーションコンポーネント275は、ナビゲーションコンポーネント115,130を用いて、ナビゲーションコンポーネント120に対する1つ又は複数の方程式を時間の関数として創出する。
エクスペクティッドバリューコンポーネント280は、ナビゲーションコンポーネント115,120,125,130の出力230,235,240,245に対する1つ又は複数の期待値を供給する。例えば、出力230,235,240,245は、位置、速度、加速度計又はジャイロスコープのドリフトエラーの見積もり値、及び、検知された加速度又は角速度を、熟練技術者に容易に認識できるように、含んでいる。一例として、エクスペクティッドバリューコンポーネント280は、ナビゲーションコンポーネント115,120,125,130の出力230,235,240,245に対する期待値を決定するために、ナビゲーションソリューションデターミネーションコンポーネント275によって創出された1つ又は複数の方程式と、フレクシュラルモデルコンポーネント225によって計算されたレバーアーム259を用いる。他の一例として、エクスペクティッドバリューコンポーネント280は、ナビゲーションコンポーネント115,120,125,130の出力230,235,240,245に対して、時間の関数としての期待値を用いて事前にプログラムされている。
一例として、ヘルスモニタコンポーネント210は、ナビゲーションコンポーネント115,120,125,130に対する1つ又は複数のヘルスインジケータを生成するために、AIME(Autonomous Integrity Monitored Extrapolation:自動完全性監視外挿)技術を用いる。ヘルスモニタコンポーネント210は、スタンダードナビゲーションソリューションコンポーネント215に、ヘルスインジケータを出力252として送出する。ヘルスモニタコンポーネント210は、リプレースメントナビゲーションソリューションコンポーネント220に、ヘルスインジケータを出力254として送出する。他の一例として、ヘルスモニタコンポーネント210は、出力230,235,240,245から、出力230,235,240,245に対する1つ又は複数の期待値を用いて得られた数値間の1つ又は複数の差を決定する。さらに他の一例として、ヘルスモニタコンポーネント210は、差を定量化し、定量化した差を、スタンダードナビゲーションソリューションコンポーネント215とリプレースメントナビゲーションソリューションコンポーネント220に送る。さらに他の一例として、ヘルスモニタコンポーネント210は、差を出力値に対する閾値と比較する。ヘルスモニタコンポーネント210は、差と閾値の比較に基づいたヘルスインジケータを供給する。ヘルスモニタコンポーネント210は、ナビゲーションコンポーネント出力230,235,240,245の1つ又は複数のヘルスインジケータを、出力258として、フレクシュラルモデルコンポーネント225に送る。フレクシュラルモデルコンポーネント225は、どのナビゲーションコンポーネント出力230,235,240,245が、撓みモデルを計算するために信頼して用いられるかを決定するために、ヘルスインジケータを用いる。
フレクシュラルモデルコンポーネント225は、一例として、動いている移動体105の反応を記述するモデルを構築する。モデルは、一例として、ナビゲーションコンポーネント115,120,125,130の全て又は何れかが行う相互間の変位を記述する。フレクシュラルモデルコンポーネント225は、移動中の移動体105の反応を記述するためのモデルを構築するために、1つ又は複数のルール、例えば、移動体105のレバーアーム、コンプライアンス、又は共鳴、及び、移動体105の機構に関するルールを用いる。フレクシュラルモデルコンポーネント225は、一例として、ナビゲーションコンポーネント115,120,125,130と、ナビゲーションネットワークプロセッサコンポーネント110によって確立された参照位置との間の、3次元動的移動ベクトルを記述する1つ又は複数のレバーアームパラメタを評価する。フレクシュラルモデルコンポーネント225は、一例として、出力230,235,240,245(例として、物理パラメタ、例えば、加速度、角速度、及び温度)を、入力として受け取る。フレクシュラルモデルコンポーネント225は、移動体105のナビゲーションコンポーネント115,120,125,130の力、トルク、偏向、及び、移動に対して1つ又は複数の評価を実行するために、出力230,235,240,245を用いる。フレクシュラルモデルコンポーネント225は、ナビゲーションコンポーネント115,120,125,130のダイナミックレバーアームに対する動作を決定するために、1つ又は複数の評価を用いる。
フレクシュラルモデルコンポーネント225は、一例として、スタンダードナビゲーションソリューションコンポーネント215からの出力260,261,262,263を、入力として受け取る。出力260,261,262,263は、一例として、ナビゲーションソリューション及び/又はナビゲーション測定データである。フレクシュラルモデルコンポーネント225は、一例として、撓みモデルをより高精度化するために、撓みモデルとナビゲーションソリューション260,261,262,263の1つ又は複数の比較を実行する。一例として、フレクシュラルモデルコンポーネント225は、決定論的な機構モデルを含んでいる。他の一例として、フレクシュラルモデルコンポーネント225は、柔軟順応形式(flexible adaptive form)、例えば、ニューラルネットワークを含む。
フレクシュラルモデルコンポーネント225は、ヘルスモニタコンポーネント210からの出力258を、入力として受け取る。フレクシュラルモデルコンポーネント225は、撓みモデルの計算又は更新に用いるのに、ナビゲーションコンポーネント115,120,125,130のどれ、及び、スタンダードナビゲーションソリューション260,261,262,263のどれ、が充分信頼できるかを決定するために、出力258を用いる。フレクシュラルモデルコンポーネント225は、1つ又は複数のナビゲーションコンポーネント115,120,125,130に対する、1つ又は複数のダイナミックレバーアームを、出力259として、リプレースメントナビゲーションソリューションコンポーネント220に出力する。リプレースメントナビゲーションソリューションコンポーネント220は、健全性でないナビゲーションコンポーネント、例えば、ナビゲーションコンポーネント120に対するナビゲーションソリューションを評価するために、出力259と出力260,261,262,263を用いる。
リプレースメントナビゲーションソリューションコンポーネント220は、一例として、出力260,261,262,263を入力として受け取る。リプレースメントナビゲーションソリューションコンポーネント220は、1つ又は複数のナビゲーションコンポーネント115,120,125,130に対する1つ又は複数のリプレースメントソリューション265,266,267,268を作る。リプレースメントナビゲーションソリューションコンポーネント220は、一例として、ナビゲーションコンポーネント115,120,125,130の出力230,235,240,245をモニタする。リプレースメントナビゲーションソリューションコンポーネント220は、1つのナビゲーションコンポーネントの出力を、残りのナビゲーションコンポーネントの出力に基づいて、シミュレーションを始める。リプレースメントナビゲーションソリューションコンポーネント220は、1つ又は複数の出力230,235,240,245に関する出力230,235,240,245の動きを記述するために、出力230,235,240,245の間の1つ又は複数の函数関係を構築する。例えば、リプレースメントナビゲーションソリューションコンポーネント220は、出力230,235,240,245をモニタする1つ又は複数のニューラルネットワークを備えている。リプレースメントナビゲーションソリューションコンポーネント220は、出力235,240、及び/又は245に対する出力230の動きを記述する1つ又は複数の函数関係を構築する。リプレースメントナビゲーションソリューションコンポーネント220は、ナビゲーションコンポーネント115の出力230をシミュレートするために、1つ又は複数の函数関係を用いる。リプレースメントナビゲーションソリューションコンポーネント220が1つ又は複数の函数関係を構築するとき、リプレースメントナビゲーションソリューションコンポーネント220は、1つ又は複数の函数関係を用いて得られた値と、ナビゲーションコンポーネント115,120,125,130からの出力230,235,240,245の値とを比較することにより、1つ又は複数の函数関係を検証する。
例えば、リプレースメントナビゲーションソリューションコンポーネント220は、ナビゲーションコンポーネント115の出力230をシミュレートする。リプレースメントナビゲーションソリューションコンポーネント220は、出力235,240,245を時間をかけてモニタする。リプレースメントナビゲーションソリューションコンポーネント220は、出力235,240,245を用いて出力230の動きを時間の関数として記述する、1つ又は複数の方程式、あるいは方程式のシステムを、時間の関数として出力235,240,245から構成する。リプレースメントナビゲーションソリューションコンポーネント220は、ある時間間隔において得られた出力230、例えば、出力230の現在値を、その時点における1つ又は複数の方程式から得られた値とを比較する。リプレースメントナビゲーションソリューションコンポーネント220は、熟練技術者に容易に認識できるように、出力230を出力235,240,245によって記述する1つ又は複数の方程式を、比較に基づいて調節する。
ナビゲーションコンポーネント115,120,125,130の動きを、ナビゲーションコンポーネント115,120,125,130によって記述する1つ又は複数の函数関係を用いることによって、リプレースメントナビゲーションソリューションコンポーネント220は、1つ又は複数のナビゲーションコンポーネント115,120,125,130の故障に際して、ナビゲーションコンポーネント115,120,125,130のための冗長な(代理機能性を有する)ナビゲーションソリューションを提供する。例えば、ナビゲーションコンポーネント115の故障の場合に、リプレースメントナビゲーションソリューションコンポーネント220は、好ましい精度を有する出力230の値を構成するために、出力230に対する1つ又は複数の函数関係を用いる。
図3を参照する。スタンダードナビゲーションソリューションコンポーネント215は、一例として、1つ又は複数のリジッドレバーアームモデルコンポーネント310,340、1つ又は複数の加算ノード318,348、1つ又は複数のフレクシュラルモデルコンポーネント320、及び、1つ又は複数のフィルタ325を備えている。リジッドレバーアームモデルコンポーネント310は、ナビゲーションコンポーネント115に対するベースライン静位置を備えている。リジッドレバーアームモデルコンポーネント310は、ベースライン静位置に基づいて、ナビゲーションコンポーネント115に対するベースライン静レバーアームを決定する。ナビゲーションコンポーネント115に対するベースライン静レバーアームは、ナビゲーションネットワークプロセッサコンポーネント110によって確立された参照位置とナビゲーションコンポーネント115との間の3次元位置距離、又はベクトルを備える。リジッドレバーアームモデルコンポーネント310は、ナビゲーションコンポーネント115に対する静レバーアームを決定するために参照座標コンポーネント205によって確立した座表系においてナビゲーションコンポーネント115に対するベースライン静レバーアームを投影するため、参照座標コンポーネント205とともに協同する。リジッドレバーアームモデルコンポーネント310は、ナビゲーションコンポーネント115の静レバーアームを、出力316として、加算ノード318に送る。
ナビゲーションコンポーネント115は、ナビゲーションコンポーネント115によって確立された座標系、例えば、第2座標系を参照して、ナビゲーションコンポーネント115に対するナビゲーション測定データを決定する。ナビゲーションコンポーネント115は、ナビゲーションコンポーネント115によって確立された座標系を参照して、ナビゲーションコンポーネント115に対するナビゲーション測定データを、出力230として、加算ノード318に送る。加算ノード318は、参照座標コンポーネント205によって確立された座標系、例えば、第1座標系を参照して、ナビゲーションコンポーネント115に対するナビゲーション測定データを、出力260として生成するために、リジッドレバーアームコンポーネント310からの出力とナビゲーションコンポーネント115からの出力とを結合する。
参照座標コンポーネント305によって確立された座標系を参照したナビゲーションコンポーネント115に対するナビゲーション測定データを含んでいる出力260は、フレクシュラルモデルコンポーネント320を援用することによって強化される。フレクシュラルモデルコンポーネント320は、移動体105の構造の撓み又は曲げを記述する移動体105の移動中におけるモデルを、時間の関数として含んでいる。ナビゲーションコンポーネント115,120,125,130の位置の評価に基づいて、フレクシュラルモデルコンポーネント320は、移動体の構造に沿ったいずれの点における相対的移動をも表現する。例えば、フレクシュラルモデルコンポーネント320は、ナビゲーションネットワークプロセッサコンポーネント110によって確立された参照位置とナビゲーションコンポーネント115,120,125,130のそれぞれとの間の時間の、関数として距離の1つ又は複数のアームパラメタを、入力として取得する。フレクシュラルモデルコンポーネント320は、移動中における移動体105の反応を記述する1つ又は複数の方程式を含む。例えば、フレクシュラルモデルコンポーネント320は、移動体105の構造の曲がりを記述する方程式を時間の関数として含む。フレクシュラルモデルコンポーネント320は、移動体105の構造に沿った何れかのセンサの相対的な変位を記述する時間の関数としての方程式を生成するために、レバーアームパラメタを方程式に適用する。一例として、フレクシュラルモデルコンポーネント320は、移動体105の構造の曲がりを記述する時間の関数としての方程式を用いてプログラムされている。他の一例として、フレクシュラルモデルコンポーネント320は、センサ135,140,145,150の相互間の変位を記述するモデルを構築するために協同する1つ又は複数のニューラルネットワークを用いる。フレクシュラルモデルコンポーネント320は、移動体105の構造に沿ったセンサ135の相対的な変位を記述する時間の関数としての方程式を出力324として供給する。
例えば、フレクシュラルモデルコンポーネント320は、1つ又は複数の付加的なダイナミックレバーアーム修正コンポーネントを備える。付加的なダイナミックレバーアーム修正コンポーネントは、移動体105の移動中の反応を記述するモデルを含む。付加的なダイナミックレバーアーム修正コンポーネントは、移動体105の移動中の反応に関連して、ナビゲーションコンポーネント115,120,125,130に対する位置を与えるモデルを用いる。例えば、移動中に、移動体105は、曲げに反応する。移動体105の撓みは、マスターナビゲーションコンポーネント110とナビゲーションコンポーネント115との間のレバーアーム(すなわち、3次元距離ベクトル)を変化させる。移動体105が曲がるとき、マスターナビゲーションコンポーネント110とナビゲーションコンポーネント115との間のレバーアームが変化する。
一例として、フレクシュラルモデルコンポーネント320は、一例として、参照座標コンポーネントからの出力326と、ナビゲーションコンポーネント115からの出力328を、入力として受け取る。付加的なダイナミックレバーアーム修正コンポーネントは、一例として、参照座標コンポーネント205によって確立された座表系を参照して、ナビゲーションコンポーネント115に対するダイナミックレバーアームを決定するために、出力326,328を用いる。付加的なダイナミックレバーアーム修正コンポーネントは、ナビゲーションコンポーネント115に対するダイナミックレバーアームを加算ノード318に送る。加算ノード318は、出力260を生成するために、出力316,230,324を結合する。このようにして、加算ノード318は、移動中の移動体105に対する参照座標コンポーネント205によって確立された座標系を参照して、ナビゲーションコンポーネント115に対するより正確なナビゲーション測定データを含むように、出力260を生成する。付加的なダイナミックレバーアーム修正コンポーネントの出力324は、フィルタ325、例えば、カルマンフィルタ、を用いることにより、後述するように、よりよい精度が得られる。
フィルタ325は、加算ノード318からの出力260を、入力として受け取る。フィルタ325は、与えられたタイムスタンプ(すなわち、参照座標コンポーネント205によって確立された座標系を参照しているナビゲーションコンポーネント115に対するナビゲーション測定データ)に対する出力260と、与えられたタイムスタンプにおける参照座標コンポーネント205からのナビゲーション測定データとを比較する。フィルタ325は、出力260におけるエラーを評価する。フィルタ325は、参照座標コンポーネント205によって確立された座標系を参照して、ナビゲーションコンポーネント115に対する修正されたナビゲーション測定データを、出力332として供給する。ナビゲーションコンポーネント115は、参照座標コンポーネント205によって確立された座標系を参照して、センサ135の向き、位置、速度を決定するために、出力332を用いる。さらに加えて、フィルタ325は、参照座標コンポーネント205によって確立された座標系を参照しているナビゲーションコンポーネント115に対する修正されたナビゲーション測定データを出力334として、フレクシュラルモデルコンポーネント320に送る。フレクシュラルモデルコンポーネント320は、ナビゲーションコンポーネント115に対するダイナミックレバーアームである出力324を修正するために、出力334を用いる。このようにして、フレクシュラルモデルコンポーネント320、ナビゲーションコンポーネント115、及び、フィルタ325は、協同して、参照座標コンポーネント205によって確立された座標系とナビゲーションコンポーネント115の座標系とを、反復的に揃える。
ナビゲーションコンポーネント120、センサ140、参照座標コンポーネント205、リジッドレバーアームモデルコンポーネント340、加算ノード348、フレクシュラルモデルコンポーネント320、及び、出力235,346,261,354,358,362,364は、ナビゲーションコンポーネント115、センサ135、参照座標コンポーネント205、リジッドレバーアームモデルコンポーネント310、加算ノード318、フレクシュラルモデルコンポーネント320、及び、出力230,316,260,324,328,332,334と同様のやり方で、相互にやり取りする。参照座標コンポーネント205、リジッドレバーアームモデルコンポーネント310,340、フレクシュラルモデルコンポーネント320、及び、フィルタ325は、図中に示すように、1つ又は複数の記録可能信号保存メディア101を備えている。
さらに図3において、ナビゲーションコンポーネント115は、ナビゲーションコンポーネント115に対するナビゲーション測定データを、
フレクシュラルモデルコンポーネント320に、出力328として送る。フレクシュラルモデルコンポーネント320は、参照座標コンポーネント205によって確立された座標系を参照しているナビゲーションコンポーネント120に対するダイナミックレバーアームの精度を増すために、出力328を用いる。ナビゲーションコンポーネント120は、ナビゲーションコンポーネント120に対するナビゲーション測定データを、フレクシュラルモデルコンポーネント320に、出力358として送る。フレクシュラルモデルコンポーネント320は、参照座標コンポーネント205によって確立された座標系を参照しているナビゲーションコンポーネント115に対するダイナミックレバーアームの精度を増すために、出力358を用いる。
フィルタ325は、参照座標コンポーネント205、及びナビゲーションコンポーネント115,120から、ナビゲーション測定データを、入力として受け取る。フィルタ325は、参照座標コンポーネント205から出力370、ナビゲーションコンポーネント115から出力260、及びナビゲーションコンポーネント120から出力261を、入力として受け取る。フィルタ325は、参照座標コンポーネント205、及びナビゲーションコンポーネント115,120から受け取ったナビゲーション測定データを評価する。フィルタ325は、エラーを修正し、参照座標コンポーネント205によって確立された座標系を参照して、修正されたナビゲーション測定データを、参照座標コンポーネント205に、出力372として送る。参照座標コンポーネント205は、参照座標コンポーネント205によって確立された座標系を調整するために、出力372を用いる。例えば、参照座標コンポーネント205は、参照座標コンポーネント205によって確立されたベースライン座標系を調整するために、出力372を用いる。フィルタ325と参照座標コンポーネント205は、参照座標コンポーネント205によって確立された座標系と、フィルタ325によって確立された座標系を揃えるために協同する。フィルタ325は、参照座標コンポーネント205によって確立された座標系を参照して修正されたナビゲーション測定データを、参照座標コンポーネント205、ナビゲーションコンポーネント115,120、及びフレクシュラルモデルコンポーネント320に、出力332,334,362,364として送る。
説明のために、装置100の代表的な実行動作の説明的描写を行う。
図2〜図4を参照する。STEP405において、ナビゲーションネットワークプロセッサコンポーネント110は、移動体105に対するナビゲーションソリューションを時間の関数として決定する。STEP410において、参照座標コンポーネント205は、移動体105に対する地球を参照した座標系、例えば、第1座標系を確立するために、ナビゲーション測定データ、及び、外部位置決めコンポーネント155からのオプションデータを用いる。STEP415において、参照座標コンポーネント205は、ナビゲーションコンポーネント115によって確立された座標系、例えば、第2座標系を参照するナビゲーション測定データ、及びタイムタグを、センサ135に対するナビゲーションコンポーネント115から受け取る。参照座標コンポーネント205は、タイムタグで記述された時間に参照座標コンポーネント205のナビゲーション測定データを決定するために、タイムタグを用いる。STEP420において、参照座標コンポーネント205は、タイムタグで記述された時間におけるナビゲーションコンポーネント115のナビゲーション測定データと、タイムタグで記述された時間における参照座標コンポーネント205のナビゲーション測定データと、を比較する。タイムタグで記述された時間における参照座標コンポーネント205のナビゲーション測定データは、一例として、参照座標コンポーネント205とナビゲーションコンポーネント115,120,125,130の間の1つ又は複数のレバーアームによって調整された、参照座標コンポーネント205のナビゲーション測定データを含む。
STEP425において、参照座標コンポーネント205とフィルタ325は、ナビゲーションコンポーネント115からのナビゲーション測定データにおけるエラーを評価する。STEP430において、フィルタ325は、ナビゲーションコンポーネント115からのナビゲーション測定データにおけるエラーを修正するする。STEP435において、フィルタ325は、ナビゲーションコンポーネント115に対する修正されたナビゲーション測定データを、ナビゲーションコンポーネント115によって確立された座標系(例えば、第2座標系)から、参照座標コンポーネント205によって確立された座標系(例えば、第1座標系)に変換する。STEP440において、加算ノード318は、ナビゲーションネットワークプロセッサコンポーネント110の参照座標コンポーネント205によって確立された座標系におけるセンサ135に、ナビゲーションパラメータ、例えば、姿勢、位置、及び、速度を供給するために、第1座標系におけるナビゲーションコンポーネント115のための修正され、変換されたナビゲーション測定データを用いる。
図5を参照する。STEP505において、ヘルスモニタコンポーネント210は、ナビゲーションコンポーネント115からの出力230のナビゲーション測定データを取得する。STEP510において、ヘルスモニタコンポーネント210は、出力230のナビゲーション測定データと、出力230の期待ナビゲーション測定データとの間の差を決定する。例えば、ナビゲーションコンポーネント115の姿勢と、ナビゲーションコンポーネント115の期待される姿勢の差は、3度である。STEP515において、ヘルスモニタコンポーネント210は、差のパーセンテージに基づいて、差を定量化する。例えば、3度という値はナビゲーションコンポーネント115に対する許容限界内である。STEP520において、ヘルスモニタコンポーネント210は、定量化された差に基づいて、ナビゲーションコンポーネント115に対するヘルスインジケータを決定する。ヘルスモニタコンポーネント210は、ナビゲーションコンポーネント115に98%のヘルスインジケータを与える。
図1、図2、図6を参照する。ナビゲーションネットワークコンポーネント110は、ナビゲーションコンポーネント115,120に対するナビゲーションソリューションを決定する。STEP605において、ナビゲーションネットワークコンポーネント110は、ナビゲーションコンポーネント115,120からナビゲーション測定データを受け取る。STEP610において、ヘルスモニタコンポーネント210は、ナビゲーションコンポーネント115が健全性であり、ナビゲーションコンポーネント120が健全性でない、ということを決定する。STEP615において、スタンダードナビゲーションソリューションコンポーネント215は、ナビゲーションコンポーネント115のナビゲーションソリューションを決定する。STEP620において、スタンダードナビゲーションソリューションコンポーネント215は、ナビゲーションソリューションを、ナビゲーションコンポーネント115に、出力260として供給する。STEP625において、フレクシュラルモデルコンポーネント320は、健全性なナビゲーションコンポーネント、例えば、ナビゲーションコンポーネント115によって測定された物理パラメタを取得する。STEP630において、リプレースメントナビゲーションソリューションコンポーネント220は、フレクシュラルモデルコンポーネント225から、健全性でないナビゲーションコンポーネント、例えば、ナビゲーションコンポーネント120に対するダイナミックレバーアームを、取得する。STEP635において、リプレースメントナビゲーションソリューションコンポーネント220は、ナビゲーションコンポーネント115(つまり、健全性なナビゲーションコンポーネント)と、ナビゲーションコンポーネント120(つまり、健全性でないナビゲーションコンポーネント)と、ナビゲーションコンポーネント115に対するナビゲーションソリューションと、ナビゲーションコンポーネント120に対する物理パラメタと、ナビゲーションコンポーネント120に対するダイナミックレバーアームとの間の函数関係に基づいて、ナビゲーションコンポーネント120に対するリプレースメントナビゲーションソリューションを決定する。リプレースメントナビゲーションソリューションコンポーネント220は、リプレースメントナビゲーションソリューションを出力265として供給する。
装置100は、一例として、1つ又は複数の電気コンポーネント、ハードウエア、及び、コンピュータソフトウエアのようなコンポーネントを、複数含む。多くのこのようなコンポーネントが、装置100に結合でき、又は分配できる。装置100の代表的なコンポーネントは、熟練技術者に容易に認識できるように、種々のプログラム言語のいずれかによって書かれた、又は作り込まれた、セット及び/又は一連のコンピュータ命令を用いて、及び/又は備えている。
一例として、装置100は、コンピュータによって読み取り可能の1つ又は複数の信号保存メディアを用いている。コンピュータによって読み取り可能の信号保存メディアは、発明の1つ又は複数の実施形態の1つ又は複数の部分を実行するために、ソフトウエア、ファームウエア、及び/又は、アセンブリ言語を記憶している。装置100のためのコンピュータによって読み取り可能の信号保存メディアの例は、ナビゲーションネットワークコンポーネント110、ナビゲーションコンポーネント115,120,125,130、フレクシュラルモデルコンポーネント225、参照座標コンポーネント205、リジッドレバーアームモデルコンポーネント310,340、及び、フィルタ320が備えている記録可能信号保存メディア101である。装置100のためのコンピュータによって読み取り可能の信号保存メディアは、一例として、1つ又は複数の磁気的、電気的、光学的、バイオ的、及び、原子的なデータ記憶メディアを備えている。例えば、コンピュータによって読み取り可能の信号保存メディアは、フロッピーディスク、磁気テープ、CD−ROM、DVD−ROM、ハードディスクドライブ、及び、電気的メモリを備えている。他の一例として、コンピュータによって読み取り可能の信号保存メディアは、装置100を含む、又は装置100と結合したネットワーク、例えば、1つ又は複数の電話回線、ローカルエリアネットワーク(LAN)、ワイドエリアネットワーク(WAN)、インターネット、及び、無線ネットワークによって伝達する変調キャリア信号を含む。
ここで記述したステップや操作は、代表例のみである。これらのステップや操作について、この発明の精神から外れることなく、多くの変形例があり得る。例えば、各ステップは異なる順番で実行してもよく、ステップが加えられたり、削られたり、修正されたりしてもよい。
発明の代表的な実施形態が説明され記述されたが、この発明の精神から離れることなく種々の変形、追加、除去などを行うことができるのは、関連技術に熟練した人々にとって明白であり、従って、これらは、特許請求の範囲で規定された発明の範囲内にある。
本発明の一実施形態に係る装置における1つ又は複数の移動体、1つ又は複数のナビゲーションネットワークプロセッサコンポーネント、1つ又は複数のナビゲーションシステムコンポーネント、1つ又は複数のナビゲーションコンポーネント、1つ又は複数のセンサ、及び1つ又は複数の外部位置デターミネーションコンポーネントを示すブロック構成図。 図1に示した装置のナビゲーションネットワークプロセッサコンポーネントにおける1つ又は複数のナビゲーションソリューションデターミネーションコンポーネント、1つ又は複数のエクスペクティッドバリューコンポーネント、1つ又は複数のスタンダードナビゲーションソリューションコンポーネント、1つ又は複数のリプレースメントナビゲーションソリューションコンポーネント、及び1つ又は複数のフレクシュラルモデルコンポーネントを示すブロック構成図。 図1に示した装置におけるナビゲーションネットワークプロセッサコンポーネント、ナビゲーションコンポーネント、センサ、外部位置決めコンポーネント、1つ又は複数のダイナミックレバーアーム修正コンポーネント、及び、1つ又は複数のフィルタの、1つ又は複数の参照座標コンポーネントと1つ又は複数のリジッドレバーアームコンポーネントを示すブロック構成図。 図1に示した装置における、ナビゲーションネットワークプロセッサコンポーネントからナビゲーションコンポーネントに、センサに対する修正ナビゲーションパラメータを供給する代表的なプロセスを示すフローチャート。 図1に示した装置における、ナビゲーションコンポーネント、ナビゲーションシステムコンポーネント、及び、センサの、1つ又は複数のヘルスインジケータを決定する代表的なプロセスを示すフローチャート。 図1に示した装置における、ナビゲーションコンポーネント、ナビゲーションシステムコンポーネント、及び、センサに対する、1つ又は複数のリプレースメントナビゲーションソリューションを決定する代表的なプロセスを示すフローチャート。
符号の説明
100 装置
101 メディア
105 移動体
110 ナビゲーションネットワークコンポーネント
115,120,125,130 ナビゲーションコンポーネント
135,140,145,150 センサ
155,160 外部位置決めコンポーネント
152,153,154 ナビゲーションシステム
210 ヘルスモニタコンポーネント
325 フィルタ
310,340 レバーアーム(モデル)コンポーネント

Claims (3)

  1. 移動体用の装置において、
    移動体の第1の位置に設置された第1のセンサを有し、この第1のセンサが出力値を生じるために必要な入力値として、センサの向き、位置、または速度を含む第1のナビゲーションパラメタ決定し、この第1のナビゲーションパラメタに基づいて第1のナビゲーション測定データを計算する第1のナビゲーションコンポーネントと;
    移動体の前記第1の位置の前記第1のセンサから所定距離だけ離れた第2の位置に設置された第2のセンサを有し、この第2のセンサの動作のための、前記第1のナビゲーションパラメタと同じ種類の第2のナビゲーションパラメタ決定し、この第2のナビゲーションパラメタに基づいて第1のナビゲーション測定データと同じ種類の第2のナビゲーション測定データを計算する第2のナビゲーションコンポーネントと;
    予め定めた参照位置で確立された座標系で表した第1の位置での前記移動体の構造の撓み又は曲げを記述するフレクシュラルモデルコンポーネントを有するナビゲーションネットワークプロセッサコンポーネントと;を備え、
    前記第1、第2のセンサは、1つ又は複数の開口合成レーダ、1つ又は複数の光学センサ、あるいは1つ又は複数の音響センサを備え、
    前記ナビゲーションネットワークプロセッサコンポーネントは、
    (a)(a−1)前記参照位置で確立された座標系で表した第1のセンサの位置に関する出力と、(a−2)(i)前記第1のナビゲーション測定データと(ii)第1のセンサの前記参照位置及び前記フレクシュラルモデルコンポーネントによって得られる、前記移動体の構造が撓み又は曲がっている間の第1のセンサの位置と第1のセンサの前記参照位置との間の距離を表す第1のダイナミックレバーアームのデータとによって定められる、第1の位置で前記移動体の構造が撓み又は曲がっている間の第1のセンサの位置に関する出力と、を比較して前記第1のナビゲーション測定データと同じ種類の第1の修正されたナビゲーション測定データを演算し、
    (b)(b−1)前記参照位置で確立された座標系で表した前記第1の修正されたナビゲーション測定データと、(b−2)前記第2のナビゲーション測定データに基づいて定められる第2のセンサの位置に関する出力と、を比較して、前記第1のナビゲーション測定データと同じ種類の、第2の修正されたナビゲーション測定データを演算し、前記第2の修正されたナビゲーション測定データは、第1の位置での移動体の撓み又は曲げに起因する、第2のセンサに対する第1のセンサの位置の変化を含み、
    前記第2の修正されたナビゲーション測定データは、第2のセンサの位置に対する第1のセンサの位置の前記移動体の構造の撓み又は曲げによる差を考慮していない測定値データに比べて精度が改善されていることを特徴とする移動体用の装置。
  2. 前記ナビゲーションネットワークプロセッサコンポーネントは、ニューラルネットワークを備える請求項1に記載の装置。
  3. 前記ナビゲーションネットワークプロセッサコンポーネントは、カルマンフィルタを備える請求項1に記載の装置。
JP2005189032A 2004-06-28 2005-06-28 相互補完ナビゲーションシステム Active JP5517389B2 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
US58345404P 2004-06-28 2004-06-28
US60/583,454 2004-06-28

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2011004304A Division JP2011099868A (ja) 2004-06-28 2011-01-12 相互補完ナビゲーションシステム

Publications (2)

Publication Number Publication Date
JP2006017713A JP2006017713A (ja) 2006-01-19
JP5517389B2 true JP5517389B2 (ja) 2014-06-11

Family

ID=35005636

Family Applications (2)

Application Number Title Priority Date Filing Date
JP2005189032A Active JP5517389B2 (ja) 2004-06-28 2005-06-28 相互補完ナビゲーションシステム
JP2011004304A Pending JP2011099868A (ja) 2004-06-28 2011-01-12 相互補完ナビゲーションシステム

Family Applications After (1)

Application Number Title Priority Date Filing Date
JP2011004304A Pending JP2011099868A (ja) 2004-06-28 2011-01-12 相互補完ナビゲーションシステム

Country Status (7)

Country Link
US (1) US7058505B1 (ja)
EP (1) EP1612514B1 (ja)
JP (2) JP5517389B2 (ja)
KR (1) KR101135782B1 (ja)
CA (1) CA2510714C (ja)
DE (1) DE602005014169D1 (ja)
IL (1) IL169408A (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102213198B1 (ko) * 2019-08-06 2021-02-05 주식회사 현대케피코 센서 데이터 자동 검출 기능을 구비한 차량 제어기 및 그것의 센서 데이터 자동 검출 방법

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2901363B1 (fr) * 2006-05-19 2010-04-23 Thales Sa Dispositif de navigation aerienne a capteurs inertiels et recepteurs de radionavigation et procede de navigation aerienne utilisant de tels elements
DE102007054628A1 (de) * 2007-11-15 2009-05-20 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Positionsbestimmung eines Luftfahrzeuges
ATE497147T1 (de) * 2008-09-05 2011-02-15 Converteam Technology Ltd Dynamische positionierungsarchitektur
US8204635B2 (en) * 2008-12-16 2012-06-19 Honeywell International Inc. Systems and methods of redundancy for aircraft inertial signal data
US8290744B2 (en) * 2009-01-14 2012-10-16 The Charles Stark Draper Laboratory, Inc. Integrated rate isolation sensor
US9157744B2 (en) * 2012-08-06 2015-10-13 The Boeing Company Precision multiple vehicle navigation system
RU2515469C1 (ru) * 2012-11-22 2014-05-10 Российская Федерация, от имени которой выступает Государственная корпорация по атомной энергии "Росатом" Способ навигации летательных аппаратов
EP2952994A1 (en) * 2014-06-03 2015-12-09 GE Energy Power Conversion Technology Ltd System and method for dynamic positioning
RU2613369C1 (ru) * 2016-01-28 2017-03-16 Российская Федерация, От Имени Которой Выступает Министерство Промышленности И Торговли Российской Федерации Способ навигации летательного аппарата с использованием высокоточного одноэтапного пеленгатора и адресно-ответной пакетной цифровой радиолинии в дкмв диапазоне
RU2623452C1 (ru) * 2016-05-19 2017-06-26 Российская Федерация, от имени которой выступает Государственная корпорация по атомной энергии "Росатом" Способ навигации движущихся объектов
RU2644632C1 (ru) * 2016-11-03 2018-02-13 Открытое акционерное общество Московский научно-производственный комплекс "Авионика" имени О.В. Успенского (ОАО МНПК "Авионика") Малогабаритный навигационный комплекс
EP3572819B1 (en) 2018-05-25 2020-09-09 Brüel & Kjaer Sound & Vibration Measurement A/S Method of determining spatial configurations of a plurality of transducers relative to a target object
US10889302B2 (en) 2018-06-27 2021-01-12 Honeywell International Inc. Methods for monitoring the output performance of state estimators in navigation systems
RU2707269C1 (ru) * 2019-01-21 2019-11-26 Российская Федерация, от имени которой выступает Государственная корпорация по атомной энергии "Росатом" Способ навигации летательных аппаратов и устройство для его осуществления
RU2732520C1 (ru) * 2019-07-23 2020-09-18 Войсковая часть 13991 Устройство для определения пространственной ориентации ракеты космического назначения "союз-2"

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6195609B1 (en) 1993-09-07 2001-02-27 Harold Robert Pilley Method and system for the control and management of an airport
US6901369B2 (en) * 1992-11-09 2005-05-31 Lextron, Inc. Satellite based global positioning system for feedlot computer network and method
JPH07294622A (ja) * 1994-04-21 1995-11-10 Japan Radio Co Ltd 列車位置測定方法
JP3416694B2 (ja) * 1995-01-31 2003-06-16 松下電器産業株式会社 回転角速度算出装置および車両位置算出装置
US6720920B2 (en) * 1997-10-22 2004-04-13 Intelligent Technologies International Inc. Method and arrangement for communicating between vehicles
US6768944B2 (en) 2002-04-09 2004-07-27 Intelligent Technologies International, Inc. Method and system for controlling a vehicle
US6236365B1 (en) * 1996-09-09 2001-05-22 Tracbeam, Llc Location of a mobile station using a plurality of commercial wireless infrastructures
JP3970473B2 (ja) * 1999-05-19 2007-09-05 財団法人鉄道総合技術研究所 監視手段付きgps装置
JP4304400B2 (ja) * 2000-05-31 2009-07-29 株式会社日立製作所 車両のセンサフェイル検出装置
JP3624826B2 (ja) * 2000-12-20 2005-03-02 日本電気株式会社 Gps受信装置及びgps測位システム
EP1302356B1 (en) * 2001-10-15 2006-08-02 Ford Global Technologies, LLC. Method and system for controlling a vehicle
KR100591751B1 (ko) * 2003-03-06 2006-06-22 삼성전자주식회사 신경망을 이용한 복합 항법 시스템 및 신경망 적용 방법

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102213198B1 (ko) * 2019-08-06 2021-02-05 주식회사 현대케피코 센서 데이터 자동 검출 기능을 구비한 차량 제어기 및 그것의 센서 데이터 자동 검출 방법

Also Published As

Publication number Publication date
EP1612514A1 (en) 2006-01-04
JP2006017713A (ja) 2006-01-19
US20060106511A1 (en) 2006-05-18
DE602005014169D1 (de) 2009-06-10
CA2510714A1 (en) 2005-12-28
IL169408A (en) 2010-02-17
KR101135782B1 (ko) 2012-04-16
JP2011099868A (ja) 2011-05-19
CA2510714C (en) 2013-06-25
KR20060048581A (ko) 2006-05-18
US7058505B1 (en) 2006-06-06
EP1612514B1 (en) 2009-04-29

Similar Documents

Publication Publication Date Title
JP5517389B2 (ja) 相互補完ナビゲーションシステム
US10216265B1 (en) System and method for hybrid optical/inertial headtracking via numerically stable Kalman filter
US8224574B2 (en) System for multiple navigation components
US7979231B2 (en) Method and system for estimation of inertial sensor errors in remote inertial measurement unit
CN106500693B (zh) 一种基于自适应扩展卡尔曼滤波的ahrs算法
JP2002512069A (ja) 動き追跡システム
JP4818260B2 (ja) インターフェロメトリック・センシングシステム
Guangcai et al. An iterative Doppler velocity log error calibration algorithm based on Newton optimization
CN104792336B (zh) 一种飞行状态测量方法及装置
KR101140379B1 (ko) 리 대수 및 칼만 필터를 이용한 자세 추정 방법 및 장치
Yang et al. IMU signal software simulator
CN110857860B (zh) 一种定位转换方法及其系统
CN115060259A (zh) 多imu融合的定位系统及方法
CN118089710A (zh) 一种基于imu和lstm辅助的惯性导航性能保持方法
Wagner et al. Integrated motion measurement of multibody systems and flexible vehicle structures
Fontana et al. Robust Emergency Procedures for Quadrotors
Martí et al. Analysis of a sensor fusion hybrid solution for indoor/outdoor robot navigation

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080606

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20101012

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110112

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110531

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110824

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20110912

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20111125

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20111125

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120214

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120514

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120524

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20121211

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130404

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20130405

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20130426

A912 Re-examination (zenchi) completed and case transferred to appeal board

Free format text: JAPANESE INTERMEDIATE CODE: A912

Effective date: 20130628

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140220

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140401

R150 Certificate of patent or registration of utility model

Ref document number: 5517389

Country of ref document: JP

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