JP6170983B2 - 慣性航法システム及び慣性航法システムにおける磁気異常検出支援を提供する方法 - Google Patents

慣性航法システム及び慣性航法システムにおける磁気異常検出支援を提供する方法 Download PDF

Info

Publication number
JP6170983B2
JP6170983B2 JP2015212867A JP2015212867A JP6170983B2 JP 6170983 B2 JP6170983 B2 JP 6170983B2 JP 2015212867 A JP2015212867 A JP 2015212867A JP 2015212867 A JP2015212867 A JP 2015212867A JP 6170983 B2 JP6170983 B2 JP 6170983B2
Authority
JP
Japan
Prior art keywords
moving body
magnetic
magnetometers
magnetic field
magnetometer
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
JP2015212867A
Other languages
English (en)
Other versions
JP2016126001A (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 JP2016126001A publication Critical patent/JP2016126001A/ja
Application granted granted Critical
Publication of JP6170983B2 publication Critical patent/JP6170983B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18Stabilised platforms, e.g. by gyroscope
    • 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/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • G01C21/08Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
    • 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/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • G01C21/1654Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with electromagnetic compass
    • 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
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • G01P15/02Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of inertia forces using solid seismic masses
    • G01P15/08Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of inertia forces using solid seismic masses with conversion into electric or magnetic values
    • G01P15/105Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of inertia forces using solid seismic masses with conversion into electric or magnetic values by magnetically sensitive devices
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • G01P15/14Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of gyroscopes

Description

本開示は、一般的にはセンサシステムに関し、より詳細には、慣性航法システムの磁気異常追跡に関する。
航法および慣性データは、移動体(vehicle)に関連する速度、位置、および方位情報、あるいは速度、位置、または方位情報等、移動体の運動に関する情報に対応可能である。このような航法および慣性データを実装することによって、移動体の経時的な運動を追跡するとともに、たとえば経時的な移動体の位置および計時情報を計算することができる。航法および慣性データは、ジャイロスコープおよび加速度計、あるいはジャイロスコープまたは加速度計等、多様な種類のセンサを介して取得することができる。別の例として、航空機の場合は、大気速度を測定することによって、周囲の空気に対する航空機の速度を測定することができる。ただし、大気速度の測定は、地面に対する風速および航空機周りの気流変動の両者の1次従属である。船舶についても、その速度の測定に同様の不確実性が存在し得る。したがって、一部の移動体では、慣性データの測定および航法解の計算、あるいは慣性データの測定または航法解の計算のための追加または代替システムが必要となる場合がある。
米国特許第4509131号明細書 米国特許第7400142号明細書 米国特許第7526384号明細書 米国特許第8423276号明細書 米国特許第8461999号明細書 米国特許出願公開第2008/0262772号明細書 米国特許出願公開第2011/0238307号明細書 米国特許出願公開第2013/0018582号明細書 国際公開第2013/150183号
一例として、航法および慣性データの測定は、全地球航法衛星システム(GNSS:Global Navigation Satellite System)測定および視覚的補助(たとえば、地球固定特徴追跡もしくは光学的流速補助のための地上対向カメラまたは慣性的に固定された星に対する方位および位置補助のための星追跡システムに基づく)等、他の種類のセンサシステムによって補助可能な場合が多い。ただし、現代の電子戦では、晴天条件においてもGNSS測定が確実とは考えられず、都市の谷間、高密度に成長した林冠、屋内、地下、および水中環境等の特定の環境では、最適状況のGNSS信号の有効性に頼ることができない。また、視覚的補助では通常、明確かつ固定された視覚的特徴を有する領域または星をはっきりと視認できる領域の中または上方を移動体が進行する必要があるため、慣性データの計算による航法解の決定を支援する様態としては、限定的となり得る場合が多い。たとえば、このような視覚的補助は、星追跡システムまたは他の視覚的特徴(たとえば、山または川等)を識別するシステムを実装可能である。ただし、これらの技術は、可視性条件または移動体自体に対する有用な近接性の欠如によって制限され得る場合が多いため、慣性データまたは航法解における誤差成長の効果的な低減を制限する可能性がある。
一例として、慣性航法システム(INS:Inertial Navigation System)が挙げられる。このINSは、移動体上に構成された少なくとも1つの航法センサおよび磁気異常データに基づいて、移動体の運動に関連する慣性データを生成するように構成された航法コントローラを備える。また、このINSは、移動体上の複数の位置それぞれに分散して配置された複数の磁力計を具備した磁気異常INS補助システムを備える。磁気異常INS補助システムは、複数の磁力計それぞれにおける固定磁気異常の磁界測定結果に基づいて、磁気異常データを生成するように構成可能である。
別の例として、移動体のINSにおける磁気異常検出支援を提供する方法が挙げられる。この方法は、移動体周りのアレイ状に配置された複数の磁力計を介して、地球座標フレーム(たとえば、ECEF(Earth−Centered, Earth−Fixed:地球中心地球固定)、ECR(Earth Centered Rotational:地球中心回転)、IRP(International Reference Pole:国際基準極)、IRM(International Reference Meridian:国際基準子午線)、または磁気異常との関係が既知であるその他任意の関連基準フレーム)または類似の基準フレーム(たとえば、他の惑星または衛星上等の地球外用途の場合)に対する固定磁気異常に関連する磁界測定結果を取得するステップを含む。また、この方法は、移動体周りの複数の磁力計それぞれに関連する複数の位置間の所定の距離に対する磁界測定結果に関連する磁気異常データを提供するステップを含む。さらに、この方法は、INSを介した磁気異常データに基づいて、地球座標フレームに対する移動体の速度を計算するステップを含む。
別の例として、INSが挙げられる。このINSは、移動体上に構成された少なくとも1つの航法センサおよび磁気異常データに基づいて、地球座標フレームに対する移動体の速度に関連する慣性データを生成するように構成された航法コントローラを備える。また、このINSは、移動体上の複数の位置それぞれにアレイ状に分散し、互いに所定の距離を有する複数の磁力計を具備した磁気異常INS補助システムを備える。磁気異常INS補助システムは、上記所定の距離に関し、複数の磁力計それぞれにおける固定磁気異常の磁界測定結果に基づいて磁気異常データを生成するように構成可能である。
慣性航法システム(INS)の一例を示す図。 移動体の一例を示す図。 磁気異常データを取得する構成の一例を示す図。 移動体の別の例を示す図。 慣性航法システムにおける磁気異常検出支援を提供する方法の一例を示す図。
本開示は、一般的にはセンサシステムに関し、より詳細には、慣性航法システム(INS)の磁気異常追跡に関する。INSは、移動体上に構成された少なくとも1つの航法センサおよび磁気異常データに基づいて、移動体の運動に関連する慣性データを生成するように構成された航法コントローラを備える。一例として、磁気異常データは、地球座標フレームの固定位置からの磁気異常と関連付け可能である。また、磁気異常データは、固定磁気異常を測定するようにそれぞれが構成された複数の磁力計を具備した磁気異常INS補助システムによって生成可能である。一例として、磁力計は、互いに所定の距離で、移動体周りのアレイとして配置可能である。したがって、磁気異常データを実装することにより、互いに所定の距離での固定磁気異常の磁界測定結果に基づいて、移動体の速度を計算することができる。これにより、磁気異常データを実装することによって、航法センサが生成した慣性データ中の移動体に関連する速度および方位、あるいは速度または方位誤差成長を実質的に抑制することができる。
一例として、磁気異常INS補助システムは、複数の磁力計それぞれから磁界測定結果を受信し、磁力計アレイの磁界測定結果の比較に基づいて、固定磁気異常の位置に関連する複合磁界測定結果として磁気異常データを生成するように構成された磁力計コントローラを具備可能である。たとえば、磁力計は、移動体前進運動の方向に対応した移動体の実質的な中心軸に沿って、1次元アレイとして(たとえば、第1の磁力計を前部に、第2の磁力計を後部に)配置可能である。磁力計コントローラは、たとえば磁界測定結果に基づいて相関アルゴリズムを実装するように構成可能である。相関アルゴリズムは、磁界測定結果それぞれに対する特徴照合を行って、磁界測定結果に関連するノイズを実質的に抑制するとともに、固定磁気異常の検出に関する誤差修正を行うように構成可能である。また、磁力計コントローラは、実時間の磁界測定結果および相関アルゴリズムに基づいて生成された信頼性スコアに基づいて、地球座標フレームに対する移動体の速度を計算するように構成可能である。これにより、INSは、全地球航法衛星システム(GNSS)受信機を用いずに、慣性センサデータのみを用いた場合よりも正確に慣性データを生成して移動体の位置解を計算することができる。
図1は、慣性航法システム(INS)10の一例を示した図である。INS10は、移動体の制御電子回路に実装可能である。移動体は、陸上車、船舶、航空機、または宇宙船等の多様な移動体のうちのいずれかとすることが可能であり、また、有人もしくは無人とすることが可能である。別の例として、移動体は、小型自動化移動体(たとえば、惑星間探査機)等の小型移動体とすることが可能である。あるいは、人間とすることも可能である。INS10は、移動体の速度、位置、および方位のうちの少なくとも1つの実時間での計算等によって、移動体の運動を制御および記録、あるいは制御または記録するように構成可能である。
INS10は、少なくとも1つの航法センサ14が提供する測定結果に基づいて、移動体の運動に関連する慣性データを計算するように構成された航法コントローラ12を具備する。図1の例において、航法センサ14が提供する測定結果は、信号NAVで表している。たとえば、航法センサ14は、(たとえば、大気速度を測定することによって)速度を測定するように構成されたセンサ、少なくとも1つのジャイロスコープ、少なくとも1つの加速度計、および他の多様な測定装置の少なくとも何れか一つを具備可能である。したがって、航法センサ14が提供する測定結果NAVは、速度、少なくとも1つの感知軸周りの回転速度もしくは回転角、および少なくとも1つの座標フレーム軸における加速度の少なくとも一つを含み得る。
また、INS10は、図1の例において、航法コントローラ12に提供される信号NAVとして表した磁気異常データを生成するように構成された磁気異常INS補助システム16を具備する。磁気異常INS補助システム16は、複数(N個)の磁力計18を具備しており、Nは正の整数である。磁力計18は、核磁気共鳴(NMR:Nuclear Magnetic Resonance)磁力計、電子常磁性共鳴(EPR:Electron Paramagnetic Resonance)磁力計、フラックスゲート磁力計、または他の多様な種類もしくは組み合わせの磁力計システムのうちのいずれかとしての構成等に基づいて、スカラーおよびベクトル、あるいはスカラーまたはベクトルの磁界測定結果を測定する多様な種類の磁力計のうちのいずれかとして構成可能である。一例として、磁力計18は、互いに所定の距離だけ離間したそれぞれの位置において、移動体周りのアレイ状に配置可能である。図1の例において、磁力計18は、それぞれ磁界測定結果M〜Mで表した外部磁界を実時間で測定するように構成されている。磁界測定結果M〜Mは、移動体上の磁力計の各位置に対する磁界測定結果M〜Mに基づいて磁気異常データNAVを計算するように構成された磁力計コントローラ20に提供される。
たとえば、磁力計18はそれぞれ、地球座標空間上の固定位置に関連するか、または別の基準フレームに対して固定された磁気異常(以下、「固定磁気異常」と称する)を測定可能である。固定磁気異常は一般的に、移動体が進行可能な任意の動作環境において遍在するため、磁気異常INS補助システム16は、ほとんどすべての環境において、十分なINS補助能力を提供可能である。一例として、磁力計18は、それぞれ移動体の前部および移動体の後部に配置され、移動体前進運動の方向に対応した移動体の実質的な中心軸(たとえば、移動体の座標フレームのロール軸)に沿って互いに所定の距離を有する第1の磁力計および第2の磁力計を少なくとも具備可能である。したがって、磁力計コントローラ20は、移動体が前方に進行する際の第1および第2の磁力計18間の固定磁気異常の測定結果の時間遅延に基づいて、地球座標フレームまたはその他任意の関連基準フレームにおける速度を計算可能である。別の例として、磁力計18は、移動体前進運動の方向と直交した軸に沿う航空機の翼端等、少なくとも2次元のアレイ状に構成可能である。
このため、移動体上の磁力計18の相対位置に基づいて、磁力計コントローラ20は、磁力計18それぞれが測定した固定磁気異常に対する移動体の運動の関数として、磁気異常データNAVを計算可能である。その結果、磁気異常データNAVが航法コントローラ12に提供されることにより、航法コントローラは、航法センサ14が提供する測定結果NAVおよび磁気異常データNAVに基づいて慣性データ(たとえば、移動体の位置姿勢、方位、および速度解、あるいは位置姿勢、方位、または速度解)を計算するように構成可能である。一例として、航法コントローラ12は、航法センサ14が提供する測定結果NAVおよび磁気異常データNAVを相関させてより正確な航法解を提供するように構成された航法アルゴリズムを実装するように構成可能である。たとえば、航法アルゴリズムは、カルマンフィルタ、最適状態推定器、または測定結果NAVおよび磁気異常データNAVに基づいて慣性データを計算する多様な統計的アルゴリズムのうちのいずれかにより実装可能である。
一例として、慣性データは初めに、航法センサ14が提供する測定結果NAVに基づいて、航法コントローラ12により計算可能である。そして、航法コントローラ12は、磁気異常データNAVを実装することにより、航法センサ14が提供する測定結果NAVとは独立して慣性データを計算することができる。したがって、航法コントローラ12は、慣性データの測定結果を比較することにより、航法センサ14が提供する測定結果NAV中の誤差の実質的な軽減等が可能である。たとえば、航法コントローラ12は、磁気異常データNAVに応答して、航法センサ14が提供する測定結果NAVに基づいて計算された慣性データ中の速度および方位、あるいは速度または方位誤差成長を抑制することができる。別の例として、航法コントローラ12は、磁気異常データNAVに応答して、多様な統計的アルゴリズムのうちのいずれか等に基づき、測定結果NAVおよび磁気異常データNAVの組み合わせに基づいて、慣性データを計算することができる。
また、磁力計コントローラ20は、異常データNAVの計算に相関アルゴリズムを実装するように構成可能である。たとえば、磁力計コントローラ20は、相関アルゴリズムおよび磁力計18の実時間測定結果を実装することにより、磁界測定結果M〜Mの特徴照合を行って、磁界測定結果M〜Mの互いの誤差の判定等(たとえば、すべての磁力計18が同じ固定磁気異常を測定したか否かの判定)を行うことができる。相関アルゴリズムを実装して磁力計18の実時間測定結果に関連する信頼性スコアを生成することにより、磁力計18の信頼性スコアおよび実時間測定結果を実装して磁気異常データNAVをより正確に計算することができる。これにより、磁気異常データNAVは、GNSS受信機を用いることなく、正確にINS補助を提供可能である。
さらに、磁気異常INS補助システム16は、INS10のセンサ14に対する誤差修正を行うように構成可能である。一例として、磁力計18は、固定磁気異常の大きさおよび方向の両者を測定するように構成可能である。したがって、磁界測定結果M〜Mは、固定磁気異常に関するベクトルおよびスカラー情報を含むものとして、磁力計コントローラ20に提供される。その結果、磁力計コントローラ20は、スカラーおよびベクトルの磁界測定結果M〜Mの相互相関に基づいて、関連するセンサ14中の1つまたは複数のジャイロスコープおよび加速度計に関連する測定ドリフトを航法コントローラ12が抑えられるように、磁気異常データNAVを提供可能である。その結果、磁力計コントローラ20は、航法解の決定における誤差成長の速度を低減することにより、より長い期間にわたって、航法解の正確性の向上等を行うことができる。これにより、航法コントローラ12は、地球座標フレーム等の所与の座標フレームに対する全3つの移動体座標フレーム軸周りの方位情報を提供可能である。
したがって、本明細書に記載の通り、INS10は、磁気異常データNAVを組み込むことによって、通常の航法補助解に優る改善された航法補助解を提供することができる。たとえば、都市の谷間、高密度に成長した林冠、屋内、地下、および水中環境等に生じ得る特定の環境でGNSS信号の有効性が制限されることに基づいて、GNSS受信機を組み込んだ通常の航法補助解は、誤差の影響を受ける可能性がある。ただし、磁気異常は、移動体が進行可能な任意の環境でほとんど例外なく利用可能であるため、INS10は、複数の磁力計18、より具体的には測定結果M〜Mに対する磁力計18それぞれの位置に基づいて、磁気異常の測定結果に基づく航法補助を提供可能である。複数の磁力計18を実装することによって、単一の磁力計のみを組み込んだ他の航法補助解よりも信頼性の高い航法補助解が得られる。たとえば、単一の磁力計を組み込んだ通常の航法補助解では、移動体が進行する局所領域に前もってマッピングされた異常に対して、観測された異常を相関させようとするため、(たとえば、所定の磁気異常マップに基づく)関心領域の局所的な磁気異常に関する予備知識なしに、航法補助は起こり得ない。以上から、INS10は、磁気異常に関する予備知識およびGNSS受信機なしに、航法補助を提供可能である。また、INS10は、1つまたは複数の磁気異常の位置が地球座標フレームにおいて特定されている場合、地球座標フレームにおける移動体の位置を計算するように構成可能である。
図2は、移動体50の一例を示した図である。図2の例において、移動体50は、前部52および後部54のほか、左翼56および右翼58を有する航空機として表している。また、移動体50は、当該移動体50の前部52に搭載された第1の磁力計60と当該移動体50の後部54に搭載された第2の磁力計62とを具備するものとして表している。第1および第2の磁力計60および62は、移動体50の製造時等に予め決定された距離に対応可能な距離Dだけ離れている。一例として、第1の磁力計60および第2の磁力計62は、たとえば移動体50のロール軸に対応した移動体50の実質的な中心軸64に沿って、前部52および後部54にそれぞれ搭載可能である。一例として、第1および第2の磁力計60および62は、移動体50がINS10(図2の例には図示せず)を具備し得るように、図1の例の磁気異常INS補助システム16の磁力計18のうちの2つに対応可能である。
したがって、第1および第2の磁力計60および62は、アレイ状に配置されることにより、図2の例でベクトルVとして表した速度ベクトルに沿って移動体50が進行する際の固定磁気異常を測定する。たとえば、第1および第2の磁力計60および62は、移動体50の座標フレームに対する空間的な方位および位置に固定され、移動体50が速度ベクトルVに沿って進行する際に通過する自然発生的な多くの磁界異常のうちの1つ等の固定磁気異常を追跡する。一例として、磁力計コントローラ(たとえば、磁力計コントローラ20)は、移動体50上の第1および第2の磁力計60および62の相対位置に基づき、第1および第2の磁力計60および62それぞれが測定した固定磁気異常に対する移動体50の運動の関数として、磁気異常データNAVを計算することができる。その結果、磁気異常データNAVが関連する航法コントローラ(たとえば、航法制コントローラ12)に提供されることで、航法コントローラは、関連する航法センサ(たとえば、航法センサ14)が提供する測定結果NAVおよび磁気異常データNAVに基づいて、慣性データを計算するように構成可能である。たとえば、磁気異常データNAVを実装することによって、(たとえば、測定結果NAVによりもたらされる)航法センサに関連する速度および方位、あるいは速度または方位誤差を抑制することができる。
図3は、磁気異常データを取得する構成100の一例を示した図である。構成100は、移動体50が速度ベクトルVに沿って進行する様子を表している。図2の例において説明した通り、移動体50は、当該移動体50の前部に第1の磁力計60と当該移動体50の後部に第2の磁力計62とを具備し、第1および第2の磁力計60および62は、実質的な中心軸64(たとえば、移動体50の座標フレームのロール軸)に沿って位置決めされている。また、構成100は、移動体50から地理的に分離された固定磁気異常102を含む。一例として、固定磁気異常102は、地球座標フレームにおいて固定された自然発生的な磁気異常に対応可能である。したがって、移動体50は、デカルト座標系104が与えるY方向に、速度ベクトルVに沿って固定磁気異常を通過する。
図3の例に表した移動体50の位置において、第1の磁力計60は、固定磁気異常に関連する磁界Mを測定し、第2の磁力計62は、固定磁気異常に関連する磁界Mを測定する。一例として、図3の例に表した移動体50の位置は、時刻Tに対応することにより、第1の磁力計60が固定磁気異常102に関連する磁界Mを時刻Tに測定可能となる。時刻Tから経過時間Tだけ進んだ時刻Tにおいて、第2の磁力計62は、磁界Mを測定可能であるため、時刻Tは時刻T+Tに対応可能である。たとえば、磁界Mは、第1の磁力計60が測定した時刻Tの磁界Mの振幅と略等しい振幅にて、第2の磁力計62により測定可能である。第1および第2の磁力計60および62間の距離Dが既知の固定値であることから、磁力計コントローラ(たとえば、磁力計コントローラ20)は、第1および第2の磁力計60および62間の実質的な中心軸64に沿った移動体50の速度を計算することができる。一例として、移動体50の速度Vは、第1および第2の磁力計60および62間の固定距離Dを第1および第2の磁力計60および62それぞれによる磁界Mの観測間の時間で除算することにより計算可能であり、式1で与えられる。
=D/T (式1)したがって、関連する航法コントローラ(たとえば、航法コントローラ12)で速度Vを実装することにより、航法センサを介して提供される移動体50の速度の測定結果の増強や航法センサによる移動体50の速度の計算における誤差の実質的な軽減が可能となる。
一例として、移動体50の関連する磁気異常INS補助システム(たとえば、磁気異常INS補助システム16)は、速度Vを実時間で連続して計算することができる。たとえば、時刻Tに先立つある時刻において、移動体50の磁気異常INS補助システムは、移動体50が速度ベクトルVに沿って進行する際の第1および第2の磁力計60および62による磁界Mの各測定結果に基づいて、速度Vを測定することができる。同様に、時刻Tの後のある時刻において、移動体50の磁気異常INS補助システムは、移動体50が速度ベクトルVに沿って進行する際の第1および第2の磁力計60および62による磁界Mの各測定結果に基づいて、速度Vを測定することができる。たとえば、関連する磁力計コントローラは、相関アルゴリズムならびに第1および第2の磁力計60および62の実時間測定結果を実装することにより、磁界M、M、およびMの特徴照合を行って、磁界測定結果M、M、およびMの互いの誤差の判定等を行い、磁力計60および62が固定磁気異常102を測定したか否かの判定等を行うことができる。また、相関アルゴリズムを実装することによって、第1および第2の磁力計60および62の実時間測定結果に関連する信頼性スコアを生成することで、第1および第2の磁力計60および62の信頼性スコアおよび実時間測定結果の実装により磁気異常データをより正確に計算することができる。
図4は、移動体150の別の例を示した図である。図4の例において、移動体150は、前部152および後部154のほか、左翼156および右翼158を有する航空機として表している。また、移動体150は、当該移動体150の前部152に搭載された第1の磁力計160と当該移動体150の後部154に搭載された第2の磁力計162とを具備するものとして表している。第1および第2の磁力計160および162は、移動体150の製造時等に予め決定された距離に対応可能な距離Dだけ離れている。一例として、第1の磁力計160および第2の磁力計162は、たとえば移動体150のロール軸に対応した移動体150の実質的な中心軸164に沿って、前部152および後部154にそれぞれ搭載可能である。
同様に、移動体150は、当該移動体150の左翼156に搭載された第3の磁力計166と当該移動体150の右翼158に搭載された第4の磁力計168とを具備するものとして表している。第3および第4の磁力計166および168は、移動体150の製造時等に予め決定された距離に対応可能な距離Dだけ離れており、予想および測定、あるいは予想または測定された移動体動力学に基づいて、最高のINS補助性能が得られるように最適化されている。一例として、第3の磁力計166および第4の磁力計168は、実質的な中心軸164と略直交した移動体150の軸170に沿って、左翼156および右翼158にそれぞれ搭載可能である。一例として、第1、第2、第3、および第4の磁力計160、162、166、および168は、移動体150がINS10(図4の例には図示せず)を具備し得るように、図1の例の磁気異常INS補助システム16の磁力計18のうちの4つに対応可能である。
したがって、第1、第2、第3、および第4の磁力計160、162、166、および168は、アレイ状に配置されることにより、図4の例でベクトルVとして表した速度ベクトルに沿って移動体150が進行する際の固定磁気異常を測定する。一例として、第1および第2の磁力計160および162ならびに第3および第4の磁力計166および168はすべて、同一平面内に配置可能であるか、または第1および第2の磁力計160および162ならびに第3および第4の磁力計166および168の対に関して面外とすることが可能である。たとえば、第1、第2、第3、および第4の磁力計160、162、166、および168は、移動体150の座標フレームに対する空間的な方位および位置に固定され、移動体150が速度ベクトルVに沿って進行する際に通過する自然発生的な多くの磁界異常のうちの1つ等の固定磁気異常を追跡する。
一例として、磁力計コントローラ(たとえば、磁力計コントローラ20)は、移動体150上の第1、第2、第3、および第4の磁力計160、162、166、および168の相対位置に基づき、第1、第2、第3、および第4の磁力計160、162、166、および168それぞれが測定した固定磁気異常に対する移動体150の運動の関数として、磁気異常データNAVを計算することができる。その結果、磁気異常データNAVが関連する航法コントローラ(たとえば、航法コントローラ12)に提供されることで、航法コントローラは、関連する航法センサ(たとえば、航法センサ14)が提供する測定結果NAVおよび磁気異常データNAVに基づいて、慣性データを計算するように構成可能である。
別の例として、図2の例における移動体50に対して移動体150の磁力計の数が増えていることから、第1、第2、第3、および第4の磁力計160、162、166、および168のそれぞれ個々の磁界測定結果に基づいて、固定磁気異常に関連する磁界の測定ノイズおよび誤差源を実質的に抑制することができる。たとえば、関連する磁気異常INS補助システムは、図2の例における移動体50の第1および第2の磁力計60および62に対して、第1、第2、第3、および第4の磁力計160、162、166、および168の改善された特徴照合を実装することができる。また、一例として、移動体150は、系統的誤差の抑制に第1、第2、第3、および第4の磁力計160、162、166、および168のアレイが役立ち得るように、(たとえば、旋回および高度変更時の)ロール軸に直接沿わない航法に有用な基準フレームに対する進行方向を有することができる。したがって、第3および第4の磁力計166および168は、速度、加速度、および方位情報等の利用可能な航法情報を増強することができる。
図4の例において、第1、第2、第3、および第4の磁力計160、162、166、および168は、2次元アレイで表している。したがって、移動体150の速度成分は、移動体150のロール−ピッチ面等、移動体座標面の複数の面に関して計算可能である。また、移動体150は、第1および第2の磁力計160および162ならびに第3および第4の磁力計166および168の対のうちの少なくとも1つに関して面外となる磁力計等、付加的な磁力計を組み込むことも可能である。したがって、第1、第2、第3、および第4の磁力計160、162、166、および168ならびに付加的な磁力計は、3次元アレイ状に配置可能である。このように、移動体150の速度の3つの直交成分を計算可能であるとともに、3次元の磁力計アレイは、(たとえば、3つの直交軸それぞれに沿ったジャイロスコープに関して)方位誤差修正を行うように構成可能である。さらに、3次元の磁力計アレイは、潜水艦/UUV(Unmanned Underwater Vehicle)、ヘリコプタ/垂直離着陸(VTOL:Vertical Take−Off and Landing)移動体、人間、または少なくとも2つの方向に類似の速度を有し得るその他任意の移動体等、大きさが類似し得る全3つの方向の速度成分を有する他の種類の移動体に対して特に有用となり得る。
上述の構造的および機能的特徴を考慮すると、図5を参照して、本発明の種々態様に係る方法がより深く理解される。図5の方法は、説明の簡略化のため、順次実行するものとして図示および記載しているが、当然のことながら、本発明は図示の順序によって制限されず、本発明に係る一部の態様は、本明細書に図示および記載する態様と異なる順序および/または他の態様と同時に生じ得る。さらに、図示の特徴すべてにおいて、本発明の一態様に係る方法を実装していなくてもよい。
図5は、慣性航法システム(たとえば、INS10)における磁気異常検出支援を提供する方法200の一例を示した図である。ステップ202においては、移動体(たとえば、移動体50)周りのアレイ状に配置された複数の磁力計(たとえば、磁力計18)を介して、地球座標フレームに対する固定磁気異常(たとえば、固定磁気異常102)に関連する磁界測定結果を取得する。ステップ204においては、移動体周りの複数の磁力計それぞれに関連する複数の位置間の所定の距離(たとえば、距離D)に対する磁界測定結果に関連する磁気異常データ(たとえば、磁気異常データNAV)を提供する。ステップ206においては、INSを介した磁気異常データに基づいて、地球座標フレームに対する移動体の速度を計算する。
以上の説明は、本発明の一例である。当然のことながら、考え得るあらゆる構成要素の組み合わせまたは本発明を記述するための方法を説明することは不可能であるが、当業者であれば、本発明のその他多くの組み合わせおよび並べ替えが可能であることが認識されよう。したがって、本発明は、添付の特許請求の範囲を含めて、本願の範囲に含まれるこのようなすべての変更、改良、および変形を包含するものである。

Claims (15)

  1. 慣性航法システムであって、
    移動体上に構成された少なくとも1つの航法センサおよび磁気異常データに基づいて、前記移動体の運動に関連する慣性データを生成するように構成された航法コントローラと、
    前記移動体上の複数の位置それぞれに分散して配置された複数の磁力計を具備した磁気異常INS補助システムであり、前記複数の磁力計それぞれにおける固定磁気異常の磁界測定結果に基づいて前記磁気異常データを生成するように構成された、磁気異常INS補助システムと、
    を備えた慣性航法システム。
  2. 前記複数の磁力計が、互いに所定の距離で前記複数の位置に配置されることにより、前記所定の距離に関し、前記複数の磁力計それぞれにおける磁界測定結果に基づいて、前記磁気異常INS補助システムが前記磁気異常データを生成するように構成されたものである、請求項1に記載の慣性航法システム。
  3. 前記複数の磁力計が、前記移動体の前部に配置された第1の磁力計と前記移動体の後部に配置された第2の磁力計とを備え、前記第1および第2の磁力計が、移動体前進運動の方向に対応した前記移動体の中心軸に沿って、互いに所定の距離で配置された、請求項1に記載の慣性航法システム。
  4. 前記複数の磁力計が、前記移動体の左舷に配置された第3の磁力計と、前記移動体の右舷に配置された第4の磁力計とをさらに備え、前記第3および第4の磁力計が、前記中心軸に対して略直交する前記移動体の軸に沿って、互いに所定の距離で配置された、請求項3に記載の慣性航法システム。
  5. 記航法コントローラが前記磁気異常データを実装して、前記複数の磁力計それぞれにおける前記磁界測定結果に基づいて、地球座標フレームに対する前記移動体の速度を計算する、請求項1に記載の慣性航法システム。
  6. 前記磁気異常INS補助システムが、前記複数の磁力計それぞれから前記磁界測定結果を受信し、前記磁界測定結果の比較に基づいて、前記固定磁気異常の位置に関連する複合磁界測定結果として前記磁気異常データを生成するように構成された磁力計コントローラを備えた、請求項1に記載の慣性航法システム。
  7. 前記磁力計コントローラが、前記磁界測定結果に基づいて相関アルゴリズムを実装するように構成され、前記相関アルゴリズムが、前記磁界測定結果それぞれに対する特徴照合を行って、前記磁界測定結果に関連するノイズを抑制するとともに、前記固定磁気異常の検出に関する誤差修正を行うように構成されたものである、請求項6に記載の慣性航法システム。
  8. 前記磁力計コントローラが、前記相関アルゴリズムに基づいて、前記固定磁気異常の検出に関連する信頼性スコアを生成するように構成されており、前記磁力計コントローラが、前記信頼性スコアおよび前記磁界測定結果を実時間で実装することによって、地球座標フレームに対する前記移動体の速度を計算する、請求項7に記載の慣性航法システム。
  9. 前記複数の磁力計が、前記移動体に沿った少なくとも2次元のアレイに分散しており、前記磁気異常INS補助システムが、前記少なくとも2次元の磁力計アレイに基づいて、少なくとも2つの座標フレーム軸における速度、加速度、方位、および位置のうちの少なくとも1つを計算するように構成されたものである、請求項1に記載の慣性航法システム。
  10. 前記移動体上に構成された前記少なくとも1つの航法センサが、ジャイロスコープおよび加速度計のうちの少なくとも一方を備え、前記航法コントローラが、前記磁気異常データに基づいて、前記ジャイロスコープおよび前記加速度計のうちの前記少なくとも一方に関連する誤差を軽減するように構成されたものである、請求項1に記載の慣性航法システム。
  11. 移動体の慣性航法システムにおける磁気異常検出支援を提供する方法であって、
    前記移動体周りのアレイ状に配置された複数の磁力計を介して、地球座標フレームに対する固定磁気異常に関連する磁界測定結果を取得するステップと、
    前記移動体周りの前記複数の磁力計それぞれに関連する複数の位置間の所定の距離に対する前記磁界測定結果に関連する磁気異常データを提供するステップと、
    前記慣性航法システムを介した前記磁気異常データに基づいて、地球座標フレームに対する前記移動体の速度を計算するステップと、
    を備える方法。
  12. 移動体上に構成された少なくとも1つの航法センサおよび前記磁気異常データに基づいて、前記移動体の運動に関連する慣性データを生成するステップであり、前記慣性データが、前記移動体の速度および位置のうちの少なくとも一方を含む、ステップをさらに備える請求項11に記載の方法。
  13. 前記磁界測定結果に基づいて相関アルゴリズムを実装するステップと、
    前記相関アルゴリズムに基づいて前記磁界測定結果を比較することにより、前記磁界測定結果それぞれに対する特徴照合を行って、前記磁界測定結果に関連するノイズを抑制するとともに、前記固定磁気異常の検出に関する誤差修正を行うステップと、
    をさらに備える請求項11に記載の方法。
  14. 前記相関アルゴリズムに基づいて、前記固定磁気異常の検出に関連する信頼性スコアを生成するステップをさらに備え、前記移動体の速度を計算するステップが、実時間で前記信頼性スコアおよび前記磁界測定結果に基づいて、前記移動体の速度を計算するサブステップを含む、請求項13に記載の方法。
  15. ジャイロスコープおよび加速度計のうちの少なくとも一方に基づいて、前記移動体に関連する慣性データを生成するステップと、
    前記磁気異常データに基づいて、前記ジャイロスコープおよび前記加速度計のうちの前記少なくとも一方に関連する前記慣性データの誤差修正を行うステップと、
    をさらに備える請求項11に記載の方法。
JP2015212867A 2014-12-30 2015-10-29 慣性航法システム及び慣性航法システムにおける磁気異常検出支援を提供する方法 Active JP6170983B2 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
US14/586,207 US9857179B2 (en) 2014-12-30 2014-12-30 Magnetic anomaly tracking for an inertial navigation system
US14/586,207 2014-12-30

Publications (2)

Publication Number Publication Date
JP2016126001A JP2016126001A (ja) 2016-07-11
JP6170983B2 true JP6170983B2 (ja) 2017-07-26

Family

ID=54251376

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015212867A Active JP6170983B2 (ja) 2014-12-30 2015-10-29 慣性航法システム及び慣性航法システムにおける磁気異常検出支援を提供する方法

Country Status (3)

Country Link
US (1) US9857179B2 (ja)
EP (1) EP3040680B1 (ja)
JP (1) JP6170983B2 (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9677889B2 (en) * 2012-06-21 2017-06-13 Innovative Solutions & Support, Inc. Method and system for compensating for soft iron magnetic disturbances in multiple heading reference systems
US9207079B2 (en) * 2012-06-21 2015-12-08 Innovative Solutions & Support, Inc. Method and system for compensating for soft iron magnetic disturbances in a heading reference system
CN107065898B (zh) * 2016-12-06 2021-03-26 北京臻迪科技股份有限公司 一种水下无人船航行控制方法及系统
CN108107883B (zh) * 2017-11-07 2020-10-30 浙江工业大学 一种基于磁带导引agv的多传感器信息融合定位方法
US20220178692A1 (en) * 2017-12-21 2022-06-09 Mindmaze Holding Sa System, method and apparatus of a motion sensing stack with a camera system
CN109029455A (zh) * 2018-07-17 2018-12-18 济南浪潮高新科技投资发展有限公司 一种室内导航方法
US20200264209A1 (en) * 2019-02-15 2020-08-20 Hoverfly Technologies, Inc. System and method for determining wind direction and velocity measurement from altitude for an unmanned aerial vehicle
CN112033405B (zh) * 2020-08-10 2022-06-17 北京摩高科技有限公司 一种室内环境磁异常实时修正与导航方法及装置

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4509131A (en) 1982-06-01 1985-04-02 The United States Of America As Represented By The Secretary Of The Navy Geomagnetic velocimeter
GB8622127D0 (en) * 1986-09-13 1997-09-17 Gev Avionics Limited Navigation system
AU2003900863A0 (en) 2003-02-26 2003-03-20 Commonwealth Scientific & Industrial Research Organisation Inertial and radiolocation method
US7400142B2 (en) * 2003-11-06 2008-07-15 Stephen John Greelish Dynamic magnetic anomaly compensation
US7526384B2 (en) 2005-03-10 2009-04-28 Witten Technologies Inc. Method for correcting a 3D location measured by a tracking system assuming a vertical offset
EP1970005B1 (en) 2007-03-15 2012-10-03 Xsens Holding B.V. A system and a method for motion tracking using a calibration unit
US8120498B2 (en) 2007-09-24 2012-02-21 Intel-Ge Care Innovations Llc Capturing body movement related to a fixed coordinate system
US8423276B2 (en) 2008-04-29 2013-04-16 Honeywell International Inc. Systems and methods for determining entry of a navigation system into a structure
DE102009024268B4 (de) * 2009-06-05 2015-03-05 Integrated Dynamics Engineering Gmbh Magnetfeldkompensation
US20110238308A1 (en) 2010-03-26 2011-09-29 Isaac Thomas Miller Pedal navigation using leo signals and body-mounted sensors
FR2977313B1 (fr) * 2011-06-28 2013-08-09 Centre Nat Etd Spatiales Engin spatial muni d'un dispositif d'estimation d'un vecteur vitesse et procede d'estimation correspondant
US20130018582A1 (en) 2011-07-13 2013-01-17 Miller Paul A Inertial Navigation Common Azimuth Reference Determination System and Method
US9228842B2 (en) * 2012-03-25 2016-01-05 Sensor Platforms, Inc. System and method for determining a uniform external magnetic field
FI124697B (en) 2012-04-04 2014-12-15 Jc Inertial Oy Vehicle location
US8972166B2 (en) * 2012-07-17 2015-03-03 Lockheed Martin Corporation Proactive mitigation of navigational uncertainty

Also Published As

Publication number Publication date
US9857179B2 (en) 2018-01-02
EP3040680A1 (en) 2016-07-06
US20160187142A1 (en) 2016-06-30
EP3040680B1 (en) 2019-02-27
JP2016126001A (ja) 2016-07-11

Similar Documents

Publication Publication Date Title
JP6170983B2 (ja) 慣性航法システム及び慣性航法システムにおける磁気異常検出支援を提供する方法
Gade The seven ways to find heading
EP3350543B1 (en) Magnetic field gradient navigation aid
EP3158417B1 (en) Sensor fusion using inertial and image sensors
CN106500693B (zh) 一种基于自适应扩展卡尔曼滤波的ahrs算法
Shen et al. Optical flow sensor/INS/magnetometer integrated navigation system for MAV in GPS-denied environment
US20140236401A1 (en) Star Tracker Rate Estimation with Kalman Filter Enhancement
JP2013533467A (ja) 複数の電磁信号からの物体の空間的配向情報の判定
Stančić et al. The integration of strap-down INS and GPS based on adaptive error damping
JP5602070B2 (ja) 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム
CN103994766A (zh) 一种抗gps失效固定翼无人机定向方法
JP5164645B2 (ja) カルマンフィルタ処理における繰り返し演算制御方法及び装置
CN105928515A (zh) 一种无人机导航系统
CN105910623B (zh) 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法
Wang et al. Attitude determination method by fusing single antenna GPS and low cost MEMS sensors using intelligent Kalman filter algorithm
JPH095104A (ja) 移動物体の三次元姿勢角測定法および三次元姿勢角計測装置
Gallo et al. Reduction of GNSS-denied inertial navigation errors for fixed wing autonomous unmanned air vehicles
CN108151765A (zh) 一种在线实时估计补偿磁强计误差的定位测姿方法
Tomaszewski et al. Concept of AHRS algorithm designed for platform independent IMU attitude alignment
Bisgaard et al. Full state estimation for helicopter slung load system
US9217639B1 (en) North-finding using inertial navigation system
Rothmaier et al. Single GNSS antenna heading estimation
JP6841857B2 (ja) 磁気慣性グローバル測位システム
Zhang et al. An integration method of inertial navigation system and three-beam lidar for the precision landing
Amin et al. A novel vehicle stationary detection utilizing map matching and IMU sensors

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20161004

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170104

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: 20170606

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20170703

R150 Certificate of patent or registration of utility model

Ref document number: 6170983

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250