(57)【要約】  物体の空間的配向を判定するための方法であって、物体と共に配置される受信機器によって、少なくとも３つの電磁信号のセットを受信することであって、受信された信号のセットのそれぞれは、異なる位置で少なくとも３つの別個の伝送器の異なるものによって伝送されている、受信することと、受信された信号のセットのそれぞれのものに対して、信号のセットが受信された物体から伝送器への方向を部分的に画定する情報を検出することであって、検出された情報は、物体が信号のセットを受信した到来方向を物体座標系に関して完全に画定する２つの角度のうちの１つを含み、検出された情報が、２つの角度のうちの第２のものを含まない、検出することと、受信された信号セットのそれぞれのものに対して検出された情報を使用して、ナビゲーション座標系に対する、ヨー、ピッチ、およびロール角を含む、物体の空間的配向を判定することと、を含む、方法。
2013533467.tif 000002
【特許請求の範囲】
【請求項１】
物体の空間的配向を判定するための機械実装された方法であって、
前記物体と共に配置される受信機器によって、少なくとも３セットの電磁信号を受信することであって、前記受信される電磁信号のセットのそれぞれが、異なる位置で、少なくとも３つの別個の伝送器のうちの異なるものによって伝送されている、受信することと、
前記受信される電磁信号のセットのそれぞれのものに対して、前記物体から前記電磁信号のセットが受信された前記伝送する伝送器への方向を部分的に画定する、部分的な方向情報を検出することであって、前記検出された部分的な方向情報が、前記物体が物体座標系に関して前記電磁信号のセットを受信した到来方向を完全に画定する、２つの角度のうちの第１の角度を含み、前記検出された部分的な方向情報が、前記到来方向を完全に画定する前記２つの角度のうちの第２の角度を含まない、検出することと、
前記受信された電磁信号のセットのそれぞれのものに対して、前記検出された部分的な方向情報を使用して、ナビゲーション座標系に対するヨー、ピッチ、およびロール角を含む、前記物体の前記空間的配向を判定することと、を含む、方法。
【請求項２】
前記第１の角度が、前記物体座標系に対して画定される方位角平面に対する前記到来方向を画定する方位角である、請求項１に記載の方法。
【請求項３】
前記第２の角度が、前記物体座標系に対して画定される仰角平面に対する前記到来方向を画定する仰角である、請求項２に記載の方法。
【請求項４】
前記第１の角度が、前記物体座標系に対して画定される仰角平面に対する前記到来方向を画定する仰角である、請求項１に記載の方法。
【請求項５】
前記第２の角度が、前記物体座標系に対して画定される方位角平面に対する前記到来方向を画定する方位角である、請求項４に記載の方法。
【請求項６】
前記受信された電磁信号のセットのそれぞれのものに対して、部分的な方向情報の変化速度を検出することであって、前記検出される部分的な方向情報の変化速度が、前記物体がそこから前記物体座標系に関して前記電磁信号を受信する、前記到来方向を完全に画定する２つの角度のうちの第１の角度の変化速度を含む、検出することと、
前記ナビゲーション座標系に関する前記物体座標系の前記空間的配向の変化の角速度を判定することであって、前記判定することが、前記受信される電磁信号のセットのそれぞれのものに対する部分的な方向の前記検出された変化速度および前記判定された空間的配向を使用することを含む、判定することと、をさらに含む、請求項１に記載の方法。
【請求項７】
前記受信機器によって提供されるセンサデータが、前記部分的な方向情報または前記部分的な方向情報の前記変化速度のうちの１つに変換される、請求項６に記載の方法。
【請求項８】
前記受信された電磁信号のセットのそれぞれのものに対して、前記電磁信号のセットに対する前記部分的な方向情報の加速度を検出することであって、前記検出された前記部分的な方向情報の加速度が、前記物体がそこから受信する、前記到来方向を完全に画定する２つの角度のうちの第１の角度の加速度を含む、検出することと、
前記ナビゲーション座標系に関する前記物体座標系の前記空間的配向の角加速度を判定することであって、前記判定することが、前記受信された電磁信号のセットのそれぞれのものに対する前記検出された前記部分的な方向情報の加速度、および前記判定された空間的配向、ならびに前記判定された角変化速度を使用することを含む、判定することと、をさらに含む、請求項６に記載の方法。
【請求項９】
前記受信機器によって提供されるセンサデータが、前記部分的な方向情報の加速度に変換される、請求項４に記載の方法。
【請求項１０】
既知のナビゲーション座標系に関して、物体の空間的配向を判定するための機械実装された方法であって、
前記物体と共に配置される受信機器によって、少なくとも３セットの電磁信号を受信することであって、前記受信されるセットのそれぞれが、物体座標系に関して、少なくとも３つの別個の既知のナビゲーション方向のうちの異なるもので、前記物体に到来する、受信することと、
前記受信される電磁信号セットのそれぞれのものに対して、前記既知の到来方向をナビゲーション基準データセットに変換することと、
前記受信される電磁信号セットのそれぞれのものに対して、前記電磁信号のセットが受信される、前記既知のナビゲーション方向に対する物体座標系における物体方位角軸に対する方位角情報を検出することであって、前記方位角情報が、検出される仰角情報を含まない、検出することと、
前記既知のナビゲーション座標系における前記検出された方位角情報を、物体測定デ―タセットに変換することと、
ヨー、ピッチ、およびロール角を含む、前記既知のナビゲーション座標系に関する前記物体座標系の前記空間的配向を判定することと、を含む、方法。
【請求項１１】
判定することが、
前記既知のナビゲーション座標系に関する前記物体座標系の現在の姿勢の推定を表す、姿勢４元数を初期化することと、
前記ナビゲーション基準データセットおよび前記物体測定値データセットからの基準値を使用して、近似値を表す角度固有行列を確立することと、
前記基準姿勢４元数および前記角度固有行列を反復的にリファインすることと、
前記リファインした姿勢４元数を、相当するヨー、ピッチ、およびロール角に変換することと、を含む、請求項１０に記載の方法。
【請求項１２】
前記少なくとも３つの受信された電磁信号セットのそれぞれに対して、前記方位角情報の変化速度を測定することと、
前記少なくとも３つの別個の電磁信号セットのそれぞれに対して、前記方位角情報の前記変化速度を、物体測定速度行列に変換することと、
前記物体測定速度行列を使用して、既知のナビゲーション座標系に関する前記物体座標系の角速度の近似値を反復的にリファインすることと、をさらに含む、請求項１０に記載の方法。
【請求項１３】
前記反復的リファインメントが、
（ａ）前記物体座標系の角速度を初期化することと、
（ｂ）前記物体座標系の前記角速度を使用して、４元数の導関数を推定することと、
（ｃ）前記速度行列を反復的にリファインすることと、
（ｄ）前記４元数の導関数から、前記物体座標系の前記角速度を計算することと、
（ｅ）二次エラー値を計算することと、
（ｆ）前記二次エラー値を、以前の二次エラー値と比較することと、を含み、
ステップ（ｂ）から（ｆ）が、複数回の反復で繰り返される、請求項１２に記載の方法。
【請求項１４】
ステップ（ｂ）から（ｆ）が、前記二次エラー値と前記以前の二次エラー値の比較が実質的に同一になるまで繰り返される、請求項１３に記載の方法。
【請求項１５】
前記物体座標系の前記角速度は、前記物体座標系が未知または初期状態にある場合に、ゼロに初期化される、請求項１３に記載の方法。
【請求項１６】
前記物体座標系の前記角速度は、前記物体座標系が急速な回転状態にある場合に、大きな速度に初期化される、請求項１３に記載の方法。
【請求項１７】
前記物体座標系の前記初期角速度が、前記速度行列を調整するため、および姿勢の推定値または前記初期角速度に対する前記方位角情報の変化速度をリファインするために使用される、請求項１３に記載の方法。
【請求項１８】
既知のナビゲーション座標系に関する物体座標系の空間的配向を判定するためのシステムであって、
前記物体座標系と共に配置され、方向変換機を備える受信機であって、前記受信機が、前記物体座標系に関して既知のナビゲーション方向から電磁信号を受信し、発信源からの電磁信号のセットが受信される前記既知のナビゲーション方向についての部分的な方向情報を検出するように適合され、前記部分的な方向情報が、前記電磁信号が受信された、前記物体から前記発信源への方向を部分的に画定する、受信機と、
物体姿勢判定モジュールであって、
ｉ）前記物体が、そこから少なくとも３つの別個の受信された電磁信号のセットに対する前記電磁信号のセットを受信する、到来方向を完全に画定する２つの角度のうちの第１のもの対する検出された部分的な方向情報を、前記受信機から受信し、前記受信されたセットのそれぞれが、少なくとも３つの別個の既知のナビゲーション方向から到来し、前記検出された部分的な方向情報が、前記到来方向を完全に画定する２つの角度のうちの第２のものを含まないように、適合され、
ｉｉ）前記受信された電磁信号のセットのそれぞれのものに対する前記検出された部分的な方向情報を使用して、前記既知のナビゲーション座標系に関する前記物体座標系のヨー、ピッチ、およびロール角を含む、前記空間的配向を画定するように適合される、物体姿勢判定モジュールと、を含む、システム。
【請求項１９】
物体速度判定モジュールであって、
ｉ）少なくとも３つの別個の受信された電磁信号のセットに対する前記部分的な方向情報の検出された変化速度を、前記受信機から受信し、前記受信されたセットのそれぞれが、少なくとも３つの別個の既知のナビゲーション方向のうちの異なるものから到来するように適合され、
ｉｉ）前記受信された電磁信号のセットのそれぞれのものに対する前記部分的な方向情報の前記検出された変化速度を使用して、前記既知のナビゲーション座標系に関する前記物体座標系の前記空間的配向の角変化速度を判定するように適合される、物体速度判定モジュールをさらに備える、請求項１８に記載のシステム。
【請求項２０】
物体加速度判定モジュールであって、
ｉ）前記受信機から前記電磁信号のセットに対する前記部分的な方向情報の検出された加速度を受信するように適合され、
ｉｉ）前記受信された電磁信号のセットのうちのそれぞれのものに対する前記方位角情報の前記検出された加速度を使用して、前記ナビゲーション座標系に関する前記物体座標系の前記空間的配向の角加速度を判定するように適合される、物体加速度判定モジュールをさらに備える、請求項１８に記載のシステム。
【発明の詳細な説明】
【技術分野】
【０００１】
本出願は、２０１０年５月２４日に出願された、ＤＥＴＥＲＭＩＮＩＮＧ  ＳＰＡＴＩＡＬ  ＯＲＩＥＮＴＡＴＩＯＮ  ＩＮＦＯＲＭＡＴＩＯＮ  ＯＦ  Ａ  ＢＯＤＹ  ＦＲＯＭ  ＭＵＬＴＩＰＬＥ  ＥＬＥＣＴＲＯＭＡＧＮＥＴＩＣ  ＳＩＧＮＡＬＳと題される米国特許出願整理番号第１２／７８６，１３７号の優先権を主張し、その開示は、参照により本明細書に組み込まれる。
【０００２】
本明細書は、物体においてナビゲーションシステムの異なる伝送器から受信される複数の電磁信号に基づいて、物体の空間的配向情報（例えば、配向、および／または配向の変化速度）を判定すること、ならびに物体のナビゲーションにおける空間的配向情報の使用に関する。
【背景技術】
【０００３】
物体の空間的配向および／またはその変化速度を判定することは、多数の異なる適用において有用である。一例は、飛行機またはヘリコプター等の航空機体であり、航空機体の空間的配向は、現在の位置から所望の位置または所望の方向への物体のナビゲーションに使用可能である。操作中に、空間的配向情報（配向およびその変化速度を含む）は、その情報を使用して航空機体を手動で操縦することができる人物に提供され得るか、または航空機体のナビゲーションを制御する、コンピュータ制御されたナビゲーションシステムに提供され得る。物体の空間的配向が有用な別の適用は、油および天然ガス等の地下掘削のような地下適用である。このような地下適用において、視覚によって直接観察することができない地下のドリル先端の配向情報は、例えば、ドリルを目的の方向または目的の標的位置へナビゲートすることに有用であるか、または必要でさえあり得る。空間的配向情報が有用であり得るこれらの２つの一般的な適用例が例示目的であること、ならびに空間的配向情報が同様に有用であり得る、多数の他の現在および将来の適用が存在することを理解されたい。
【０００４】
航空機等の航空機体との関連において、例えば、空間的配向を判定するための従来の技術には、航空機の方向進路を判定するためのコンパス等の搭載機構、ならびに加えて、従来的に定義される姿勢のピッチ、ヨーおよびロール要素を含む、航空機の姿勢を判定する能力のある慣性ナビゲーション装置（例えば、加速度計およびジャイロスコープ）が含まれる。背景として、ピッチ角は、航空機の機首の上方向または下方向の回転を示し、ロール角は、航空機体を中心とした回転（または換言すると、翼の上方向または下方向の傾斜）を示し、ヨー角は、側面の回転（または換言すると、航空機の機首が、右または左方向に移動する）を示す、これらの従来タイプのような搭載ナビゲーションシステムはまた、航空機の姿勢の変化速度についての情報を提供することができる。多数の適用において、このような搭載ナビゲーションシステムは、全体的に十分ではあるが、多数の適用において、それらは、それら自体では、十分に正確でないか、または敏感でない場合がある。例えば、慣性ナビゲーションシステムに存在し得る１つの問題は、長時間にわたるその空間的配向の判定におけるドリフトの可能性、およびそのためにこのようなドリフトを定期的に較正または修正する必要性が生じる可能性があることである。さらに、空間的配向の変化速度は、特定の物体に対して非常に急激または急速であり得るため、このような空間的配向の判定機構は、それ自体では単純に非効率的である。
【０００５】
最近開発された、物体の空間的配向情報を判定するための別の技術は、マイクロ波の携帯電話基地局伝送または衛星伝送等、外部伝送システムから受信される電磁伝送を使用する。このような電磁伝送システムの１つの例示的分類は、全地球的航法衛星システム（ＧＮＳＳ）である。米国の全地球位置測定システム（ＧＰＳ）、ロシアの全地球航法衛星システム（ＧＬＯＮＡＳＳ）等のＧＮＳＳは、それぞれが、物体により受信され、物体によりナビゲーションに使用される、電磁伝送を行う複数の周回軌道衛星から構成される。
【０００６】
受信されたＧＮＳＳ伝送により行われる一般的で主要な使用は、物体の現在の位置を判定することである。これは、例えば航空機および自動車によって使用されているように、非常に偏在的に既知である。一般的にＧＮＳＳの操作において、物体は、少なくとも４つの異なるＧＮＳＳの衛星から伝送を受信し、それらの伝送を使用して、物体の現在位置を判定する。物体の３次元位置（経度、緯度、および高度）を判定するための１つの方法には、既知の位置に位置付けられる、衛星またはビーコンにより伝送される電磁信号を受信することが含まれる。小型電動受信機を使用して、これらの受信された電磁信号に基づいて、位置を計算することができる。ＧＮＳＳ衛星の伝送には、典型的に、その伝送が、いつ衛星によって送信されたかに関するタイムスタンプ情報が含まれており、そのため、受信する物体は、受信時刻を使用して、特定の衛星からの物体の距離を計算することができる。さらに、ＧＮＳＳ衛星の伝送にはまた、軌道ＧＮＳＳ衛星の現在の位置、より具体的には、衛星の軌道情報を示す天体暦データが、従来的に含まれる。このように、物体は、伝送が受信された衛星のそれぞれの現在の位置に関する情報が提供され、その情報に加えて、各衛星が物体から離れている距離を使用して、物体の位置を判定する。
【０００７】
位置の判定に使用することに加えて、ＧＮＳＳはまた、より最近では、物体の空間的配向情報を判定するために使用されている。これを行うために、物体には、ベクトルによって画定される、電磁伝送が受信される正確な方向を検出する能力のある、受信および方向アンテナシステムが装備されている。特に、このようなシステムにおいて方向アンテナシステムを有する受信システムは、２つの角度、すなわち方位角および仰角によって画定される、受信したＧＮＳＳ伝送に対するベクトル方向を検出するように構成される。ＧＮＳＳ伝送のそれぞれに対する正確な受信ベクトルを知ることは、空間的配向情報を、これらの物体において判定することが可能になる。具体的には、正確なベクトル方向を考慮すると、衛星から物体までの各伝送の通過時間および伝送を送信した衛星の既知の位置に加えて、処理システムが、例えば従来の定義のヨー、ピッチ、およびロール要素を含む、物体の空間的配向情報を計算することができる。難点として、しかしながら、方位角および仰角の両方を画定する能力のある受信および方向アンテナシステムは、概して、例えば、より単純な受信およびアンテナシステムと比較して、複雑であり、配向が判定される物体に空間要求を強いる。
【０００８】
特定のアンテナ構成はまた、運動または追加センサの補助なしで、物体の配向を判定する測定を行うことができる、回転センサとして使用することができる。このようなシステムは、物体上のアンテナに到来するＧＮＳＳ信号を使用して、物体の配向に対するＧＮＳＳ衛星の方向を判定する。幾何は、物体から単一の衛星への方向を、衛星と３つの物体軸との間の３つの角度を特定することによって示すことができることを暗示する。これらの角の余弦を使用して、所定の座標系の座標に現れる各衛星に対する固有の方向余弦ベクトルを特定することができる。姿勢の推定にＧＮＳＳを使用する従来のシステムは、物体座標系において作製される方向余弦ベクトルの測定を行い、これらの測定値を、ナビゲーション座標系において既知の衛星位置と比較する。このようなシステムの別の実施形態は、指定の物体ｘ軸と「オフボアサイト角」との間の角度について説明することになる。オフボアサイト角度はまた、物体ｙおよびｘ軸により画定される平面に対する衛星の「仰」角としても記載される。仰角が測定されたとして、衛星の方向余弦ベクトルは、衛星の方向が、ｘ軸を中心にどのように回転されるかを特定する、追加の「方位」角の測定によって判定することができる。従来のシステムは、ナビゲーション座標系に対する物体の配向を、少なくとも２つの衛星へのベクトルの方向（すなわち、仰角および方位角の両方）を測定し、これらの物体測定値およびナビゲーション座標系における衛星の既知の方向を使用することによって判定し、ナビゲーション座標系に対する実際の物体の回転を導く。
【発明の概要】
【課題を解決するための手段】
【０００９】
１つの一般的な態様において、外部ナビゲーションシステム伝送器からのナビゲーション伝送が受信される方向を、従来のシステムで必要とされる精度で検出することを要することなしに、物体の空間的配向情報を判定することが可能なシステム、構成要素、および方法を提供する。この一般的な態様において、本明細書に記載されるシステム、構成要素、および方法は、あまり正確ではない方向情報を使用し、依然として、適切および効率的に物体の空間的配向情報を判定することができる。そのため、本明細書に記載のシステム、構成要素、および方法は、従来のシステムにあったものよりも、複雑でなくてもよい、および／またはより少ない空間要件を必要とする、受信および方向アンテナシステムを必要とするわけではないが、その使用を可能にする。
【００１０】
一般的に、本明細書に記載の主題の１つの革新的な態様は、物体と共に配置される受信機器によって、少なくとも３セットの電磁信号を受信する動作であって、受信される電磁信号のそれぞれが、異なる位置で、少なくとも３つの別個の伝送器によって伝送されている、受信する動作と、受信される電磁信号のセットのそれぞれのものに対して、物体から電磁信号のセットが受信された伝送する伝送器への方向を部分的に画定する部分的な方向情報を検出する動作であって、検出される部分的な方向情報が、物体が物体座標系に関して電磁信号を受信した到来方向を完全に画定する２つの角度のうちの第１の角度を含み、検出される部分的な方向情報は、到来方向を完全に画定する２つの角度のうちの第２のものを含まない、検出する動作と、受信された電磁信号のセットのそれぞれのものに対して検出された部分的な方向情報を使用して、ナビゲーション座標系に対するヨー、ピッチ、およびロール角を含む、物体の空間的配向を判定する動作と、を含む、方法において、具体化することができる。この態様の他の実施形態には、本方法の機能を実行するように構成され、コンピュータ記憶デバイス上にコード化される、対応するシステム、装置、およびコンピュータプログラムが含まれる。
【００１１】
これらおよび他の実施形態は、それぞれ、以下の特徴の１つ以上を任意に含むことができる。第１の角度は、物体座標系に対して画定される、方位角平面に対する到来方向を画定する、方位角であってもよい。第２の角度は、物体座標系に対して画定される、仰角平面に対する到来方向を画定する、仰角であってもよい。さらに、第１の角度は、物体座標系に対して画定される仰角平面に対する到来方向を画定する、仰角であってもよく、第２の角度は、物体座標系に対して画定される方位角平面に対する到来方向を画定する、方位角であってもよい。
【００１２】
本方法は、受信される電磁信号のセットのそれぞれのものに対して、部分的な方向情報の変化速度を検出することであって、検出された部分的な方向情報の変化速度は、物体が物体座標系に対して電磁信号を受信した到来方向を完全に画定する２つの角度のうちの第１の角度の変化速度を含む、検出することと、ナビゲーション座標系に関して物体座標系の空間的配向の角変化速度を判定することであって、判定することは、受信される電磁信号のセットのそれぞれのものに対する部分的な方向の検出された変化速度および判定された空間的配向を使用することを含む、判定することと、をさらに含んでもよい。受信機器によって提供されるセンサデータは、部分的な方向情報のうちの１つか、または部分的な方向情報の変化速度に変換することができる。
【００１３】
本方法は、受信された電磁信号のセットのそれぞれのものに対して、電磁信号のセットに対する部分的な方向情報の加速度を検出することであって、検出された部分的な方向情報の加速度は、物体がそこから受信する到来方向を完全に画定する２つの角度のうちの第１の角度の加速度を含む、検出することと、ナビゲーション座標系に関する物体座標系の空間的配向の角加速度を判定することであって、判定することが、受信された電磁信号のセットのそれぞれのものに対する部分的な方向情報の検出された加速度、判定された空間的配向、および判定された角変化速度を使用することを含む、検出することと、をさらに含んでもよい。受信機器によって提供されるセンサデータは、部分的な方向情報の加速度に変換され得る。
【００１４】
さらなる方法には、物体と共に配置される受信機器によって、少なくとも３セットの電磁信号を受信することであって、受信されるセットのそれぞれは、物体座標系に関して、少なくとも３つの別個の既知のナビゲーション方向のうちの異なるもので、物体に到来する、受信することと、受信される電磁信号のセットのそれぞれのものに対して、既知の到来方向をナビゲーション基準データセットに変換することと、受信される電磁信号のセットのそれぞれのものに対して、電磁信号セットがそこから受信される既知のナビゲーション方向についての物体座標系における物体方位角軸に対する方位角情報を検出することであって、方位角情報が、検出される仰角情報を含まない、検出することと、既知のナビゲーション座標系における検出された方位角情報を、物体測定値データセットに変換することと、ヨー、ピッチ、およびロール角を含む、既知のナビゲーション座標系に関する物体座標系の空間的配向を判定することと、を含んでもよい。
【００１５】
これらおよび他の実施形態は、それぞれ、任意で、以下の特徴のうちの１つ以上を含むことができる。判定することは、既知のナビゲーション座標系に関して、物体座標系の現在の姿勢の推定を表す姿勢の４元数を初期化することと、ナビゲーション基準データセットおよび物体測定値データセットからの基準値を使用して、近似値を表す角度固有行列を確立することと、基準姿勢４元数および角度固有行列を反復してリファインすることと、リファインした姿勢４元数を、相当するヨー、ピッチ、およびロール角に変換することと、を含むことができる。本方法は、少なくとも３つの受信された電磁信号セットのそれぞれに対して、方位角情報の変化速度を測定することと、少なくとも３つの別個の電磁信号セットのそれぞれに対して、方位角情報の変化速度を、物体測定速度行列に変換することと、物体測定速度行列を使用して、既知のナビゲーション座標系に関する物体座標系の角速度の近似値を反復的にリファインすることと、をさらに含んでもよい。
【００１６】
反復的なリファインメントは、（ａ）物体座標系の角速度を初期化することと、（ｂ）物体座標系の角速度を使用して、４元数の導関数を推定することと、（ｃ）速度行列を反復してリファインすることと、（ｄ）４元数の導関数から、物体座標系の角速度を計算することと、（ｅ）二次エラー値を計算することと、（ｆ）二次エラー値を、以前の二次エラー値と比較することと、を含み、ステップ（ｂ）から（ｆ）は、ある反復回数で繰り返される。さらに、ステップ（ｂ）から（ｆ）は、二次エラー値と以前の二次エラー値の比較が、実質的に同一になるまで繰り返されてもよい。
【００１７】
物体座標系の角速度は、物体座標系が、未知または初期状態にある場合、ゼロに初期化され得る。物体座標系の角速度は、物体座標系が、急速な回転状態にある場合に、大きな速度に初期化され得る。物体座標系の初期角速度は、速度行列の調整、および初期角速度に対する姿勢の推定値または方位角情報の変化速度をリファインするために使用することができる。
【００１８】
本明細書に記載の主題の他の革新的な態様は、データ処理装置によって実行される際に、そのデータ処理装置に、記載の操作を実行させる命令を含む、コンピュータプログラムでコード化された、コンピュータ記憶媒体に具体化することができる。さらに、システムは、方向変換器、および記載の操作を実行するように操作可能な物体姿勢判定モジュールを含む、物体座標系に配置される受信機を含むことができる。
【００１９】
本発明の１つ以上の実施形態の詳細は、添付の図および以下の説明に記載される。本発明の他の特徴、目的、および利点は、説明および図面、ならびに特許請求の範囲から明らかであろう。
【図面の簡単な説明】
【００２０】
【図１Ａ】図１Ａは、衛星ナビゲーションシステムおよび物体の空間的配向情報を判定するために衛星ナビゲーションシステムからの伝送を受信する物体に搭載して使用するための例示的システムの図である。
【図１Ｂ】図１Ｂは、物体の空間的配向情報の判定のための例示的プロセスのフローチャートである。
【図２】図２は、衛星ナビゲーションシステムおよび移動体（航空機）の図であり、種々の画定されるベクトルおよび角度を図示する。
【図３Ａ】図３Ａは、移動体（ヘリコプター）および衛星ナビゲーションシステムの衛星の図であり、物体から衛星へのベクトルを画定する角を図示する。
【図３Ｂ】図３Ｂは、衛星の図および方位角情報を検出するように操作可能な例示的なアンテナである。
【図４】図４は、物体の空間的配向情報を判定するための例示的プロセスのフローチャートである。
【図５】図５は、４元数を使用して、方位角情報から物体の空間的配向情報を判定するための例示的プロセスのフローチャートである。
【図６】図６は、４元数を使用して、方位角の速度情報から物体の角速度を判定するための例示的プロセスのフローチャートである。
【図７Ａ】図７Ａは、空間的配向の推定値を使用して、遠隔システムにフィードバックを提供するための例示的プロセスのフローチャートである。
【図７Ｂ】図７Ｂは、空間的配向の推定値を使用して、物体の軌道を調整するための例示的プロセスのフローチャートである。
【図７Ｃ】図７Ｃは、空間的配向の推定値を使用して、車両のパイロットに視覚的フィードバックを提供するための例示的プロセスのフローチャートである。
【図８】図８は、本明細書に記載のコンピュータ実装されたプロセスの実装に使用可能なコンピュータ構成要素のブロック図である。
【発明を実施するための形態】
【００２１】
種々の図面中の同様の参照記号は、同様の要素を示す。
【００２２】
図１Ａは、例えば、複数の衛星から構成されるＧＰＳシステム等のナビゲーションシステムから受信される、ナビゲーション伝送に基づいて、位置および空間的配向、または姿勢、物体の情報を判定するために、移動体に装備することができる、姿勢情報判定システム１００の例である。簡略的には、本システム１００は、電磁ビーコン（例えば、衛星）のセット１０６から、方向変換器１０４を通じて電磁信号を受信し、受信した信号から種々の入力データを判定する能力のある受信機１０２を含む。図示されるように、方向変換器１０４は、円形アレイアンテナである。他の実装において、回転可能なアンテナ、ビーム形成アレイ、光学デバイス、または同様の方向センサを、方向変換器として使用することができる。受信機１０２は、６自由度（６ＤＯＦ）の物体状態推定器１０８に入力データを提供し、そのデータを使用して、既知のナビゲーション座標系に関して、少なくとも６ＤＯＦの物体の測定値を判定する。６ＤＯＦ測定値は、姿勢（ヨー、ピッチ、およびロール）についての３つの測定値、ならびに姿勢の変化速度（ヨー、ピッチ、およびロールのそれぞれの変化速度）についての３つの測定値を指す。６ＤＯＦ姿勢情報測定値は、次いで、６ＤＯＦデータリポジトリ１１０に出力することができる。６ＤＯＦ姿勢情報測定値は、いくつかの実施例において、受信機１０２がその機能を果たすことを補助するか、あるいは物体の経路を追跡するか、または進路のナビゲーション調整を行い、および／もしくは物体の経路内のナビゲーションエラーを修正するために使用することができる。受信機１０２は、物体の位置１１４およびビーコン１０６のそれぞれの位置を判定する能力のある、３ＤＯＦ位置判定要素１１２を含み、後者は、ビーコン位置１１６のセットとして収集される。３ＤＯＦ位置判定ユニット１１２の３自由度とは、基準ナビゲーション座標系内の配置点（物体および各ビーコンについて）の定義を指す。これらの３次元は、公的ナビゲーション座標系とも称される、地球中心地球固定（ＥＣＥＦ）座標系におけるｘ、ｙ、およびｚ座標として記載することができる。ＥＣＥＦ座標系は、地球に固定され、その回転は地球中心を中心としている。このようにして、ｚ軸は、地球の自転方向と平行して整列し、ｘ軸は、赤道面とグリニッジ子午線との交点方向を指し、ｙ軸は、ｘ、ｙ、およびｚが右手系座標を作る方向で、地球表面に垂直である。
【００２３】
他の実装において、これらの３次元は、東、北、および上に対応する、ｘ、ｙ、およびｚ座標として記載することができる。例えば、地球の表面においては、東−北−上の基準座標系が、より便利な場合があり、一方で空中または宇宙においては、ＥＣＥＦ座標系が、より適切であることがわかり得る。
【００２４】
この実施例における３自由度は、緯度、経度、および高度の尺度であってもよい。いくつかの実装において、ビーコン１０６のそれぞれは、電磁信号コンテンツ内で、その位置情報を伝送することができ、その位置情報は、３ＤＯＦ位置決定ユニット１１２によって単純に受信することができる。他の実装において、３ＤＯＦ位置決定ユニット１１２は、ビーコン位置１１６のそれぞれを、ビーコンが任意の時点で配置される、基準のナビゲーション座標系内の配置をそこから判定することができる、軌道経路情報を含み得る、電磁信号内に提供される特徴および記憶された既知のビーコン配置のセットを識別することに基づいて、導くことができる。後者の場合において、伝送内に提供されるタイムスタンプ情報を使用して、システム１００に提供される軌道経路情報から、ビーコン配置を判定することができる。位置情報に加えて、いくつかの実装において、物体位置１１４およびビーコン位置１１６は、速度情報およびタイムスタンプ情報もまた含むことができる。速度情報は、例えば、受信機１０２によって（例えば、ドップラー技術を使用して）判定される、方向変換器１０４の位置の変化速度を含むことができる。
【００２５】
物体位置１１４およびビーコン位置１１６を使用して、ビーコン１０６のそれぞれからの電磁信号の物体における到来方向、または換言すると、（ビーコンから物体への伝送が見通し線伝送である場合については）物体からビーコン１０６のそれぞれへのベクトルを判定することができる。物体からビーコンのそれぞれのものへのこれらのベクトルは、物体を中心としたローカルナビゲーション座標系に画定することができる。物体のローカルナビゲーション座標系を画定するためには、ＥＣＥＦ座標系を、（例えば、物体位置１１４で）例えば物体の中心への回転なしに変換して、物体位置１１４にローカルナビゲ―ション座標系を作製することができる。ローカルナビゲーション座標系は、実際の物体配向（姿勢）情報が画定され得る基準姿勢として機能することができる。
【００２６】
受信機１０２はまた、方位角および任意で複数のビーコン１０６のそれぞれへの検出された方向の方位角変化速度を含む、方位角測定値１２０のセットを判定する、１自由度（１ＤＯＦ）方向決定構成要素１１８を含む。方位角測定値１２０は、物体座標系に画定される単一の変換器１０４の軸を中心とする角変位に基づいてもよい。物体座標系という用語は、本明細書に使用される際、姿勢情報が判定される、物体の構造に関して画定される、座標系または基準系を指し、したがって、物体座標系は、物体が移動すると移動し、したがって、ナビゲーション座標系に対して移動する。例示として、飛行機の物体座標系は、Ｘ−Ｙ−Ｚ座標系として定義することができ、３つの軸は飛行機の中心で交差し、ｘ軸は、機首および機体の中心を通じて延在し、ｙ軸は、飛行機の上部および下部を通じてｘ軸に垂直に延在し、ｚ軸は、１つの翼からもう１つの翼へ、ｘ軸およびｙ軸に垂直に延在する。
【００２７】
本明細書に使用する際、物体座標系の座標は、ｘ軸が、方向アンテナシステムがそこを中心に回転され得る軸となるように配向され、方位角は、ｙ−ｚ平面で測定される。これは、単純に、数学的表記の整合性のための慣例である。
【００２８】
方位角測定１２０を判定する際、ビーコン１０６から受信される電磁信号が到来するベクトル方向は、それぞれ、変換器１０４の軸に垂直である、物体座標系の水平面で、方向変換器１０４によって射影することができる。方位角測定１２０は、次いで、物体座標系の方位角平面に射影されたベクトルの変位に関する。方向変換器１０４からの各ビーコンの方位角方向は、例えば、方向変換器１０４が、単一の軸を中心に回転する際、ビーコン１０６のそれぞれに対するピーク信号振幅に基づいて測定することができる。いくつかの実装において、方向決定モジュール１１８は、マルチパス信号到来を分解して、最終的な方位角測定１２０を生成することができる。他の実装において、方向変換器１０４からの電子信号が、角速度情報を含む場合、方向決定ユニット１１８は、さらに、方位角測定１２０内に含まれる、方位角の測定変化速度を計算することができる。
【００２９】
６ＤＯＦ物体状態推定器１０８は、角度測定１２０、ビーコン位置１１６、および物体位置１１４を受信機１０２から受信し、この情報を使用して、物体の空間的配向または姿勢（例えば、ヨー、ピッチ、およびロール角）、ならびに任意で、物体の空間的配向の変化の角速度（再度、例えばヨー、ピッチ、およびロール角の変化速度）を計算することができる。これらの６つの要素の姿勢情報は、ナビゲーション座標系、例えばＥＣＥＦに関して画定することができ、リポジトリ１１０に記憶することができる。ヨー、ピッチ、およびロール角の３ＤＯＦ空間的配向尺度はまた、オイラー角と称される。オイラー角は、ローカルナビゲーション座標を回転させ、回転された座標系を物体座標系と一直線になるようにするために使用することができる、回転のセットを画定する。
【００３０】
幾何学のため、ナビゲーション座標系のｘ軸は、間隔を空けて２回の回転を適用することによって、物体座標のｘ軸の実際の方向に回転することができる。まず、ナビゲーションｘ軸を、元のナビゲーション座標系のｚ軸を中心に、ヨー角を通じて、物体座標系のｘ軸方向に回転させることができる。次いで、新しいｘ軸を、新しいｙ軸を中心に、ピッチ角を通じて回転させることができる。新しいｘ軸は、物体座標系のｘ軸と揃った方向を指すことになる。この時点で、ロール角を使用して、新しい座標系を、合致する物体ｘ軸を中心にして、新しいｙ軸およびｚ軸が、対応する物体座標系のｙ軸およびｚ軸に平行な方向を指すまで、回転させてもよい。いくつかの実施例において、方向余弦行列（ＤＣＭ）等の３×３の回転行列、または単一の４元ベクトルの４元数を使用して、空間的配向問題を数学的にモデル化することができる。
【００３１】
６ＤＯＦ物体状態推定器１０８は、例えば、検出された方位角の余弦を使用して、角度測定１２０を物体測定データセットに変換することによって、物体の３ＤＯＦ配向の判定を開始することができる。６ＤＯＦ物体状態推定器１０８はまた、例えば、物体位置からビーコン位置への見通し線を使用して、ビーコン位置１１６および物体位置１１４をナビゲーションデータセットに変換する。配向の解を求める際、空間的配向の推定値を改善するために他のリファインメントが適用されてもよい。例えば、方位角速度または加速度の測定が方位角測定１２０内に含まれる場合に、任意で、追加の計算が、同様に角速度または角加速度を求めるために行われてもよい。
【００３２】
６ＤＯＦ物体状態推定器１０８が、空間的配向推定値および角速度推定値を、姿勢および速度測定のセット１２２として計算すると、姿勢および速度測定のセット１２２は、（例えば、物体の位置測定１１４に基づいて）物体の位置および速度測定のセット１２４と共に、６ＤＯＦレポジトリ１１０に提供され得る。
【００３３】
物体が、その経路に沿って継続する際（例えば、飛行中のヘリコプター、標的に向かうミサイル、路上のトラック、または地球表面下のドリル）、システム１００はビーコン１０６からの情報を収集し続け、物体の位置、配向、および速度の変化を推定し続けることができる。いくつかの実装において、以前に計算された推定値を使用して、後続の計算の計算を速めるか、または後続の計算によって得られる推定値を改善させることができる。例えば、６ＤＯＦナビゲーション状態１１０を、受信機１０２に返して、例えば、ビーム進行またはマルチパス分解等の信号処理機能を補助することができる。
【００３４】
いくつかの実装において、６ＤＯＦリポジトリ１１０は、物体から離れて配置されてもよい。例えば、無線通信技術を使用して、姿勢および速度測定１２２および物体の位置および配置測定１２４を、それらが監視または遠隔誘導に使用され得る遠隔部に提供することができる。測定値は、いくつかの実装において、ローカルの６ＤＯＦリポジトリ１１０内に収集され、定期的に、バッチで遠隔システムに伝送され得る。いくつかの実装において、６ＤＯＦ物体状態推定器１０８はまた、配向情報が判定されている物体から離れていてもよい。
【００３５】
測定値の収集に加えて、姿勢および速度測定値１２２、ならびに物体の位置および速度測定値１２４を使用して、いくつかの実施例において、物体の現在の進路に修正を行うか、または手動調整を行うために、操作者（例えば、飛行機、ヘリコプター、ドリル等）に、物体の配向の図表示を提供することができる。
【００３６】
いくつかの実装において、方位角測定値１２０を収集することよりも、方位決定モジュール１１８は、オフボアサイト角測定を行うか、またはそうでなければ方位角ではなく仰角のみを測定する可能性がある。仰角は、方位角の必然的帰結と見なされ得る（例えば、同様の角度であるが、ナビゲーション座標系内の異なる視点から見られる）。仰角とボアサイト角との和が、９０度であるため、仰角は、オフボアサイト角の測定値から、容易に導くことができる。６ＤＯＦ物体状態推定器１０８によって使用されるコンピュータによる方法は、方位角の測定値よりも、オフボアサイト角または仰角の測定値を受容するように、適宜調整することができる。
【００３７】
図１Ｂは、物体の空間的配向の判定および使用のための例示的プロセス１５０のフローチャートである。本プロセス１５０は、部分的に、図１Ａに示されるシステムによって実行することができる。プロセス１５０は、ナビゲーションシステムの少なくとも３つの異なる電磁ビーコンからのナビゲーション信号、例えば、図１Ａに示される衛星１０６からの信号を、受信することで開始する（１５２）。ナビゲーション信号は、電磁ビーコンの識別（異なる衛星から受信される異なる信号を区別するため）、またはナビゲーション座標系内での電磁ビーコンの位置、ならびに同期タイミングシステムに基づいて、伝送が生じる時間に関するタイムスタンプを含むことができる。
【００３８】
物体から伝送ビーコンへの部分的な方向情報は、複数の受信されたビーコンのそれぞれに対して検出される。部分的な方向情報は、方位角情報を含み得るが、仰角情報は含まない（１５４）。あるいは、例えば、部分的な方向情報は、仰角情報を含み得るが、方位角情報は含まない。部分的な方向情報は、例えば、図１Ａの方向決定要素１１８によって検出され得る。部分的な方向情報は、方向変換器および受信機システムを使用して判定することができる。いくつかの実装において、方向変換器は、物理的に回転するアンテナもしくはアンテナアレイ、または電気的に回転されるアンテナアレイであってもよい。いくつかの実施例において、アンテナ要素のアレイは、アレイの要素のそれぞれにおいて、励磁電流の位相を変化させ、その際に、アレイの受信感度の方向を「回転」させることによってか、または特定の位相シフトを励磁電流に適用し、各アンテナ要素に励磁電流を適用し、交代でアンテナアレイの方向性を回転させることによって、電気的に回転することができる。方向変換器は、例えば、厳密に仰角情報を検出するためには、単純または安価過ぎる可能性がある。
【００３９】
次に、物体の位置を計算する（１５６）。これは、例えば、図１Ａの受信機によって行うことができる。例えば、伝送に提供される情報から判定される、電磁ビーコンの発信源の既知の位置を使用して、電磁ビーコンまでの距離を、同期タイミング機構を使用して判定される、電磁ビーコンにより提供されるタイムスタンプ情報、および受信時間情報を使用して計算することができる。３つ以上の電磁ビーコンと物体との間の距離を使用して、ナビゲーション座標系内の物体の位置を計算することができる。例えば、物体の緯度、経度、および高度を計算する能力は、標準的なＧＰＳ受信機によって提供することができる。
【００４０】
物体の空間的配向を、次に計算する（１５８）。これは、例えば、図１Ａの物体状態推定機１０８によって行うことができる。検出された部分的な方向情報、計算された物体の位置、および判定された電磁ビーコンの位置を使用して、物体の空間的配向を計算することができる。空間的配向を得るための例示的な計算の詳細は、本明細書の後半で詳細に記載される。
【００４１】
物体の空間的配向の変化速度を計算する（１６０）。空間的配向の計算値および検出された方位角情報（または代替として、仰角情報）の変化速度に基づいて、空間的配向の変化速度を計算することができる。どのようにしてこれを計算することができるかについての詳細は、本明細書の後半に詳細に記載される。この変化速度情報は、後で使用するために、例えば、図１Ａのリポジトリ１１０に記憶することができる。
【００４２】
次に、計算された情報を使用して、物体の移動を制御する（１６２）。位置、空間的配向、空間的配向の変化速度の計算値を使用して、物体の進路を能動的に修正するか、または物体の進路を制御する操作者にフィードバックを提供することができる。物体の制御は、例えば、図１Ａのリポジトリに記憶された情報を使用して行うことができる。例えば、この記憶された情報は、搭載型コンピュータ制御ナビゲーションシステムへの入力として機能することができ、および／または使用者への視覚的表示を生成するために使用することができる。
【００４３】
従来的には、運動センサ（例えば、加速度計）および／または回転センサ（例えば、ジャイロスコープ）等の慣性センサは、物体の配向、ならびに任意で物体の速度（例えば、運動の方向および速度）を判定するために採用されている。多数のナビゲーションシステムは、ＧＰＳ、ならびにジャイロスコープまたは加速度計等の慣性センサを採用して、物体の６自由度（６ＤＯＦ）を判定する。これらのシステムは、総合ＧＰＳ／慣性（ＧＰＳＩ）システムと称されることがある。ＧＰＳの読み取りを使用して、慣性航法システム（ＩＮＳ）によって提供される読み取りを修正および較正することができる。例えば、ＧＰＳ計算を使用して、慣性センサ内のドリフトのために生じるナビゲーションエラーを抑制することができる。計算された空間的配向および空間配向の変化速度は、いくつかの実装において、慣性センサのナビゲーションエラーを抑制するために、システムに返すことができる。
【００４４】
図３Ａは、ヘリコプター３０２および衛星３０４の例示的な図であり、例示的な物体座標系３１２を説明するために使用する。図３Ａはまた、ローカルナビゲーション座標系を図示し、ヨー、ピッチ、およびロール角は、図３Ａに描写されるように全てゼロであると仮定して、ローカルナビゲーション座標系は、物体座標系３１２と同一である。図３Ａはまた、物体（ヘリコプター３０２）から衛星へのベクトル３０６を図示し、衛星３０４からの見通し線伝送が物体において受信される方向、およびローカルナビゲーション座標系３１２に関して方向ベクトル３０６を画定する角度を示す。
【００４５】
この説明図におけるヘリコプターの物体座標系（およびローカルナビゲーション座標系）は、前述の航空機体座標系例の実施例と同様であり、ヘリコプターの進行方向に向かって平行であるｚ軸３１２ｃ、ヘリコプターの中心を通って上下に延在し、ｚ軸３１２ｃに垂直であるｘ軸３１２ａ、ヘリコプターの中心を通って横から横へ延在し、ｘ軸３１２ａおよびｚ軸３１２ｃの両方に垂直であるｙ軸を含む。３つの軸が交差する物体の中心点３１２ｄは、回転翼の中心である。
【００４６】
物体座標系の中心３１２ｄから衛星３０４へのベクトル３０６は、異なる方法で、ローカルナビゲーション座標系に関して画定されてもよい。例えば、ベクトル「ｒ」３０６は、ローカルナビゲーション座標系において、以下の等式で記載することができ、
ｒ＝［ｒｘ，ｒｙ，ｒｚ］
【００４７】
ビーコン３０４とヘリコプター３０２との位置間の見通し線の差異として計算することができる値は、例えば、ヘリコプター３０２内のＧＰＳ受信機によって得られる。代わりに、ベクトル３０５を、物体座標系３１２（ローカルナビゲーション座標系と姿勢が揃っていない可能性がある）に関して考える場合、衛星３０４の座標は、物体座標系に対して、以下の等式を使用して記載することができる。
ｒｂ＝［ｒｂｘ，ｒｂｙ，ｒｂｚ］
【００４８】
物体の空間的配向を判定することには、ｒに対する座標と、ｒｂの座標との間の変換の解を求めることが含まれる。先行技術において、衛星３０４に関して、物体座標系３１２におけるベクトル測定値である定量ｒｂを測定することができる、専用センサ（例えば、２ＤＯＦ方向アンテナ）がヘリコプター３０２に追加される場合がある。変換は、次いで、２つの異なる衛星に対するベクトル測定値を使用して判定され得る。
【００４９】
先行技術において、ヘリコプター３０２から衛星３０４へのベクトルは、アンテナシステムが、３つの角度を検出する能力があるタイプのものであったと仮定して、３つの角度、すなわち３つの軸（ｘ、ｙ、およびｚ）のそれぞれにつき１つの角度を使用して、断定的に記載される場合があった。一実施例において、ベクトル３０６は、単位ベクトルであると考える。図３Ａに示されるように、単位ベクトルｒｂ３０６に対して、ヘリコプター３０２の物体座標系３１２から、衛星３０４へ向かうベクトル方向は、３つの方向余弦角度に等しい。ヘリコプター３０２の物体座標系のｘ軸３１２ａと衛星３０４との間の第１の「ボアサイト」角ｇａｍｍａ＿ｘ３０８、および物体座標系のｚ軸３１２ｃと衛星３０４との間の第２の「ボアサイト」角ｇａｍｍａ＿ｚ３１０が存在する。第３の方向余弦角度ｇａｍｍａ＿ｙ角は、物体座標系のｙ軸３１２ｂに関して取られるボアサイト角であり、その角度は、図３Ａの視点のため図示されていない。
【００５０】
ボアサイト角ｇａｍｍａ＿ｘ３０８で開始し、以下の等式を使用して、物体座標系ｘ軸３１２ａとのその関係を記述することができる。
ｒｂｘ＝ｃｏｓ（ｇａｍｍａ＿ｘ）
【００５１】
ｇａｍｍａ＿ｘが、ゼロに等しい場合、物体座標系のｘ軸３１２ａは、真直ぐに衛星３０４を指す。そうでなければ、衛星３０４は、軸から外れている。
【００５２】
第２の角度は、前述のように、その角度が、物体座標系のｙ軸３１２ｂまたは物体座標系のｚ軸３１２ｃに関して測定されるかに応じて、ｇａｍｍａ＿ｙまたはｇａｍｍａ＿ｚ３１０であり得る。これらの選択肢は、方向余弦としても既知の、以下の等式を使用して記述することができる。
ｒｂｙ＝ｃｏｓ（ｇａｍｍａ＿ｙ）
ｒｂｚ＝ｃｏｓ（ｇａｍｍａ＿ｚ）
【００５３】
３つの方向余弦を測定することに相当する、物体からビーコンへの方向ベクトル３０６を完全に画定する方法は、物体座標系の軸３１２ａ、３１２ｂ、または３１２ｃのうち、任意に指定されたものに対する「仰角」の角度および「方位角」の角度の両方を測定することである。物体座標系のｘ軸３１２ａ等、任意のゼロではないベクトルは、物体座標系のｘ軸３１２ａに垂直である物体座標系３１２の中心からの全ベクトルから構成される、固有の「法線」２次元（２Ｄ）平面を決定することができる。具体的には、物体座標系のｙ軸３１２ｂおよび物体座標系のｚ軸３１２ｃは、水平の法平面に含まれる。物体座標系３１２を使用して、ベクトルｒｂ３０６等、任意の３元ベクトルが、物体座標系のｘ軸３１２ａの方向ではない空間にあると考えると、ベクトル３０６と２Ｄの水平法平面との間に「仰角」の角度が存在する。
【００５４】
図３Ａにおいて、衛星３０４に対する仰角は、図の２Ｄ射影がｚ軸３１２ｃのすぐ上にベクトル３０６を示しているため、「ボアサイト」角ｇａｍｍａ＿ｚ３１０と同一であることがわかる。より一般的には、異なる透視図においては、ベクトル３０６が、ｚ軸３１２ｃから離れて、ｘ軸３１２ａを中心に「方位角」角度を通って回転し、ボアサイト角ｇａｍｍａ＿ｚ３１０が、水平面上で仰角よりも大きくなることをもたらす場合がある。
【００５５】
ヘリコプター３０２は、ヘリコプターの回転翼上に配設される、アンテナ３１４ａ、３１４ｂ、および３１４ｃのアレイを有する。アンテナアレイは、ナビゲーションシステムの複数の衛星のうちの１つであろう衛星３０４（他のものは図３Ａには示されない）を含む、衛星ナビゲーションシステムからの伝送を受信する。アンテナアレイの構成要素は、図３Ａに示されるものよりも多いかまたは少なくてもよく、例えば、アンテナアレイ構成要素の数は、回転翼の数に直接対応していてもよい。アンテナは、回転翼が回転すると回転し、したがって、アンテナアレイは、方向アンテナの能力を有する。
【００５６】
図３Ｂに示されるように、物体座標系３５６を有する円筒形のアンテナアレイ３５２は、伝送ベクトル３５８に沿って、電磁ビーコン３５４からの伝送を受信する。伝送ベクトル３５８は、物体座標系のｚ軸３５６ａからの伝送ベクトル３５８のオフセットに関する方位角３６０、ならびに伝送ベクトル３５８とｚ軸３５６ａおよびｙ軸３５６ｃを含む平面との間の角度に関する仰角３６２によって画定することができる。
【００５７】
図３Ａに戻り、ベクトル３０６は、したがって、３つの方向余弦角度、または方位角および仰角のいずれかによって、同等に画定することができる。方位角を判定するための垂直のｘ軸３１２ａの選択は、ヘリコプターの回転翼上のアンテナアレイ要素３１４ａ、３１４ｂ、３１４ｃの水平構造によって動かされる。回転翼が回転しているとき、例えば、アンテナアレイ３１４ａ〜ｃの物理的な回転は、ビーコン３０４からの電磁信号を変調し、ｘ軸３１２ａに対する方位角の測定を補助する。
【００５８】
ベクトル方向の正確な測定値を得るために専用センサを使用する代わりに、物体配向の低費用な推定は、例えば、スカラー方位角測定値のみを使用することによって、仰角または方向余弦のいずれの測定も要することなく、部分的な方向情報を使用して行うことができる。図２に示されるように、例示図２００は、物体の周囲に配設される複数のビーコンの方位角変位を図示する。地球表面付近の飛行機２０２は、地球の周囲を回る、３つの衛星２０４ａ、２０４ｂ、および２０４ｃのセットと通信している。飛行機２０２の配向は、飛行機２０２の物体座標系２０６ａ〜ｃに関して記述することができる。衛星２０４のそれぞれの方向は、一般論として、物体座標系２０６の中心から、各衛星２０４ａ、２０４ｂ、または２０４ｃへのベクトル測定２０８ａ、２０８ｂ、および２０８ｃのセットを使用して記述することができる。しかしながら、物体座標系２０６の配向は、単純に、方位角２１０ａ、２１０ｂ、２１０ｃの測定によって判定することができる。図２において、方位角は、ｙ軸２０６ｃを方位角ゼロの基準として使用して、ｘ軸２０６ａに沿って測定される。方位角２１０ａ、２１０ｂ、２１０ｃは、以下のように画定することができる。
【００５９】
物体座標系のｘ軸２０６ａ等の任意のベクトルが、物体座標系ｘ軸２０６ａに垂直である物体座標系２０２の中心からの全ベクトルから構成される固有の「法線」２次元（２Ｄ）平面２１２を画定する。換言すると、物体座標系のｙ軸２０６ｃおよび物体座標系のｚ軸２０６ｂは、水平法平面２１２に含まれる。物体座標系２０６を使用して、ベクトルｒｂ２０８ａ等、任意の３元ベクトルが、物体座標系のｘ軸２０６ａの方向ではない空間にあると考えると、物体座標系のｘ軸２０６ａおよびベクトルｒｂ２０８ａの両方を含む、別の固有の２Ｄ平面（図２には示されない）が存在する。この新しい平面は、物体座標系のｘ軸２０６ａに平行であり、法平面２１２と直線で交差する。したがって、法平面２１２の線と、物体座標系のｘ軸２０６ａに平行な平面との間の対応を確立する。
【００６０】
物体座標系のｘ軸２０６ａの射影演算子と称される、３×３行列Ｐが存在し、任意のベクトルｒｂを、物体座標系のｘ軸２０６ａに対する法平面２１２に位置する射影ベクトルＰ＊ｒｂに射影する。定義上、
ｒｂ＝［ｒｂｘ，ｒｂｙ，ｒｂｚ］
【００６１】
さらに、結果として以下となる。
Ｐ＊ｒｂ＝［０，ｒｂｙ，ｒｂｚ］
【００６２】
ｒｂは、単位ベクトルであると仮定され、さらに、前に判定されたように、ｒｂｘがｃｏｓ（ｇａｍｍａ＿ｘ）に等しいと考えられるため、結果として、射影ベクトルＰ＊ｒｂの長さは、ｓｉｎ（ｇａｍｍａ＿ｘ）に等しい。
【００６３】
射影ベクトルＰ＊ｒｂは、物体座標系のｙ軸２０６ｃおよび物体座標系のｚ軸２０６ｂそれぞれに関して、方位角変位角度ｍｕ＿ｙ２１０およびｍｕ＿ｚ（図示されない）を使用して記述することができる。これらの角度は、法平面２１２における角度が、３元空間における角度と同一ではないため、ボアサイト角ｇａｍｍａ＿ｙまたはボアサイト角ｇａｍｍａ＿ｚ３１０（図３Ａに関連して記載される）と同一ではないことに留意されたい。
【００６４】
物体座標系のｙ軸２０６ｃおよび物体座標系のｚ軸２０６ｂは、垂直であるため、ｍｕ＿ｙ２１０が既知となると、角度ｍｕ＿ｙ２１０およびｍｕ＿ｚは、９０度で異なるため、ｍｕ＿ｚを容易に導くことができる。このようにして、方位角ｍｕ＿ｙ２１０と称され、物体座標系のｙ軸２０６ｃに関する射影ベクトルＰ＊ｒｂの角度として本明細書に記載される、各ビーコンに対する単一の角度を測定することに焦点を置くことができる。
【００６５】
図２に戻り、第１の方位角２１０ａは、物体座標系２０６の中心から第１のビーコン２０４ａに延在する、単位ベクトル「ｒ」２０８ａから射影されるベクトルの位置を示す。同様に、第２の方位角２１０ｂは、物体座標系２０６の中心から第２のビーコン２０４ｂに延在する単位ベクトル「ｒ」２０８ｂから射影されるベクトルの位置を示し、第３の方位角２１０ｃは、物体座標系２０６の中心から第３のビーコン２０４ｃに延在する単位ベクトル「ｒ」２０８ｃから射影されるベクトルの位置を示す。
【００６６】
実施においては、方位角そのものよりも、方位角ｍｕ＿ｙ２１０およびｍｕ＿ｚ（図示されない）の余弦を測定することが便利な場合がある。方位角ｍｕ＿ｙ２１０およびｍｕ＿ｚの余弦は、以下の等式によって表すことができる。
ｍｖ＝ｃｏｓ（ｍｕ＿ｙ）
ｍｗ＝ｃｏｓ（ｍｕ＿ｚ）
【００６７】
３元空間において、ｘ軸２０６ａに関するボアサイト角ｇａｍｍａ＿ｘ（図示されない）は、以下の等式を使用して表すことができる。
ｓｇｘ＝ｓｉｎ（ｇａｍｍａ＿ｘ）
ｃｇｘ＝ｃｏｓ（ｇａｍｍａ＿ｘ）
【００６８】
上述の等式を使用して、単位ベクトル（物体座標系からビーコンに延在する）および射影ベクトル（法平面２１２に関して物体座標系からのビーコンの方向を示す）に関して、以下を導くことができる。
Ｐ＊ｒｂ＝ｓｇｘ＊［０，ｍｖ，ｍｗ］
ｒｂ＝［ｃｇｘ，ｓｇｘ＊ｍｖ，ｓｇｘ＊ｍｗ］
【００６９】
これらの等式を使用して、例えば、ボアサイト角ｇａｍｍａ＿ｘが測定されていなかったとしても、方位角の測定値に基づいて、物体配向を判定するためのアルゴリズムを構築することができる。方位角測定値自体は、いくつかの実施例において、専用センサ（例えば、図１に関して記載される、受信機１０２の方向決定モジュール１１８に含まれる）を使用して判定することができる。各ビーコンと物体座標系との間の方位角を測定することに加えて、いくつかの実装において、さらに、センサ（１つまたは複数）は、方位角速度としても称される、各方位角の導関数を判定することができる。
【００７０】
方位角測定値を判定する際、回転可能なアンテナ等の方向変換器を使用して、法平面に関するビーコンの仰角に関係なく、物体位置からの各ビーコンの方位角を判定することができる。図３Ａに示されるように、いくつかの実装において、１つ以上のアンテナを、ヘリコプターの回転翼上に載置することができ、翼の回転が、アンテナ（１つまたは複数）での方向決定を達成するために必要な回転を提供する。他の実装において、電気的に回転されるアンテナアレイを使用して、方位角測定値を判定することができる。例えば、図３Ｂに示されるように、複数のアンテナ要素３６６を、円筒形のアンテナアレイ３５２の径の周囲に載置することができる。アンテナ要素の電気位相は、方位角に敏感な方向ビームを作製するように、調整することができる。電気位相を変更することにより、円筒形アンテナアレイ３５２の方向ビームの、その物体座標系のｘ軸３５６ｂを中心とした回転３６４をもたらすことができる。円筒形のアンテナアレイ設計は、方位角ｍｕ＿ｙ３６０を仰角３６２よりも正確に測定することができる。仰角３６２を使用することなく、方位角ｍｕ＿ｙ３６０は、ビーコン３５４への方向３５８についての必要な部分的情報を提供する。方位角ｍｕ＿ｙ３６０の測定に加えて、いくつかの実装において、アンテナアレイ３５２はまた、物体が回転するか、またはビーコン３５４が移動する際、方位角ｍｕ＿ｙ３６０の変化速度を測定することができる。
【００７１】
図４は、物体の空間的配向情報を判定するための例示的プロセス４００のフローチャートである。簡略的には、プロセス４００は、方位角情報、および任意で、それぞれがナビゲーションシステムの複数のビーコンのうちの異なるものから発生する３つ以上の電磁信号セットに関連する方位角情報の変化速度を検出する。検出された方位角情報に基づいて、さらに仰角情報の検出を必要とすることなく、物体の空間的配向を推定することが可能である。さらに、検出された方位角情報の変化速度を使用して、物体の角速度をさらに推定することができる。プロセス４００は、いくつかの実施例において、図１に関連して記載される、受信機１０２および６ＤＯＦ物体状態推定機１０８によって実行することができる。
【００７２】
プロセス４００は、それぞれがナビゲーションシステムの複数のビーコンの異なるものからの電磁信号のセットを受信することで開始する（４０２）。物体の通信領域にある３つ以上のビーコンは、例えば、ナビゲーション方向または各ビーコンの既知の位置を決定するために変換され得る電磁信号セットと通信し、ビーコンは、互いに対して異なる位置にある（例えば、物体に関連する単一の線内にない）。
【００７３】
電磁信号セットは、回転可能なアンテナ等の方向変換器によって受信することができる。第１の実施例において、回転可能なアンテナは、回転物体（例えば、ミサイル、または他の発射体）内に位置付けられる１つ以上のアンテナ、例えば、回転物体内に載置され、それに関して固定された小さなマイクロ波パッチアンテナを含むことができる。第２の実施例において、アンテナまたはアンテナアレイを、物体に対して画定された配向で、軸を中心に物理的に回転することができる（例えば、物体内またはその上で回転する回転盤に載置される、ヘリコプターの回転翼に載置される）。第３の実施例において、アンテナパターンのアンテナアレイは、アンテナパターンの振幅または位相を、軸を中心に回転させることによって、電気的に回転することができる。
【００７４】
電磁信号セットは、物体と見通し線通信にあるビーコンから到来し得るか、または信号は、物体が信号のナビゲーション方向を理解することができる方法で、物体に送られ得る。いくつかの実施例において、電磁信号セットは、ＧＰＳもしくはＧＬＯＮＡＳＳ航法衛星等の通信衛星、または陸上もしくは水上無線周波ビーコンから到来していてもよい。いくつかの実装において、３つのビーコンおよび物体は、好ましくは、全てが単一の平面内にない。
【００７５】
いくつかの実装において、電磁信号セットは、天体暦データと称される、ビーコンの正確な位置に関する情報を含む。いくつかの実施例において、天体暦データは、ＧＰＳ形式、Ｅｐｈｅｍｅｒｉｄｅｓ  ｏｆ  ｔｈｅ  Ｐｌａｎｅｔｓ  ａｎｄ  ｔｈｅ  Ｍｏｏｎ（ＥＰＭ）形式（ｔｈｅ  Ｒｕｓｓｉａｎ  Ｉｎｓｔｉｔｕｔｅ  ｆｏｒ  Ａｐｐｌｉｅｄ  Ａｓｔｒｏｎｏｍｙ  ｏｆ  ｔｈｅ  Ｒｕｓｓｉａｎ  Ａｃａｄｅｍｙ  ｏｆ  Ｓｃｉｅｎｃｅｓにより開発）、またはＩｎｔｅｇｒａｔｉｏｎ  Ｎｕｍｅｒｉｑｕｅ  Ｐｌａｎｅｔａｉｒｅ  ｄｅ  ｌ’Ｏｂｓｅｒｖａｔｏｉｒｅ  ｄｅ  Ｐａｒｉｓ（ＩＮＰＯＰ）形式（ｔｈｅ  Ｉｎｓｔｉｔｕｔ  ｄｅ  Ｍｅｃａｎｉｑｕｅ  Ｃｅｌｅｓｔｅ  ｅｔ  ｄｅ  Ｃａｌｃｕｌ  ｄｅｓ  Ｅｐｈｅｍｅｒｉｄｅｓ  ｏｆ  Ｆｒａｎｃｅにより開発）を通じて導くことができる。物体内の受信機は、いくつかの実装において、ビーコンの既知の位置またはナビゲーション方向を、電磁信号セット内で、物体に通信されるビーコン識別コードを使用することによって、導くために使用することができる。
【００７６】
各電磁信号セットの到来方向は、ナビゲーション基準データセットに変換される（４０４）。例えば、電磁信号セットに基づいて、物体内の受信機は、既知のナビゲーション座標系に関する物体の位置（例えば、物体座標系の中心のナビゲーション座標）を判定することができる。基準データセットは、いくつかの実装において、物体の速度をさらに含むことができる。基準データセットは、いくつかの実施例において、標準的なＧＰＳ復調および処理法を使用して決定することができる。
【００７７】
方位角情報を、各電磁信号セットに対して検出する（４０６）。例えば、物体座標系のｙおよびｚ軸から構成される法平面に関するビーコンの射影ベクトルの方向を、ビーコンによって通信されている電磁信号をサンプリングすることにより検出し、ピーク信号振幅点を判定することができる。例えば、回転可能なアンテナ等の方向変換器を使用して、各ビーコンがピーク信号振幅点を示す方向を判定することができる。いくつかの実装において、物体の受信機内の専用センサは、物体座標系に対する方位角または方位角の余弦を測定することができる。
【００７８】
任意で、方位角情報の変化速度を、各電磁信号セットについて測定することができる（４０８）。例えば、ビーコンの方位角は、受信機システムによって追跡される、各ビーコンの整列時間を測定し、収集された整列時間の全ての加重和を計算することによって判定することができる。
【００７９】
方位角情報が変化している速度を、受信機内の時間に関して複数の方位角測定を行うことによって判定することができる。いくつかの実装において、物体内の受信機は５ヘルツ以上の速度で測定値を報告することができる。測定期間は、いくつかの実装において、物体の性質に部分的に基づいて決定される。回転物体の配向の変化速度の判定は、より短い測定期間を要するため、例えば、高周波コーニング運動は、適度な正確さで計算することができる。
【００８０】
有効な推定値を得るために、いくつかの実装において、追跡される各ビーコン（例えば、３つ以上のＧＰＳ衛星）に対して、同じ回数の測定をコンパイルしてもよい。例えば、特定のビーコンに関連する特定の測定が、通信問題のために行われなかった場合、そのビーコンは、方位角情報の変化速度を判定する際の計算プロセスから除外され得る。
【００８１】
方位角（ｍｕ＿ｙ）の変化速度（ｍｕ＿ｙｄｏｔ）は、以下の等式によって定義することができる。
ｍｖｄｏｔ＝−ｓｉｎ（ｍｕ＿ｙ）＊ｍｕ＿ｙｄｏｔ
ｍｗｄｏｔ＝−ｓｉｎ（ｍｕ＿ｚ）＊ｍｕ＿ｚｄｏｔ
【００８２】
検出された方位角情報を、物体測定データセットに変換する（４１０）。方位角の測定で開始して、方位角の余弦は、以下の等式により表すことができる。
ｍｖ＝ｃｏｓ（ｍｕ＿ｙ）
ｍｗ＝ｃｏｓ（ｍｕ＿ｚ）
【００８３】
値ｍｖおよびｍｗは、受信機から物体状態推定モジュールに提供され得るか、または代替として、提供された方位角情報に基づいて、物体状態推定モジュールによって計算され得る。一般的に、物体測定データセットの形式は、物体配向が、どのようにして特定の実装に記述されることになるかに依存する。いくつかの実装において、方向余弦行列（ＤＣＭ）等の３×３の回転行列Ａは、ナビゲーション座標系で示されるベクトルから、物体座標系で示されるベクトルへの変換を記述することができる。物体配向を表す別の方法は、４元数と称される単一の４元ベクトルを通じて表され、数学的に以下のように表される。
ｅ＝［ｅ０，ｅ１，ｅ２，ｅ３］
【００８４】
３つのオイラー角は、いくつかの実装において、例えば、ニュートンの法則を使用して、直接操作することができる。いくつかの実装において、上述の方法のいずれも、実質的に等しいと見なすことができるため、空間的配向を求める際に、行列計算とオイラー角計算との間にいくらかの入れ替えが成されてもよい。
【００８５】
（４０８）において方位角情報の変化速度が測定されると、方位角情報は、物体測定行列に変換される（４１２）。一般的に、物体測定速度データセットの形式は、物体の速度が、どのようにして特定の実装において記述されることになるかに依存する。いくつかの実装において、角速度ベクトルの絶対値を使用して、回転の速度を、例えば、１秒あたりの全サイクル数（例えば、ヘルツ）、または１秒あたりの数学的ラジアンで、特定することができる。物体座標系において、３つの成分［ｐ，ｑ，ｒ］は、物体軸の瞬時位置を中心とした物体の回転の組み合わせ速度を表すことができる。
【００８６】
直線関係が、以下の等式によって示される、オイラー角の導関数と
ｅｕｌｅｒｄｏｔ＝［ｙａｗｄｏｔ，ｐｉｔｃｈｄｏｔ，ｒｏｌｌｄｏｔ］
【００８７】
角速度のｐｑｒ成分との間に存在する。３×３行列Ｍ１を、オイラー角（例えば、ヨー、ピッチ、およびロール）の三角関数の条件を使用して構築することができ、以下の一次方程式が適用できる。
ｅｕｌｅｒｄｏｔ＝Ｍ１＊［ｐ，ｑ，ｒ］
【００８８】
別の実施例において、４元数４元ベクトルの導関数
ｅｄｏｔ＝［ｅ０ｄｏｔ，ｅ１ｄｏｔ，ｅ２ｄｏｔ，ｅ３ｄｏｔ］は、
【００８９】
以下の直線関係を示す、４×３行列Ｍ２を使用して、［ｐ，ｑ，ｒ］３次元ベクトルにもまた関連し得る。
ｅｄｏｔ＝Ｍ２＊［ｐ，ｑ，ｒ］
【００９０】
行列Ｍ２の成分は、例えば、オイラー角に依存する行列Ｍ１の成分と類似の方法で、４元数ｅの成分から導くことができる。上述の方法のいずれも、実質的に等しいと見なすことができるため、４元数の導関数と、オイラー角の導関数と、角速度との間のいくらかの入れ替えが、物体の角速度を求める再の計算に成されてもよい。
【００９１】
既知のナビゲーション座標系に関する物体座標系の空間的配向を、判定する（４１４）。利用可能な情報は、物体測定データセットおよびナビゲーションデータセット内に格納される。物体測定データセットは、方位角に対する余弦ｍｖおよびｍｗを含む。物体測定データセットは、ビーコンについての仰角情報（ボアサイト角ｇａｍｍａ＿ｘに等しい）を含まない。空間的配向の判定は、以下の等式により定義される、方向余弦ベクトルｒｂについての部分的な情報を用いて進行し、
ｒｂ＝［ｃｇｘ，ｓｇｘ＊ｍｖ，ｓｇｘ＊ｍｗ］
【００９２】
ｇａｍｍａ＿ｘの余弦ｃｇｘおよび正弦ｓｇｘは、依然として未知である。ナビゲーションデータセットは、ナビゲーション座標系で示されるビーコンの方向余弦ベクトルの座標を含まない。これらの既知のナビゲーションベクトルは、本明細書に次のように定義される。
ｒ＝［ｒｘ，ｒｙ，ｒｚ］
【００９３】
例えば、ナビゲーション座標系に対する物体の空間的配向は、以下の等式に使用可能な何らかの未知のＤＣＭ  Ａによって記述することができる。
ｒｂ＝Ａ＊ｒ
【００９４】
ＤＣＭ  Ａおよびボアサイト角ｇａｍｍａ＿ｘのいずれも、物体座標系の空間的配向を決定することを見出すことができる未知の変数である。これは、費用関数Ｊ（Ａ）を最小化することによって求められる。費用関数Ｊ（Ａ）は、以下の方程式により表されるエラーベクトルの長さの全加重和（二乗）を使用して、得ることができる。
ｅｒｒ＝ｒｂ−Ａ＊ｒ
【００９５】
ベクトルｒｂの成分が、方位角測定に関連するため、スカラー最適化問題を反復して解き、物体の空間的配向を推定することができる。最適化は、ローカルナビゲーション座標から、物体座標系の座標へ変換する３×３ＤＣＭ  Ａをもたらし、各ビーコンに対する未知のボアサイト角ｇａｍｍａ＿ｘを推定する。いくつかの実装において、測定のエラーおよび不確実性のため、解までの各測定の寄与は、測定の正確さの推定に応じて判断することができる。例えば、取得される測定値の数が多いほど（例えば、４つ以上のビーコンに関連する測定）、達成され得る正確性が高くなる。
【００９６】
物体測定速度行列を形成し（４１０）、物体座標系の角速度の近似値を、反復してリファインする（４１６）。まず、物体座標系の角速度の推定値が、初期化され得る。初期化に使用する値は、物体の状況に応じて多様であってもよい。例えば、物体が、回転発射体であることが既知の場合、物体座標系の角速度は、より大きな速度に初期化され得る。別の実施例において、物体が、その飛行パターンを開始する飛行機またはヘリコプターである場合、物体座標系の角速度は、車両の加速度に基づいて初期化されてもよい。以前の物体座標系の角速度の測定値が計算されている場合、初期化は、以前の計算に部分的に基づいて行われてもよい。
【００９７】
初期化された値は、ＤＣＭ、オイラー角、または４元数の導関数を推定するために使用することができる。ビーコンのそれぞれから取得された測定値に関連する速度行列（例えば、上述のｅｕｌｅｒｄｏｔまたはｅｄｏｔ）を、反復してリファインすることができる。物体座標系の角速度は、次に、ＤＣＭ、オイラー角、または４元数の導関数から計算することができる。
【００９８】
角速度推定の正確さを確認するために、二次エラー値が計算されてもよい。これが、推定値の反復の初めての実行ではない場合、二次エラー値を以前に計算された二次エラー値と比較して、推定値が、所望の正確度に達したかどうかを判定することができる。比較が失敗した場合、反復プロセスは、ＤＣＭ、オイラー角、または４元数の導関数の推定を継続し得る。
【００９９】
いくつかの実装において、反復は、二次エラー値比較が、少なくとも既定数の有効数字（例えば、３、４、または６）について、現在の二次エラー値が以前の二次エラー値と等しいことを判定するまで、継続し得る。反復は、いくつかの実装において、一定回数の反復後または特定の期間が経過した後、中断されてもよい。例えば、角速度推定の反復は、新しい測定値が利用可能であることか、または電力消費の制限のために、短く切り上げられてもよい。
【０１００】
より多いかまたはより少ないステップが、プロセス４００内に含まれてもよく、ステップのうちのいくつかは、記載されるものとは異なる順序で行われてもよい。いくつかの実装において、変化速度に加えて、加速度を推定することができる。いくつかの実装において、物体の位置および速度は、計算されない。例えば、携帯電話基地局のようにビーコンが固定であり、物体の位置が必要でない場合、プロセス４００は、位置および速度情報を無視し、物体の空間的配向に関連する情報の計算のみを行うことができる。これは、例えば、進路情報を、図的表示で操作者に提供する際に、適用可能である。
【０１０１】
図５は、４元数を使用して、方位角情報から物体の空間的配向を判定するための例示的プロセス５００のフローチャートである。簡略的には、プロセス５００に利用可能な情報は、図４に関連して記載される、変数ｍｗ、ｍｖ、ｒｂ、およびｒに関連する情報を含む、物体測定データセットおよび物体ナビゲーション基準データセットを含むことができる。物体ナビゲーション基準データセットは、例えば、物体座標系内に画定されるＮ個のナビゲーションベクトル、３×Ｎ行列Ｒ（例えば、列がＮ個のナビゲーションベクトルである）に配設されるナビゲーションベクトル成分を含むことができる。行列Ｒの階数を判定する際、ナビゲーションベクトルの少なくとも３つが、一次独立であることが想定され得る。これは、例えば、ＧＰＳ衛星を使用する場合に典型的である。本明細書に使用する際、方程式または等式内のアポストロフィは、ベクトルまたは行列の転置を取ることを指す。
【０１０２】
プロセス５００の目標は、既知のナビゲーション座標系から物体座標系の座標へ変換するために使用することができる、３×３の方向余弦行列（ＤＣＭ）Ａを決定することである。物体座標系の軸の座標が、既知のナビゲーション座標系におけるベクトルとして書かれる場合、３つの異なるベクトルｕ、ｖ、およびｗを使用して、ｘｙｚ物体座標軸を、既知のナビゲーション座標系における３×１列ベクトルとして、定義することができる。以下のように、ＤＣＭは、３×３行列として定義することができ、
Ａ＝［ｕ’，ｖ’，ｗ’］
【０１０３】
行は、行ベクトルに転置された３×１列ベクトルの成分である。
【０１０４】
各ナビゲーションベクトルｒについて、
ｒｂ＝Ａ＊ｒ＝［ｕ’＊ｒ，ｖ’＊ｒ，ｗ’＊ｒ］を、
【０１０５】
３×１列ベクトルとして表すことができる。
【０１０６】
図３Ａに関連して記載されるように、３元のボアサイト角ｇａｍｍａ＿ｘを、以下の等式を使用して表すことができる。
ｓｇｘ＝ｓｉｎ（ｇａｍｍａ＿ｘ）
ｃｇｘ＝ｃｏｓ（ｇａｍｍａ＿ｘ）
【０１０７】
ボアサイト角ｇａｍｍａ＿ｘを使用して、エラーベクトルを以下のように表すことができる。
ｅｒｒ＝ｒｂ−Ａ＊ｒ＝［ｃｇｘ−ｕ’＊ｒ，ｓｇｘ＊ｍｖ−ｖ’＊ｒ，ｓｇｘ＊ｍｗ−ｗ’＊ｒ］
【０１０８】
この時点で、ナビゲーションベクトルｒ、方位角余弦測定ｍｖ、および方位角余弦測定ｍｗは、既知の値である。
【０１０９】
プロセス５００は、物体座標系の現在の姿勢の推定値を表す姿勢４元数の初期化で開始する（５０２）。４元数に関する問題を再計算して、単位４元数ｅにおいて、３つの独立した未知数が存在することを認識することができる。図４に関連して導入した、費用関数Ｊ（Ａ）に戻り、修正費用関数Ｊ（Ａ（ｅ））を、未知の４元数ｅ、既知のナビゲーションベクトルｒ、および既知の方位角余弦測定ｍｖおよびｍｗの関数として定義することができる。
【０１１０】
最適化問題は、以下の形態の固有ベクトル問題をもたらし、
Ｈ＊ｅ＝ｌａｍｂｄａ＊ｅ
【０１１１】
ｅは４元数であり、Ｈは、ベクトル測定ｒｂから導かれる４×４角度固有行列Ｈである。
【０１１２】
角度固有行列Ｈは、未知であり、未知のボアサイト角ｇａｍｍａ＿ｘ、ならびに既知の方位角余弦測定ｍｖおよびｍｗに依存している。スカラー測定を使用して、角度固有行列Ｈを、ボアサイト角ｇａｍｍａ＿ｘの近似値で開始する、４元数ｅを判定するための固有ベクトル問題を解く際に同時に推定することができる。
【０１１３】
Ｊ（Ａ（ｅ））の最小化は、ナビゲーションベクトルｒの成分および方位角の余弦測定ｍｖおよびｍｗに単に依存する、既知の４×４行列Ｈｍについて、スカラー量を最小化することと同一であることが判明し、
Ｊ（ｅ）＝（ｓｇｘ−ｅ’＊Ｈｍ＊ｅ）２
【０１１４】
費用関数Ｊ（ｅ）は、未知パラメータｓｇｘに明示的に依存するが、ｓｇｘの値は、黙示的にｅに依存する。これは、二次的に制約される二次問題を導き、ｅが単位４元数であるという制約を維持するためにラグランジュ乗数を付加し、４元数成分に関して微分する場合、固有ベクトル問題は、以下をもたらす。
（Ｈ−ｌａｍｂｄａ＊Ｉ）＊ｑ＝０
【０１１５】
固有行列Ｈは、黙示的にパラメータｓｇｘに依存する。この固有ベクトル問題は、４つの異なる固有値ｌａｍｂｄａを用いて、４つの固有ベクトルｑによって解くことができる。所望の姿勢４元数ｅは、この実施例において、正しいパラメータｓｇｘに対して最も大きな固有値ｌａｍｂｄａを伴う固有ベクトルｑである。
【０１１６】
パラメータｓｇｚに対する推定値を考慮すると、角度固有行列Ｈは、ナビゲーション基準データセットおよび物体測定データセットからの基準値を使用して確立される（５０４）。既知のナビゲーションベクトルｒのみに依存する３×４行列Ｈｕ、Ｈｖ、およびＨｗを定義し、どのように角度固有行列Ｈもまた、既知のボアサイト角ｇａｍｍａ＿ｘおよび測定余弦ｍｖおよびｍｗに依存するかを示すことができる。角度固有行列Ｈは、明示的に、ボアサイト角ｇａｍｍａ＿ｘの余接に依存する。
【０１１７】
【数１】
2013533467.tif 000003
【０１１８】
具体的には、角度固有行列Ｈは、次の等式に一致する。
Ｈ＝ｍｖ＊Ｈｖ＋ｍｗ＊Ｈｗ＋ｃｔｎ＊Ｈｕ
【０１１９】
これらの４×４行列を、各ナビゲーションベクトルｒに対して得ることができる。固有値問題を正しく提起するために、ナビゲーションベクトルｒの全Ｎ個に対する寄与の和（または、任意で加重和）を形成することができる。少なくとも３つのビーコンに対するデータは、例えば、一意解を判定する必要がある場合がある。いくつかの実装において、小さなボアサイト角ｇａｍｍａ＿ｘを有するあらゆるナビゲーションベクトルｒに対する寄与は、余接が無限であるために、無視することができる。したがって、Ｎ個の異なる角度固有行列が、測定および追跡されている場合であっても、方位角余弦測定ｍｖおよびｍｗの信頼性が高く、ボアサイト角ｇａｍｍａ＿ｘが小さすぎないような角度固有行列のみが、最小二乗解を計算する際に使用可能である。
【０１２０】
このアルゴリズムを適用する際、例えば、ＭａｔＬａｂにおいて、以下の計算を使用して、角度固有行列を確立し、姿勢４元数ｅを初期化することができる。
【０１２１】
まず、全Ｎ個のナビゲーションベクトルｒに対して、全ての４×４行列（例えば、Ｈｕ、Ｈｖ、Ｈｗ）の格納を初期化することができる。
Ｈｕｒ＝ｚｅｒｏｓ（Ｎ，４，４）；
Ｈｖｒ＝ｚｅｒｏｓ（Ｎ，４，４）；
Ｈｗｒ＝ｚｅｒｏｓ（Ｎ，４，４）；
【０１２２】
次に、各ナビゲーションベクトルｒ（１〜Ｎ）に対する行列を定義することができる。
【０１２３】
ベクトル成分および余弦測定を、３×Ｎ行列Ｒに配設されるナビゲーションベクトル成分から抽出することができる。
ｒｘ＝Ｒ（１，ｉ）；
ｒｙ＝Ｒ（２，ｉ）；
ｒｚ＝Ｒ（３，ｉ）；
【０１２４】
ｕに対するナビゲーションベクトルｒの射影の行列Ｈｕｒを、算出することができる。
【０１２５】
【数２】
2013533467.tif 000004
【０１２６】
ｖに対するｒの射影の行列Ｈｖｒを算出することができる。
【０１２７】
ｗに対するｒの射影の行列Ｈｗｒを算出することができる。
【０１２８】
【数３】
2013533467.tif 000005
【０１２９】
ナビゲーション行列は、例えば、それらが、行列Ｒにおいてナビゲーションベクトルｒだけに依存するため、単一回だけ算出され得る。ナビゲーション行列は、次いで、以下のアルゴリズムで使用することができる。
【０１３０】
基準姿勢４元数および角度固有行列を、反復してリファインする（５０６）。４元数ｅを算出するためのアルゴリズムのコアは、４元数ｅの初期近似値をリファインする反復的なプロセスを含む。反復が行われるたびに、例えば、４元数ｅの以前の算出結果がリファインされたものになり、最終的な４元数ｅにより近似の値を提供する。プロセスは、任意の回数で繰り返すことができるが、推定値が測定エラーにより偏ったものになる点に達する可能性がある。
【０１３１】
４元数リファインアルゴリズムの変形には、例えば、４元数ｅに対する初期推定値を画定するための異なるアプローチが含まれる。一般的に、ローカルナビゲーション座標系に対する物体座標系のおおよその配向について既知であり得るものはいずれも、ｑに対する初期推定に組み込むことができる。これには、いくつかの実施例において、センサ測定、車両に関する開始パス情報、以前に計算された空間的配向の推定値、または物体の位置、配向、速度、または加速度に関する、他の測定もしくは計算された推定値が含まれる。４元数方法の実施例を使用して、単に、４元数ｅが単位４元ベクトルとして定義されるため、各近似値ｑは、単位４の４元ベクトルによって表すことができる。
【０１３２】
以下の反復アルゴリズム例において、寄与は、単純化のために加重されていない。他の実装において、個別の寄与が、加重され得る。
【０１３３】
推定された４元数ｑを使用して、推定された４元数ｅのベクトル成分をまず抽出することによって、ボアサイト角ｇａｍｍａ＿ｘの全てに対する余接を推定することができる。
ｑ＝［ｑ０，ｑｘ，ｑｙ，ｑｚ］
【０１３４】
次に、物体ｘ軸ベクトルｕのローカルナビゲーション座標系の座標を形成することができる。
ｕ＝［ｑｘ２＋ｑ０２−ｑｙ２−ｑｚ２，２＊（ｑｘ＊ｑｙ＋ｑｚ＊ｅ０，２＊（ｑｘ＊ｑｚ−ｑｙ＊ｑ０）］
【０１３５】
次に、物体座標系のｘ軸ｕから形成されたボアサイト角ｇａｍｍａ＿ｘの余弦、正弦、および余接を、以下のように推定することができる。
【０１３６】
【数４】
2013533467.tif 000006
【０１３７】
余接推定値を使用して、４×４の角度固有行列Ｈを再算出することができるようになる。
【０１３８】
４×４角度固有行列Ｈｕ、Ｈｖ、Ｈｗ、およびＨを、以下のように初期化することができる。
Ｈｕ＝ｚｅｒｏｓ（４，４）；
Ｈｖ＝ｚｅｒｏｓ（４，４）；
Ｈｗ＝ｚｅｒｏｓ（４，４）；
Ｈ＝ｚｅｒｏｓ（４，４）；
【０１３９】
角度固有行列Ｈは、全てのナビゲーションベクトルｒをループすることによりＮ個のナビゲーションベクトルｒからの（加重）寄与を加算することによって算出することができ（ｉ＝１：Ｎ）、
【０１４０】
（１）ベクトルｒに対する角度固有行列を抽出し、
Ｈｕ（：，：）＝Ｈｕｒ（ｉ，：，：）；
Ｈｖ（：，：）＝Ｈｖｒ（ｉ，：，：）；
Ｈｗ（：，：）＝Ｈｗｒ（ｉ，：，：）；
【０１４１】
（２）ナビゲーションベクトルｒに対する余弦方位角測定値を抽出する。
ｍｖ＝Ｍｖ（１，ｉ）
ｍｗ＝Ｍｗ（１，ｉ）
【０１４２】
（３）ナビゲーションベクトルｒの寄与を、角度固有行列Ｈに加算する。
Ｈ＝Ｈ＋ｍｖ＊Ｈｖ＋ｍｗ＊Ｈｗ＋Ｃｔｎｑ（ｉ）＊Ｈｕ
【０１４３】
４元数測定値ｑは、今では、角度固有行列Ｈを使用して、改善および再正規化することができる。
【０１４４】
【数５】
2013533467.tif 000007
【０１４５】
これは、初期４元数推定値ｑよりも良好な、実際の姿勢４元数ｅの近似値を提供する新しい単位４元数ｑをもたらす。推定された４元数ｑを使用して全てのボアサイト角ｇａｍｍａ＿ｘに対する余接を推定すること、余接推定値を使用して角度固有行列Ｈを再算出すること、ならびに結果として得られる４元数推定値ｑを改善および再正規化することを含む、ある回数の反復後、最終的な４元数推定値ｑは、姿勢４元数ｅに対する妥当な近似値となるはずである。
【０１４６】
いくつかの実装において、反復は、二次エラー関数が、実質的に改善を終えるまで、繰り返される。姿勢４元数ｅに対する実際の正確な測定値が既知である場合、二次エラー関数は、理想的には、各ナビゲーションベクトルｒに対してゼロとなる。
Ｊ（ｅ）＝（ｓｇｘ−ｅ’＊Ｈｍ＊ｅ）２＝０
【０１４７】
これに基づいて、利用可能な所定の測定データが、二次エラー推定を改善していないような場合は、反復を中止することができる。より正確な余弦測定値が後に利用可能になった場合、例えば、反復を再開することができる。
【０１４８】
リファインされた姿勢４元数を、同等のヨー、ピッチ、およびロール角に変換する（５０８）。例えば、ＤＣＭまたはヨー、ピッチ、およびロール角のオイラー角は、物体配向の異なる表示間の等式を現す従来的な方法を使用して、４元数推定値ｑから導くことができる。
【０１４９】
図６は、４元数を使用して、方位角速度情報から物体の角速度を判定するための例示的プロセス６００のフローチャートである。４元数ｅおよび角度固有行列Ｈに関する図５に関連して記載される方法と同様に、４元数の導関数ｅｄｏｔは、方位角余弦測定ｍｖｄｏｔおよびｍｗｄｏｔの導関数、ならびにボアサイト角ｇａｍｍａ＿ｘに依存する導関数行列Ｈｄｏｔを使用して、所定の方位角余弦測定ｍｖｄｏｔおよびｍｗｄｏｔの導関数を計算することができる。４元数ｅの解とは異なって、しかしながら、４元数の導関数ｅｄｏｔは、導関数行列Ｈｄｏｔの固有ベクトルではないことがわかる。
【０１５０】
一般的に、４元数の導関数ｅｄｏｔを判定するために、Ｈの固有ベクトルは、４元数の導関数ｅｄｏｔが、固有ベクトルＨの一次結合として表されることを可能にする方法で慎重に正規化され得る。角度固有行列Ｈの場合、全ての固有値は、実質的に異なり、正規化は、容易かつ効率的に実行され得る。いくつかの実装において、より上位の４元数の導関数は、以下の原理を使用して、（例えば、物体の加速度を判定するために）より上位の固有行列から算出することができる。
【０１５１】
完全測定を想定して、姿勢４元数ｅは、固有値ｌａｍｂｄａに対応する、角度固有行列Ｈの固有ベクトルである。４元数ｅは、以下の固有値方程式を常に満たし、
（Ｈ−ｌａｍｂｄａ）＊ｅ＝０
【０１５２】
Ｈは、角度固有行列であり、ｅは、図５で固有値ｌａｍｂｄａに関して記述される姿勢４元数である。
【０１５３】
この方程式の導関数を取得することによって、２つの項の和を形成する。
（Ｈ−ｌａｍｂｄａ）＊ｅｄｏｔ＋（Ｈｄｏｔ−ｌａｍｂｄａｄｏｔ）＊ｅ＝０
【０１５４】
Ｈｄｏｔおよびｌａｍｂｄａｄｏｔが既知であれば、方程式を解くことができる。単純に、２つの４×４行列ＨｍＬおよびＨｍＬｄｏｔを定義し、ｅｄｏｔの解を求める。
ＨｍＬ＝Ｈ−ｌａｍｂｄａ
ＨｍＬｄｏｔ＝Ｈｄｏｔ−ｌａｍｂｄａｄｏｔ
ＨｍＬ＊ｅｄｏｔ＝−ＨｍＬｄｏｔ＊ｅ
【０１５５】
ＨｍＬは、唯一であり、固有ベクトル４元数ｅの方向にある。しかしながら、ｅ’＊ｅ＝１の二次制約に基づいて、微分によりｅｄｏｔがｅに対して垂直であるということになり、そのため、ｅｄｏｔが、ｅ方向の自明でない成分を有するという心配がほとんどない。換言すると、ｅｄｏｔは、角度固有行列Ｈの他の固有ベクトルの和と考えることができる。
【０１５６】
固有値の導関数を得るために、以下の方程式を微分することができる。
ｅ’＊（Ｈ−ｌａｍｂｄａ）＊ｅ＝０
【０１５７】
これは、以下の方程式をもたらす。
ｌａｍｂｄａｄｏｔ＝ｅ’＊Ｈｄｏｔ＊ｅ
【０１５８】
固有値の導関数の解くことは、これもまたｅｄｏｔに依存するＨｄｏｔを判定することを伴う。
Ｈｄｏｔおよびｅｄｏｔは、スカラー二次エラー関数Ｊ２（ｅｄｏｔ）を最小化する、反復的な近似法によって同時に得ることができる。
Ｊ２（ｅｄｏｔ）＝（ＨｍＬ＊ｅｄｏｔ−ＨｍＬｄｏｔ＊ｅ）２
【０１５９】
測定された方位角余弦導関数が、２行ベクトル（例えば、１×Ｎ行列）ＭｖｄｏｔおよびＭｗｄｏｔに格納されていると仮定することから開始する。また、プロセス５００（図５を参照）中に計算されたデータが利用可能であると仮定する。
【０１６０】
プロセス６００は、物体座標系の角速度を初期化することで開始する（６０２）。３×１角速度ベクトルｐｑｒおよび他のデータ構造は、角速度の反復的なリファインメントが開始する前に初期化するものとする。角速度ベクトルｐｑｒは、例えば、利用可能な追加の測定値、以前の推定値、または物体について既知の他の情報に基づいて、角速度の妥当な推定値に初期化することができる。いくつかの実装において、角速度ベクトルは、ゼロに初期化される。
【０１６１】
他の行列を、図５に関連して記載されるデータを使用して初期化することができる。標準的な行列の技術を、次の行列固有値方程式を満たす、算出のための角度固有行列Ｈ、および４×４固有ベクトル行列Ｘ、および固有値の対角４×４行列Ｌに適用することができる。
Ｈ＊Ｘ＝Ｌ＊Ｘ
【０１６２】
行列ＸおよびＬの列の順序は、以下になるように配設することができる。
Ｘ（：，４）＝ｅ
Ｌ（４，４）＝ｌａｍｂｄａ
【０１６３】
特異行列Ｈ−ｌａｍｂｄａに対する擬似逆ＨｍＬｉｎｖを算出し、以下のように初期化することができる。
【０１６４】
【数６】
2013533467.tif 000008
【０１６５】
Ｈｄｏｔを算出するために使用されるいくつかの４×４行列もまた、初期化することができる。
Ｈｕ＝ｚｅｒｏｓ（４，４）；
Ｈｖ＝ｚｅｒｏｓ（４，４）；
Ｈｗ＝ｚｅｒｏｓ（４，４）；
Ｈｄｏｔ＝ｚｅｒｏｓ（４，４）；
【０１６６】
上述のように初期化されたこれらのデータ構造を用いて、角速度ｐｑｒの反復的なリファインメントのためのステップを開始することができる。４元数の導関数を、推定された角速度を使用して計算する（６０４）。例えば、４元数の導関数ｅｄｏｔは、以下のように、近似角速度から推定することができる。
【０１６７】
【数７】
2013533467.tif 000009
【０１６８】
角度固有行列の導関数および固有値を計算する（６０６）。導関数Ｈｄｏｔおよびｌａｍｂｄａｄｏｔは、例えば、以下のプロセスにより算出することができる。
【０１６９】
まず、ナビゲーション座標系内の物体座標系のＸ軸の導関数を、以下のように推定することができる。
【０１７０】
【数８】
2013533467.tif 000010
【０１７１】
次に、ボアサイト角ｇａｍｍａ＿ｘに対する三角導関数を、以下のように推定することができる。
【０１７２】
【数９】
2013533467.tif 000011
【０１７３】
ナビゲーションベクトルｒからの固有行列の導関数Ｈｄｏｔへの寄与の和を、以下のように、（図５に関連して記載される）プロセス５００からのデータを使用して、得ることができる。
Ｈｄｏｔ＝０＊Ｈｄｏｔ
【０１７４】
ｉ＝１：Ｎについて、
Ｈｕ（：，：）＝Ｈｕｒ（：，：，：）；
Ｈｖ（：，：）＝Ｈｖｒ（：，：，：）；
ＨＷ（：，：）＝Ｈｗｒ（：，：，：）；
Ｈｄｏｔ＝Ｈｄｏｔ＋Ｍｖｄｏｔ（１，ｉ）＊Ｈｖ＋Ｍｗｄｏｔ（１，ｉ）＊Ｈｗ＋Ｃｔｎｄｏｔ（１，ｉ）＊ｈｕ
【０１７５】
終了
【０１７６】
固有値ｌａｍｂｄａｄｏｔの導関数を、以下のように推定することができる。
ｌａｍｂｄａｄｏｔ＝ｅ’＊Ｈｄｏｔ＊ｅ
【０１７７】
導関数を使用して、角速度を計算する（６０８）。例えば、４元数の導関数ｅｄｏｔは、ｌａｍｂｄａｄｏｔおよび固有行列の導関数Ｈｄｏｔの推定値に基づいて、計算できるようになる。
ＨｍＬｄｏｔ＝Ｈｄｏｔ−ｌａｍｂｄａｄｏｔ
ｅｄｏｔ＝−１＊ＨｍＬｉｎｖ＊ＨｍＬｄｏｔ＊ｅ
【０１７８】
物体座標系の角速度を、４元数の導関数から計算する（６０８）。例えば、以下の行列方程式を解いて、角速度ベクトルｐｑｒを推定することができるようになる。
【０１７９】
【数１０】
2013533467.tif 000012
【０１８０】
上述の方程式の結果が、実際の角速度をより近似に求めるために使用可能な物体座標系の角速度の新しい推定値である。
【０１８１】
二次エラー値を計算する（６１０）。例えば、以下の算出を実行し、Ｊ２（ｅｄｏｔ）の値を確保することができる。
Ｊ２（ｅｄｏｔ）＝（ＨｍＬ＊ｅｄｏｔ−ＨｍＬｄｏｔ＊ｅ）２
【０１８２】
エラー値が、実質的に、以前に計算されたエラー値と同一である場合（６１２）、プロセス６００は終了する。そうでなければ、プロセス６００は、物体座標系の角速度を使用して、４元数の導関数を推定することに戻る（６０４）。
【０１８３】
ある回数で（６０４）から（６１０）の反復を繰り返した後、例えば、結果として得られる角速度ｐｑｒの推定値は、十分に正確であることが予想される。図５に関連して記載される４元数ｅを推定するためのアルゴリズムにあるように、４元数の導関数ｅｄｏｔに対する実際の正確な測定値が既知の場合、二次エラー関数Ｊ２（ｅｄｏｔ）は、同様にゼロとなるであろう。
Ｊ２（ｅｄｏｔ）＝０
【０１８４】
これに基づいて、反復は、与えられた利用可能な測定値データが、二次エラー推定を改善していないような場合に、中止され得る。より正確な余弦の導関数測定値が、後に利用可能になった場合、例えば、反復を再開することができる。
【０１８５】
図７Ａは、空間的配向の推定値を使用して、遠隔システムにフィードバックを提供するための例示的プロセス７００のフローチャートである。遠隔システムは、いくつかの実装において、試験（例えば、回転する発射体が、設計者によって推定された経路およびコーニングモデルに従っているかどうかを判定する）、修正（例えば、進路を外れてしまった物体の経路を調整する）、または制御（例えば、物体の経路を能動的に調整する）のために、この情報を使用することができる。例えば、遠隔制御デバイスにおける利用者は、表面に載置された電磁ビーコン、およびパイプラインドリル内蔵の物体配向推定機から得られた配向測定値に基づいて、パイプラインドリルの経路を能動的に調整することができる。
【０１８６】
プロセス７００は、物体の位置情報を判定することで開始する（７０２）。物体の位置情報は、例えば、ＧＰＳ受信機を通じて等、従来の方法で判定することができる。
【０１８７】
物体の配向は、仰角情報を使用することなく、検出された方位角情報を使用して判定される（７０４）。例えば、図４に関連して記載されるプロセスを使用して、物体の配向を推定することができる。
【０１８８】
物体の位置情報および空間的配向情報は、ローカルデータ記憶装置に収集される（７０６）。例えば、物体の位置データおよび配向推定データを、物体に直接接続されるデータ記憶装置内に収集することができる。
【０１８９】
情報を遠隔で提供する準備ができると（７０８）、物体の位置情報および空間的配向情報を、遠隔システムに無線で通信することができる（７１０）。物体が能動的に制御されている場合、例えば、データは、計算されるたびに、遠隔システムに無線で通信されてもよい。いくつかの実装において、物体の位置データおよび配向推定データのセットを収集し、データを遠隔システムに定期的に提供することができる。一実施例において、データは、毎Ｎ回の反復後に提供されてもよい。別の実施例において、データは、固定の時間スケジュール（例えば、１０秒毎）で提供されてもよい。物体の位置データおよび配向推定データは、いくつかの実装において、エラー条件を満たすことに基づいて、遠隔システムに提供されてもよい。例えば、物体の配向推定データが、計画されたナビゲーション経路と著しく異なる場合、遠隔システムは、警告を受け得る。
【０１９０】
情報が遠隔システムに提供されたかどうかに関わらず、プロセス７００は、現在および異なる可能性のある、物体の位置および姿勢に基づいて、物体の位置情報の判定に戻る（７０２）。
【０１９１】
図７Ｂは、空間的配向の推定値を使用して物体の軌道を調整するための、例示的プロセス７２０のフローチャートである。プロセス７２０は、例えば、ミサイルもしくは衛星等の発射体、またはヘリコプター、潜水艦、もしくは航空機等の無人機体の誘導システムにおいて使用可能である。
【０１９２】
プロセス７２０は、物体の位置情報を判定することで開始する（７２２）。物体の位置情報は、例えば、ＧＰＳ受信機を通じて等、従来の方法で判定することができる。
【０１９３】
物体の配向は、仰角情報を使用することなく、検出された方位角情報を使用して判定される（７２４）。例えば、図４に関連して記載されるプロセスを使用して、物体の配向を推定することができる。
【０１９４】
物体の位置情報および空間的配向を、所望の経路と比較する（７２６）。例えば、所定の軌道または飛行計画を、図１に関連して記載される６ＤＯＦ物体状態推定機１０８等の物体姿勢推定モジュールにプログラムすることができる。いくつかの実装において、物体の位置および推定配向と、物体の所望の経路との間で、閾値の比較を行ってもよい。
【０１９５】
物体が、経路から外れると（７２８）、物体の進路は、物体の位置および空間的配向を、所望の経路と再度一致するように調整することができる（７３０）。いくつかの実装において、所定の進路と現在の物体の位置および配向との間の差異を使用して、物体の経路を調整することができる。発射体または無人機体の実施例において、調整は、飛行システムを通じて行われてもよい。いくつかの実施例において、翼、羽根、または先尾翼等の受動的な調整要素を、物体を所望の軌道に再度一致するように調整することができる。物体が潜水艦の場合、例えば、バラストシステムを調整することができる。推進ジェット等の能動的要素もまた、物体を再整列させるために調整可能である。
【０１９６】
物体が進路を外れていると判断されるかどうかに関わらず、プロセス７２０は、現在または異なっている可能性のある物体の位置および姿勢に基づいて、物体の位置情報の判定に戻る（７２２）。
【０１９７】
図７Ｃは、空間的配向の推定値を使用して、飛行機、ヘリコプター、トラック、または潜水艦等のパイロットまたは操作者に、視覚的なフィードバックを提供するための例示的プロセス７４０のフローチャートである。プロセス７４０は、いくつかの実装において、パイロットが、物体配向の実際の視覚的指示へのアクセスを制限されている時に、パイロットに、視覚的指示を提供することができる。例えば、パイロットは、沈泥もしくは視界の悪い海の領域を通過する際、または飛行機が濃い雲に入る際、物体の姿勢の指示をほとんど有しないか、または全く有しない。別の実施例においては、携帯電話の画面を進行方向情報で拡張することができ、そうして歩行者が、密林地域から出るためのコンパスとして携帯電話を使用することができるようになる。携帯電話の基地局は、アンテナが方位角情報を検出する能力を有して、携帯電話の配向を判定するためのナビゲーションビーコンとして機能することができる。
【０１９８】
プロセス７４０は、仰角情報を使用することなく、検出された方位角情報を使用して、物体の配向を判定することで開始する（７４２）。例えば、図４に関連して記載されたプロセスを使用して、物体の配向を推定することができる。
【０１９９】
物体の位置および空間的配向を、グラフィカルユーザインターフェース（ＧＵＩ）にプロットする（７４４）。例えば、擬似水平、物体の姿勢のシミュレーション、または既知のナビゲーション座標系に関する物体座標系の姿勢表示を、車両制御装置のダッシュボード領域内または携帯電話もしくは遠隔制御装置の表示領域に図的にプロットすることができる。
【０２００】
使用者からの入力を受信して、空間的配向を調整する（７４６）。例えば、利用者は、車両を偽水平と再度整列させるか、または物体の姿勢のシミュレーションを正すために、車両の配向を手動で調整することができる。
【０２０１】
プロセス７４０は、有人車両に関して記載されるが、いくつかの実装において、ＧＵＩは、無人車両の遠隔パイロットに提供されてもよい。例えば、暗闇、沈泥、または雲の覆いが、遠隔制御された無人車両の経路を遮る場合、典型的に、無人車両から中継される１つ以上のカメラ画像に頼っているパイロットは、プロセス７４０を頼りに、配向のフィードバックを提供することができる。
【０２０２】
図８は、本明細書に記載のシステムおよび方法の実装に使用可能なコンピューティングデバイス８００のブロック図である。例えば、コンピューティングデバイス８００は、受信機（図１に示される受信機１０２等）または６ＤＯＦ物体状態推定器（図１に示される物体状態推定器１０８等）に使用可能である。
【０２０３】
コンピューティングデバイス８００には、プロセッサ８０２、メモリ８０４、記憶装置８０６、入力デバイスおよび画像表示部等の入出力デバイス８０８、ならびにこれらの構成要素間の通信を提供するバスシステム８１０が含まれる。プロセッサ８０２は、メモリ８０４または記憶デバイス８０６に記憶された命令を含む、コンピューティングデバイス８００内での実行のための命令を処理して、本明細書に前述の種々の操作を行うことができる。さらに、本明細書に記載の構成要素はまた、ファームウェアまたは特定用途向け集積回路（ＡＳＩＣ）に実装することができ、その場合、図８は、単純にデバイス操作の例示である。
【０２０４】
記載される特徴は、デジタル電子回路、またはコンピュータハードウェア、ファームウェア、ソフトウェア、もしくはそれらの組み合わせにおいて実装可能である。装置は、明白に情報媒体に具体化されたコンピュータプログラム製品、例えば、プログラム可能プロセッサによる実行のための機械可読記憶デバイスにおいて、実装することができ、方法ステップは、命令のプログラムを実行するプログラム可能プロセッサによって実行され、入力データに基づいて作動し出力を生成することによって、記載の実装の機能を実行することができる。記載の特徴は、データ記憶装置システム、少なくとも１つの入力デバイス、および少なくとも１つの出力デバイスからデータおよび命令を受信し、データおよび命令をそこへ伝送するように接続される、少なくとも１つのプログラム可能なプロセッサを含む、プログラム可能システム上で実行可能な１つ以上のコンピュータプログラムに、有利に実装することができる。コンピュータプログラムは、特定の動作を行うか、または特定の結果をもたらすために、直接的または間接的にコンピュータで使用可能な命令のセットである。コンピュータプログラムは、コンパイル型またはインタプリタ型言語を含む、任意の形態のプログラム言語で書くことができ、独立型プログラム、またはモジュール、コンポーネント、サブルーチン、もしくはコンピューティング環境での使用に好適な他のユニットを含む、任意の形態で展開することができる。
【０２０５】
命令のプログラムを実行するのに好適なプロセッサには、例示として、汎用および専用両方のマイクロプロセッサ、ならびに任意の種類のコンピュータの単独または複数のプロセッサの１つが含まれる。一般的に、プロセッサは、読み取り専用メモリもしくはランダムアクセスメモリ、または両方から、命令およびデータを受信することになる。コンピュータの必須要素は、命令を実行するためのプロセッサ、ならびに命令およびデータを記憶するための１つ以上のメモリである。一般的に、コンピュータはまた、データファイルを記憶するための１つ以上の大容量記憶デバイスを含むか、それと操作可能に接続されることになり、このようなデバイスには、内蔵ハードディスクおよび取り外し可能ディスク等の磁気ディスク、光磁気ディスク、ならびに光ディスクが挙げられる。コンピュータプログラム命令およびデータを実体的に具現化するために好適な記憶デバイスには、任意の形態の不揮発性メモリが含まれ、例示として、ＥＰＲＯＭ、ＥＥＰＲＯＭ、およびフラッシュメモリデバイス等の半導体メモリ装置、内蔵ハードディスクおよび取り外し可能ディスク等の磁気ディスク、光磁気ディスク、ならびにＣＤ−ＲＯＭおよびＤＶＤ−ＲＯＭディスクが挙げられる。プロセッサおよびメモリは、ＡＳＩＣ（特定用途向け集積回路）により補完されるか、またはそこに組み込まれてもよい。
【０２０６】
利用者との相互作用を提供するために、利用者に情報を表示するためのＣＲＴ（陰極線管）またはＬＣＤ（液晶画面）モニタ等の表示デバイス、使用者がそれによってコンピュータに入力を提供することができる、キーボードおよびマウスまたはトラックボール等のポインティングデバイスを有するコンピュータに、特徴を実装することができる。
【０２０７】
特徴は、データサーバ等のバックエンドコンポーネントを含むか、またはアプリケーションサーバもしくはインターネットサーバ等のミドルウェアコンポーネントを含むか、またはグラフィカルユーザインターフェースもしくはインターネットブラウザを有するクライアントコンピュータ等のフロントエンドコンポーネントを含むか、あるいはそれらの任意の組み合わせを含む、コンピュータシステムに実装することができる。システムの構成要素は、通信ネットワーク等のデジタルデータ通信の任意の形態または媒体によって接続することができる。通信ネットワークの例には、例えば、ＬＡＮ、ＷＡＮ、ならびにインターネットを形成するコンピュータおよびネットワークが含まれる。
【０２０８】
コンピュータシステムには、クライアントおよびサーバが含まれてもよい。クライアントおよびサーバは、一般的に、互いに離れており、典型的には、記載されるもののようなネットワークを介して相互作用する。クライアントとサーバの関係は、それぞれのコンピュータ上で作動するコンピュータプログラムに基づいて生じ、互いに対してクライアント−サーバ関係を有する。
【０２０９】
少数の実装が上で詳細に記載されてきたが、他の修正が可能である。さらに、図で描写された論理の流れは、所望の結果を達成するために、示される特定の順序または連続した順序を必要としない。さらに、他の動作が提供されるか、または記載の流れから動作が排除されてもよく、他の構成要素が記載のシステムに追加されるか、またはそこから除去されてもよい。したがって、他の実装は、以下の請求項の範囲内である。
【符号の説明】
【０２１０】
１０２  受信機
１０４  方向変換器
１０６  電磁ビーコン
１０８  ６自由度物体状態推定機
１１０  ６自由度データリポジトリ
【図１Ａ】
2013533467.tif 000013
【図１Ｂ】
2013533467.tif 000014
【図２】
2013533467.tif 000015
【図３Ａ】
2013533467.tif 000016
【図３Ｂ】
2013533467.tif 000017
【図４】
2013533467.tif 000018
【図５】
2013533467.tif 000019
【図６】
2013533467.tif 000020
【図７Ａ】
2013533467.tif 000021
【図７Ｂ】
2013533467.tif 000022
【図７Ｃ】
2013533467.tif 000023
【図８】
2013533467.tif 000024
【国際調査報告】
2013533467.tif 000025
2013533467.tif 000026
2013533467.tif 000027