JP6965253B2 - 視覚慣性オドメトリおよび衛星測位システムの基準フレームのアラインメント - Google Patents

視覚慣性オドメトリおよび衛星測位システムの基準フレームのアラインメント Download PDF

Info

Publication number
JP6965253B2
JP6965253B2 JP2018540043A JP2018540043A JP6965253B2 JP 6965253 B2 JP6965253 B2 JP 6965253B2 JP 2018540043 A JP2018540043 A JP 2018540043A JP 2018540043 A JP2018540043 A JP 2018540043A JP 6965253 B2 JP6965253 B2 JP 6965253B2
Authority
JP
Japan
Prior art keywords
sps
measurements
vio
reference frame
mobile platform
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
JP2018540043A
Other languages
English (en)
Other versions
JP2019509475A (ja
JP2019509475A5 (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.)
Qualcomm Inc
Original Assignee
Qualcomm Inc
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 Qualcomm Inc filed Critical Qualcomm Inc
Publication of JP2019509475A publication Critical patent/JP2019509475A/ja
Publication of JP2019509475A5 publication Critical patent/JP2019509475A5/ja
Application granted granted Critical
Publication of JP6965253B2 publication Critical patent/JP6965253B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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/53Determining attitude
    • 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/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • 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/1656Navigation; 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 passive imaging devices, e.g. cameras
    • 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
    • G01S11/00Systems for determining distance or velocity not using reflection or reradiation
    • G01S11/12Systems for determining distance or velocity not using reflection or reradiation using electromagnetic waves other than radio waves
    • 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
    • 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
    • G01S19/485Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an optical system or imaging system
    • 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/52Determining velocity
    • 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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/16Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
    • G01S5/163Determination of attitude

Landscapes

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

Description

[0001]本開示は、一般に衛星測位システム(SPS)の使用に関し、具体的には、SPS基準フレームとの視覚慣性オドメトリ(VIO:visual inertial odometry)基準フレームのアラインメント(alignment)に関するが、これに限定されるものではない。
[0002]モバイルプラットフォームは、モバイルプラットフォームの動きおよび/または位置ロケーション検知(motion and/or position location sensing)に関連付けられた、ますます高度化した能力を提供する。例えば、個人的生産性、協調コミュニケーション、ソーシャルネットワーキング、および/またはデータ収集に関連したそれらのような、新しいソフトウェアアプリケーションは、消費者に新しい機能(feature)およびサービスを提供するために、動きおよび/または位置センサを利用し得る。
[0003]このような動きおよび/または位置決定能力は、衛星測位システム(SPS)を使用して提供され得る。しかしながら、SPS測定値(SPS measurements)に基づく位置決定は、およそ数メートルの固有誤差を有する可能性がある。このような正確度(accuracy)は、ある特定のアプリケーションには十分でない可能性がある。モバイルプラットフォームでは、位置の正確度は、他の利用可能なセンサ/システムを用いて、SPSから導出された測定値を補強すること(augmenting)によって改善され得る。例えば、ビークル中に含まれるSPSについての位置決定は、機械式オドメータによって補われ得る。機械式オドメータは、経時的なビークルの位置における変化を推定するために、ロータリエンコーダのような、アクチュエータの移動(movement)からオドメトリデータを提供し得る。その後、オドメトリデータは、位置決定を改善するために、SPSデータと組み合わされ得る。しかしながら、機械式オドメータは、ビークルの車輪が道路/表面上でスリップして滑り、車輪の回転に基づくオドメータのデータと比較して、不均一な走行距離を生じ得るので、精度(precision)の問題に苦しむ可能性がある。この誤差は、ビークルが、なだらかでない表面上で動作するときに、度合いを増し(compounded)得る。このような機械式オドメータのデータは、これらの誤差が経時的に蓄積され、度合いを増すにつれて、ますます信頼性がなくなり得る。
[0004]以下は、衛星測位システム(SPS)基準フレームと視覚慣性オドメトリ(VIO)基準フレームをアライン(align)するための、ここで開示されるメカニズムに関連付けられた1つまたは複数の態様および/または実施形態に関する簡略化された概要を提示する。したがって、以下の概要は、全ての企図される態様および/または実施形態に関する広範な概観であると考えられるべきではなく、また、以下の概要は、全ての企図される態様および/または実施形態に関する主要または重要な要素を識別するようにも、または任意の特定の態様および/または実施形態に関連付けられた範囲を線引きするようにも、見なされるべきでない。したがって、以下の概要は、以下で提示される詳細な説明に先立って、簡略化された形式で、衛星測位システム(SPS)基準フレームと視覚慣性オドメトリ(VIO)基準フレームをアラインするための、ここで開示されるメカニズムに関する1つまたは複数の態様および/または実施形態に関するある特定の概念を提示する。
[0005]一態様によると、視覚慣性オドメトリ(VIO)および衛星測位システム(SPS)の基準フレームをアラインするための方法が、SPSから、モバイルプラットフォームの複数のレンジレート測定値(range-rate measurements)を取得することを含む。レンジレート測定値は、SPSのグローバル基準フレームに関するものである(with respect to)。方法はまた、VIOシステムから、モバイルプラットフォームの複数のVIO速度測定値を取得することを含む。VIO速度測定値は、VIOシステムのローカル基準フレームに関するものである。その後、少なくとも1つのオリエンテーションパラメータ(orientation parameter)が、レンジレート測定値とVIO速度測定値とに基づいて、グローバル基準フレームとローカル基準フレームをアラインするために決定される。
[0006]別の態様によると、視覚慣性オドメトリ(VIO)および衛星測位システム(SPS)の基準フレームをアラインするための装置が、衛星測位システム(SPS)から、モバイルプラットフォームの複数のレンジレート測定値を取得するための手段を含み、ここで、複数のレンジレート測定値は、SPSのグローバル基準フレームに関するものである。装置はまた、視覚慣性オドメトリ(VIO)システムから、モバイルプラットフォームの複数のVIO速度測定値を取得するための手段を含み、ここで、複数のVIO速度測定値は、VIOシステムのローカル基準フレームに関するものである。装置は、複数のレンジレート測定値と複数のVIO速度測定値とに基づいて、グローバル基準フレームとローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定するための手段をさらに含む。
[0007]なお別の態様によると、視覚慣性オドメトリ(VIO)および衛星測位システム(SPS)の基準フレームをアラインするための装置が、少なくとも1つのプロセッサと、少なくとも1つのプロセッサに結合された少なくとも1つのメモリとを含む。少なくとも1つのプロセッサおよび少なくとも1つのメモリは、装置に、(i)衛星測位システム(SPS)から、モバイルプラットフォームの複数のレンジレート測定値を取得することと、ここで、複数のレンジレート測定値は、SPSのグローバル基準フレームに関するものである、(ii)視覚慣性オドメトリ(VIO)システムから、モバイルプラットフォームの複数のVIO速度測定値を取得することと、ここで、複数のVIO速度測定値は、VIOシステムのローカル基準フレームに関するものである、(iii)複数のレンジレート測定値と複数のVIO速度測定値とに基づいて、グローバル基準フレームとローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定することと、を行うように指示するように構成される。
[0008]別の態様によると、非一時的なコンピュータ可読記憶媒体が、その上に記録されたコンピュータ実行可能命令を含む。1つまたは複数のプロセッサ上でコンピュータ実行可能命令を実行することは、1つまたは複数のプロセッサに、(i)衛星測位システム(SPS)から、モバイルプラットフォームの複数のレンジレート測定値を取得することと、ここで、複数のレンジレート測定値は、SPSのグローバル基準フレームに関するものである、(ii)視覚慣性オドメトリ(VIO)システムから、モバイルプラットフォームの複数のVIO速度測定値を取得することと、ここで、複数のVIO速度測定値は、VIOシステムのローカル基準フレームに関するものである、(iii)複数のレンジレート測定値と複数のVIO速度測定値とに基づいて、グローバル基準フレームとローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定することと、を行わせる。
[0009]ここで説明される衛星測位システム(SPS)基準フレームと視覚慣性オドメトリ(VIO)基準フレームをアラインするための、ここで開示されるメカニズムに関連付けられた他の目的および利点が、添付の図面および詳細な説明に基づいて、当業者には明らかになるであろう。
[0010]本開示の態様およびそれに付随する利点の多くについてのより完全な理解は、本開示の限定ではなく例示のためだけに提示される添付の図面に関連して考慮されるとき、以下の詳細な説明を参照することによって同内容がより良く理解されるようになるので、容易に得られるであろう。
[0011]図1は、本開示の一態様による、1つまたは複数の技法を使用して位置を決定し得るモバイルプラットフォームのための例となる動作環境を例示する。 [0012]図2は、本開示の一態様による、1つまたは複数の技法を使用して位置を決定し得る動作環境において使用され得る例となるモバイルプラットフォームを例示する。 [0013]図3は、本開示の一態様による、衛星測位システム(SPS)基準フレームと視覚慣性オドメトリ(VIO)基準フレームをアラインする例となるプロセスを例示する。 [0014]図4は、本開示の一態様による、複数の時間エポックに関するスライドする時間ウィンドウ(sliding window of time)を例示する。 [0015]図5は、ここで教示されるような衛星測位システム(SPS)基準フレームとの視覚慣性オドメトリ(VIO)基準フレームのアラインメントをサポートするように構成されたモバイルプラットフォームにおいて用いられ得るコンポーネントのいくつかのサンプル態様を例示する。
詳細な説明
[0016]様々な態様が、以下の説明および関連する図面において開示される。代替の態様が、本開示の範囲から逸脱することなく考案され得る。加えて、本開示の周知の要素は、本開示に関連する詳細を不明瞭にしないように、詳細には説明されないか、または省略される。
[0017]「例示的(exemplary)」および/または「例(example)」という用語は、ここで、「例、事例、または例示を提供する」という意味で使用される。「例示的」および/または「例」としてここで説明される任意の態様は、必ずしも他の態様よりも好ましいまたは有利であるようには解釈されるべきでない。同様に、「本開示の態様」という用語は、本開示の全ての態様が、説明される特徴(feature)、利点または動作モードを含むことを必要としない。
[0018]ここで使用される専門用語は、特定の実施形態を説明することのみを目的としたものであり、ここで開示される任意の実施形態を限定するものではない。ここで使用される場合、単数形「a」、「an」および「the」は、文脈がそうでないことを明確に示していない限り、複数形も含むように意図される。ここで使用される場合、「備える(comprises)」、「備える(comprising)」、「含む(includes)」および/または「含む(including)」という用語は、述べられる特徴、整数、ステップ、動作、要素、および/またはコンポーネントの存在を規定するが、1つまたは複数の他の特徴、整数、ステップ、動作、要素、コンポーネント、および/またはそのグループの存在または追加を除外しないことがさらに理解されるであろう。
[0019]さらに、多くの態様は、例えば、コンピューティングデバイスの要素によって実行されるべき一連のアクションの観点から説明される。ここで説明される様々なアクションは、特定の回路(例えば、特定用途向け集積回路(ASIC))によって、1つまたは複数のプロセッサによって実行されているプログラム命令によって、または両方の組合せによって実行され得ることが認識されるであろう。加えて、ここで説明されるこれら一連のアクションは、実行時に、ここで説明される機能を関連するプロセッサに実行させるコンピュータ命令の対応するセットをその中に記憶した任意の形態のコンピュータ可読記憶媒体内で、全体として具現化されるものであると考えられ得る。したがって、本開示の様々な態様は、いくつかの異なる形態で具現化され得、それらの全てが、請求項に記載の事項の範囲内にあるものとして企図されている。加えて、ここで説明される態様の各々について、任意のそのような態様の対応する形態は、例えば、説明されるアクションを実行する「ように構成されたロジック」としてここで説明され得る。
[0020]本開示の一態様によると、図1は、1つまたは複数の技法を使用してその位置を決定し得るモバイルプラットフォーム108のための例示的な動作環境100を例示する。実施形態は、衛星測位システム(SPS)114と視覚慣性オドメータ(VIO)システム116との両方からのデータを利用してその位置を決定し得るモバイルプラットフォーム108に向けられる。SPS114によって生成されるSPS測定値124は、モバイルプラットフォーム108の速度を表す1つまたは複数のSPS速度測定値および/または1つまたは複数のレンジレート測定値(例えば、GPSドップラー測定値)を含み得る。
[0021]VIOシステム116は、モバイルプラットフォーム108の相対的な位置、速度、加速度、および/またはオリエンテーションを推定するために、カメラ118によってキャプチャされるいくつかの連続的な画像(sequential images)120を利用する。カメラ118は、単一の単眼カメラ、ステレオカメラ、および/または全方位カメラ(omnidirectional camera)を含み得る。動作中、VIOシステム116は、VIO速度測定値128を生成するために、カメラ118によって生成される画像120を獲得する。一態様では、VIOシステム116は、画像120に対して1つまたは複数の画像処理技法を適用し、1つまたは複数の特徴を検出し、オプティカルフローを構築(construct)するために、複数のフレームにわたってそれらの特徴をマッチさせ(match)、オプティカルフローに基づいて、モバイルプラットフォーム108の動きを推定し得る。その後、VIOシステム116は、推定された動きに基づいて、モバイルプラットフォーム108の推定された速度を表すVIO速度測定値128を生成する。
[0022]SPS測定値124とVIO速度測定値128を組み合わせることによって、モバイルプラットフォーム108は、モバイルプラットフォーム108の位置決定の正確度を増大させ得る。しかしながら、SPS測定値124およびVIO速度測定値128は、別個の座標系に関してそれぞれ作成され(each made with respect to)得る。例えば、SPS測定値124は、GPSで使用されるWGS84座標系のような、地球中心地球固定(ECEF:Earth-Centered, Earth-Fixed)座標系のような、グローバル基準フレーム126に関するものであり得、一方、VIO速度測定値128は、別個のローカル基準フレーム130に関するものであり得る。グローバル基準フレーム126は、同じ衛星測位ネットワークを使用する任意のシステムに共通しおよび既知であり得る一方で、ローカル基準フレーム130は、モバイルプラットフォーム108の特定のオリエンテーションに部分的に依存し得る。すなわち、ローカル基準フレーム130は、環境100内のモバイルプラットフォーム108の位置および/またはオリエンテーションに依存して変化し得る。したがって、SPS測定値124とVIO速度測定値128を組み合わせるために、モバイルプラットフォーム108は、グローバル基準フレーム126とローカル基準フレーム130をアラインし得る。一態様では、モバイルプラットフォーム108は、SPS測定値124およびVIO速度測定値128のみに基づいて、グローバル基準フレーム126とローカル基準フレーム130をアラインするために、1つまたは複数のオリエンテーションパラメータ(例えば、回転行列)を決定する。これらおよび他の態様が、以下でより詳細に説明される。
[0023]動作環境100は、1つまたは複数の異なるタイプのワイヤレス通信システムおよび/またはワイヤレス測位システムを含み得る。図1に示される実施形態では、1つまたは複数の衛星測位システム(SPS)衛星102a、102bが、モバイルプラットフォーム108のための位置情報の独立したソースとして使用され得る。モバイルプラットフォーム108のSPS114は、特にSPS衛星102a、102bからジオロケーション情報を導出するための信号を受信するように設計された、1つまたは複数の専用SPS受信機を含み得る。
[0024]動作環境100はまた、1つまたは複数のワイドエリアネットワークワイヤレスアクセスポイント(WAN−WAP)104a、104b、104cを含み得、これらは、ワイヤレス音声および/またはデータ通信のために、およびモバイルプラットフォーム108のための独立した位置情報の別のソースとして、使用され得る。WAN−WAP 104a−104cは、既知のロケーションにおけるセルラ基地局を含み得るワイドエリアワイヤレスネットワーク(WWAN)、および/または、例えば、WiMAX(Worldwide Interoperability for Microwave Access)(例えば、IEEE802.16)のような、他のワイドエリアワイヤレスシステムの一部であり得る。WWANは、他の既知のネットワークコンポーネントを含み得、それらは簡潔さのために図1には示されていない。典型的に、WWAN内のWAN−WAP 104a−104cの各々は、固定された位置から動作し、大都市エリアおよび/または地方エリアにわたってネットワークカバレッジを提供し得る。
[0025]動作環境100は、1つまたは複数のローカルエリアネットワークワイヤレスアクセスポイント(LAN−WAP)106a、106b、106cをさらに含み得、これらは、ワイヤレス音声および/またはデータ通信のために、ならびに位置データの別の独立したソースとして、使用され得る。LAN−WAPは、ワイヤレスローカルエリアネットワーク(WLAN)の一部であり得、これは、建物内で動作し、WWANよりも小さい地理的領域にわたって通信を実行し得る。このようなLAN−WAP 106a−106cは、例えば、Wi−Fiネットワーク(802.11x)、セルラピコネットおよび/またはフェムトセル、Bluetooth(登録商標)ネットワーク、等の一部であり得る。
[0026]モバイルプラットフォーム108は、SPS衛星102a、102b、WAN−WAP 104a−104c、および/またはLAN−WAP 106a−106cのうちの任意の1つまたは複数から位置情報を導出し得る。前述のシステムの各々は、異なる技法を使用して、モバイルプラットフォーム108についての位置の独立した推定を提供し得る。いくつかの実施形態では、モバイルプラットフォーム108は、位置データの正確度を改善するために、異なるタイプのアクセスポイントの各々から導出される解(solutions)を組み合わせ得る。SPS衛星102a、102bを使用して位置を導出するとき、モバイルプラットフォーム108は、SPS衛星102a、102bによって送信された複数の信号から、従来の技法を使用して、位置を抽出する、特にSPSとの使用のために設計された受信機を利用し得る。
[0027]SPS衛星102aおよび102bは、典型的に、エンティティが、送信機から受信される信号に少なくとも部分的に基づいて、地球上または地球上空でのそれらのロケーションを決定することを可能にするように配置された送信機のシステムを含む衛星システムの一部である。このような送信機は、典型的に、設定されたチップ数の繰り返し疑似ランダム雑音(PN)コードによりマーク付けされた(marked)信号を送信し、地上の制御局、ユーザ機器および/または宇宙ビークル上に位置し得る。特定の例では、このような送信機は、地球周回衛星ビークル(SV)上に位置し得る。例えば、全地球測位システム(GPS)、ガリレオ、グロナスまたはコンパスのような全地球航法衛星システム(GNSS)のコンステレーションにおけるSVは、(例えば、GPSの場合のように、衛星ごとに異なるPNコードを使用して、または、グロナスの場合のように、異なる周波数上で同じコードを使用して)コンステレーションにおける他のSVによって送信されるPNコードとは区別可能であるPNコードによりマーク付けされた信号を送信し得る。ある特定の態様によると、ここで提示される技法は、SPSのための全地球システム(例えば、GNSS)に限定されない。例えば、ここで提供される技法は、例えば、日本上空の準天頂衛星システム(QZSS)、インド上空のインド地域航法衛星システム(IRNSS)、中国上空の北斗、等のような、様々な地域システム、および/または、1つまたは複数の全地球および/または地域航法衛星システムに関連付けられるか、さもなければ、それらでの使用のために使用可能にされ(enabled for use with)得る様々な補強システム(例えば、静止衛星型衛星航法補強システム(SBAS))に適用されるか、さもなければ、それらにおける使用のために使用可能にされ得る。限定ではなく例として、SBASは、例えば、ワイドエリア補強システム(WAAS)、欧州静止衛星航法オーバレイサービス(EGNOS)、運輸多目的衛星用衛星航法補強システム(MSAS)、GPS支援静止衛星補強航法またはGPSおよび静止衛星補強航法システム(GAGAN)、および/または同様のもののような、インテグリティ情報、ディファレンシャル補正、等を提供する(1つまたは複数の)補強システムを含み得る。したがって、ここで使用される場合、ここで使用される衛星システムは、1つまたは複数の全地球および/または地域航法衛星システムおよび/または補強システムの任意の組合せを含み得、SPS信号は、SPS信号、SPSのような(SPS-like)信号、および/またはこのような1つまたは複数のSPSに関連付けられた他の信号を含み得る。
[0028]さらに、開示される方法および装置は、疑似衛星または衛星と疑似衛星の組合せを利用する測位決定システム(positioning determination systems)で使用され得る。疑似衛星は、GPS時間と同期され得る、L帯域(または他の周波数)搬送波信号上で変調されるPNコードまたは(GPSまたはCDMAセルラ信号に類似した)他のレンジングコードをブロードキャストする地上の送信機である。各このような送信機は、遠隔受信機による識別を許可するために、一意のPNコードを割り当てられ得る。疑似衛星は、トンネル、鉱山、建物、都市ビルの谷間または他の囲まれたエリア内のような、軌道を周回する衛星からのGPS信号が利用できないことがある状況において有用である。疑似衛星の別のインプリメンテーションが、無線ビーコンとして知られている。ここで使用される場合、「衛星」という用語は、疑似衛星、疑似衛星の同等物、および場合によっては他のものを含むように意図される。ここで使用される場合、「SPS信号」という用語は、疑似衛星または疑似衛星の同等物からのSPSのような信号を含むように意図される。
[0029]WWANから位置を導出するとき、各WAN−WAP 104a−104cは、デジタルセルラネットワーク内の基地局の形態をとり得、モバイルプラットフォーム108は、位置を導出するために基地局信号を活用し得るセルラトランシーバおよびプロセッサを含み得る。このようなセルラネットワークは、それに限定されるものではないが、GSM(登録商標)、CMDA、2G、3G、4G、LTE(登録商標)、等に準拠した規格を含み得る。デジタルセルラネットワークは、図1に示されていない場合がある追加の基地局または他のリソースを含み得ることが理解されるべきである。WAN−WAP 104a−104cは、実際には、可動であるか、さもなければ、再配置されることが可能であり得る一方で、例示を目的として、それらは、本質的に固定された位置において配置されていると仮定される。
[0030]モバイルプラットフォーム108は、例えば、アドバンスド順方向リンク三辺測量(AFLT:Advanced Forward Link Trilateration)のような、既知の到着時間(TOA)技法を使用して、位置決定を実行し得る。他の実施形態では、各WAN−WAP 104a−104cは、WiMAXワイヤレスネットワーキング基地局を備え得る。このケースでは、モバイルプラットフォーム108は、WAN−WAP 104a−104cによって提供される信号から、TOA技法を使用してその位置を決定し得る。モバイルプラットフォーム108は、TOA技法を使用して、測位サーバ110およびネットワーク112の支援を使用して、またはスタンドアロンモードでのいずれかで、位置を決定し得る。さらに、様々な実施形態は、モバイルプラットフォーム108に、異なるタイプを有し得るWAN−WAP 104a−104cを使用して位置情報を決定させ得る。例えば、いくつかのWAN−WAP 104a−104cは、セルラ基地局であり得、他のWAN−WAP 104a−104cは、WiMAX基地局であり得る。このような動作環境では、モバイルプラットフォーム108は、各異なるタイプのWAN−WAP 104a−104cからの信号を活用することが可能であり、正確度を改善するために、導出された位置の解をさらに組み合わせ得る。
[0031]WLANを使用して位置を導出するとき、モバイルプラットフォーム108は、測位サーバ110およびネットワーク112の支援を得て、TOA技法を利用し得る。測位サーバ110は、ネットワーク112を通じてモバイルプラットフォーム108に通信し得る。ネットワーク112は、LAN−WAP 106a−106cを組み込んだワイヤードおよびワイヤレスネットワークの組合せを含み得る。一実施形態では、各LAN−WAP 106a−106cは、例えば、Wi−Fiワイヤレスアクセスポイントであり得、それは、必ずしも固定された位置にセットされているとは限らず、ロケーションを変え得る。各LAN−WAP 106a−106cの位置は、共通の座標系において、測位サーバ110に記憶され得る。一実施形態では、モバイルプラットフォーム108の位置は、モバイルプラットフォーム108に、各LAN−WAP 106a−106cからの信号を受信させることによって決定され得る。各信号は、(例えば、MACアドレスのような)受信された信号に含まれ得る何らかの形式の識別情報に基づいて、その発信LAN−WAPに関連付けられ得る。その後、モバイルプラットフォーム108は、信号強度に基づいて、受信された信号をソートし、ソートされた受信された信号の各々に関連付けられた時間遅延を導出し得る。その後、モバイルプラットフォーム108は、LAN−WAPの各々の識別情報と時間遅延とを含み得るメッセージを形成し、測位サーバ110にネットワーク112を介してメッセージを送り得る。受信されたメッセージに基づいて、その後、測位サーバ110は、モバイルプラットフォーム108の、関連のあるLAN−WAP 106a−106cの記憶されたロケーションを使用して、位置を決定し得る。測位サーバ110は、ローカル座標系におけるモバイルプラットフォーム108の位置へのポインタを含む、モバイルプラットフォーム108へのロケーション構成インジケーション(LCI:Location Configuration Indication)メッセージを生成および提供し得る。LCIメッセージはまた、モバイルプラットフォーム108のロケーションに関連した他の関心地点(points of interest)を含み得る。モバイルプラットフォーム108の位置を計算するとき、測位サーバ110は、ワイヤレスネットワーク内の要素によって導入され得る異なる遅延を考慮し得る。
[0032]上記で説明された位置決定技法は、WWAN、WLAN、ワイヤレスパーソナルエリアネットワーク(WPAN)、等のような、様々なワイヤレス通信ネットワークのために使用され得る。「ネットワーク」および「システム」という用語は、交換可能に使用され得る。WWANは、符号分割多元接続(CDMA)ネットワーク、時分割多元接続(TDMA)ネットワーク、周波数分割多元接続(FDMA)ネットワーク、直交周波数分割多元接続(OFDMA)ネットワーク、シングルキャリア周波数分割多元接続(SC−FDMA)ネットワーク、WiMAX(IEEE802.16)ネットワーク、等であり得る。CDMAネットワークは、cdma2000、広帯域CDMA(W−CDMA(登録商標))、等のような1つまたは複数の無線アクセス技術(RAT)をインプリメントし得る。cdma2000は、IS−95、IS−2000、およびIS−856規格を含む。TDMAネットワークは、モバイル通信のためのグローバルシステム(GSM)、デジタルアドバンスドモバイル電話システム(D−AMPS)、または何らかの他のRATをインプリメントし得る。GSMおよびW−CDMAは、「第3世代パートナーシッププロジェクト」(3GPP(登録商標))という名称のコンソーシアムからの文書に説明されている。cdma2000は、「第3世代パートナーシッププロジェクト2」(3GPP2)という名称のコンソーシアムからの文書に説明されている。3GPPおよび3GPP2の文書は、公に入手可能である。WLANは、IEEE802.11xネットワークであり得、WPANは、Bluetoothネットワーク、IEEE802.15x、または何らかの他のタイプのネットワークであり得る。技法はまた、WWAN、WLANおよび/またはWPANの任意の組合せのために使用され得る。
[0033]ここで使用される場合、モバイルプラットフォーム108は、ビークル(有人または無人)、ロボット、セルラまたは他のワイヤレス通信デバイス、パーソナル通信システム(PCS)デバイス、パーソナルナビゲーションデバイス、パーソナル情報マネージャ(PIM)、携帯情報端末(PDA)、ラップトップ、または画像をキャプチャすることおよび内部センサ(internal sensors)を使用してナビゲートすることが可能な他の適切なモバイルデバイスのようなデバイスであり得る。「モバイルプラットフォーム」という用語はまた、衛星信号受信、支援データ受信、および/または位置関連処理が、デバイスにおいて行われるか、PNDにおいて行われるかにかかわらず、短距離ワイヤレス、赤外線、ワイヤライン接続、または他の接続等によって、パーソナルナビゲーションデバイス(PND)と通信するデバイスを含むように意図される。また、「モバイルプラットフォーム」は、ワイヤレス通信デバイス、コンピュータ、ラップトップ、等を含む、全てのデバイスを含むように意図され、それらは、衛星信号受信、支援データ受信、および/または位置関連処理が、デバイスにおいて行われるか、サーバにおいて行われるか、またはネットワークに関連付けられた別のデバイスにおいて行われるかにかかわらず、インターネット、Wi−Fi、または他のネットワーク等を介して、サーバと通信することが可能である。上記の任意の動作可能な組合せもまた、「モバイルプラットフォーム」と見なされる。
[0034]さらに、一実施形態では、モバイルプラットフォーム108は、モバイルプラットフォーム108が、それ自体、ビークルによって取得された(obtained by the vehicle, itself)VIO速度測定値および/またはSPS測定値124を読み取ることを可能にする1つまたは複数の通信インターフェース(例えば、Bluetoothインターフェース、RFアンテナ、ワイヤード接続、等)を通じてビークルに適切にリンクされ得る。さらに、モバイルプラットフォーム108とビークルとの間の通信をサポートするアプリケーションプログラムインターフェース(API)が、ビークルによって取得された、VIO速度測定値128および/またはSPS測定値124を、モバイルプラットフォーム108に利用可能にし得る。
[0035]図2は、本開示の一態様による、1つまたは複数の技法を使用して位置を決定し得る動作環境100において使用され得る例となるモバイルプラットフォーム200を例示する。モバイルプラットフォーム200は、図1のモバイルプラットフォーム108の1つの可能なインプリメンテーションである。
[0036]図2の図において例示される様々な特徴および機能(functions)は、共通データバス224を使用して共に接続されており、これは、これらの様々な特徴および機能が、共に動作可能に結合されていることを表すように意図される。当業者であれば、他の接続、メカニズム、特徴、機能、または同様のものが、実際のポータブルデバイスを動作可能に結合および構成するために、必要に応じて提供および適合され得ることを認識するであろう。さらに、図2の例において例示される特徴または機能のうちの1つまたは複数がさらに再分割され得、または、図2に例示される特徴または機能のうちの2つ以上が組み合わされ得ることもまた認識される。
[0037]モバイルプラットフォーム200は、1つまたは複数のアンテナ240に接続され得る1つまたは複数のワイヤレストランシーバ202を含み得る。ワイヤレストランシーバ202は、WAN−WAP 104a−104cと通信するおよび/またはWAN−WAP 104a−104cへの/からの信号を検出するための、および/またはネットワーク内の他のワイヤレスデバイスと直接的に通信するための、適切なデバイス、ハードウェア、および/またはソフトウェアを含み得る。例えば、ワイヤレストランシーバ202は、ワイヤレス基地局のCDMAネットワークと通信するのに適切なCDMA通信システムを備え得るが、しかしながら、他の態様では、ワイヤレス通信システムは、例えば、TDMAまたはGSMのような、別のタイプのセルラ電話ネットワークを備え得る。加えて、例えば、WiMAX(IEEE802.16)、等のその他任意のタイプのワイドエリアワイヤレスネットワーキング技術が使用され得る。ワイヤレストランシーバ202はまた、1つまたは複数のアンテナ240に接続され得る1つまたは複数のローカルエリアネットワーク(LAN)トランシーバを含み得る。例えば、ワイヤレストランシーバ202は、LAN−WAP 106a−106cと通信するおよび/またはLAN−WAP 106a−106cへの/からの信号を検出するための、および/またはネットワーク内の他のワイヤレスデバイスと直接的に通信するための、適切なデバイス、ハードウェア、および/またはソフトウェアを含み得る。一態様では、ワイヤレストランシーバ202は、1つまたは複数のワイヤレスアクセスポイントと通信するのに適切なWi−Fi(802.11x)通信システムを含み得るが、しかしながら、他の態様では、ワイヤレストランシーバ202は、別のタイプのローカルエリアネットワーク、パーソナルエリアネットワーク、(例えば、Bluetooth)を備える。加えて、例えば、ウルトラワイドバンド、ZigBee、ワイヤレスUSB、等のその他任意のタイプのワイヤレスネットワーキング技術が使用され得る。
[0038]ここで使用される場合、「ワイヤレスアクセスポイント」(WAP)という省略された用語は、LAN−WAP 106a−106cおよび/またはWAN−WAP 104a−104cを指すために使用され得る。具体的には、「WAP」という用語が使用されるとき、実施形態は、複数のLAN−WAP 106a−106c、複数のWAN−WAP 104a−104c、またはこれら2つの任意の組合せからの信号を活用し得るモバイルプラットフォーム200を含み得ることが理解されるべきである。モバイルプラットフォーム200によって利用されている特定のタイプのWAPは、動作の環境に依存し得る。さらに、モバイルプラットフォーム200は、正確な位置の解に到達するために、様々なタイプのWAPの間で動的に選択し得る。他の実施形態では、様々なネットワーク要素は、ピアツーピア方式で動作し得、それによって、例えば、モバイルプラットフォーム200は、WAPと置き換えられ得るか、あるいは、その逆も同様である。他のピアツーピアの実施形態は、1つまたは複数のWAPの代わりに機能する別のモバイルプラットフォーム(図示せず)を含み得る。
[0039]図2に示されるように、モバイルプラットフォーム200はまた、カメラ204を含み得る。カメラ204は、単一の単眼カメラ、ステレオカメラ、および/または全方位カメラであり得る。一態様では、カメラ204は、カメラパラメータ(例えば、焦点距離、光学的中心のずれ、半径方向の歪み(radial distortion)、接線方向の歪み(tangential distortion)、等)が知られているように、較正される。カメラ204は、制御ユニット210に画像244を提供するために、制御ユニット210に結合される。
[0040]モバイルプラットフォーム200の例示された例はまた、動きセンサ206を含む。動きセンサ206は、ワイヤレストランシーバ202、SPS208、およびVIOシステム226によって受信される信号から導出される動きデータとは独立している移動および/またはオリエンテーション情報を提供するために、制御ユニット210に結合され得る。
[0041]例として、動きセンサ206は、加速度計(例えば、MEMSデバイス)、ジャイロスコープ、地磁気センサ(例えば、コンパス)、高度計(例えば、気圧高度計)、および/またはその他任意のタイプの移動検出センサを含み得る。さらに、動きセンサ206は、複数の異なるタイプのデバイスを含み、動き情報を提供するために、それらの出力を組み合わせ得る。例えば、動きセンサ206は、2Dおよび/または3D座標系における位置を計算する能力を提供するために、多軸加速度計およびオリエンテーションセンサの組合せを使用し得る。
[0042]衛星測位システム(SPS)208はまた、モバイルプラットフォーム200中に含まれ得る。SPS208は、衛星信号を受信するための1つまたは複数のアンテナ242に接続され得る。SPS208は、SPS信号を受信および処理するための任意の適切なハードウェアおよび/またはソフトウェアを備え得る。SPS208は、他のシステムから、適宜、情報および動作を要求し、任意の適切なSPSアルゴリズムによって取得される測定値を使用して、モバイルプラットフォーム200の位置を決定するために必要な計算を実行する。一態様では、SPS208は、制御ユニット210に1つまたは複数のSPS測定値246を提供するために、制御ユニット210に結合される。一例では、SPS測定値246は、GPSドップラーレンジレート測定値のような、レンジレート測定値である。別の例では、SPS208は、SPS測定値246がSPS速度測定値であるように、レンジレート測定値に基づいて、モバイルプラットフォーム200のSPS速度を決定するように構成される。すなわち、SPS測定値246は、レンジレート測定値だけ(by themselves)、SPS速度測定値だけ、および/またはこれら2つの任意の組合せを含み得る。
[0043]モバイルプラットフォーム200はまた、存在する場合には、ユーザインターフェース212、SPS208、動きセンサ206、カメラ204、およびワイヤレストランシーバ202に接続されかつそれらと通信する制御ユニット210を含む。一態様では、制御ユニット210は、カメラ204から受信される画像244のみならず、SPS208から受信されるSPS測定値246を受け取って、処理する。制御ユニット210は、プロセッサ214、関連付けられたメモリ220、ハードウェア216、ファームウェア218、およびソフトウェア222によって提供され得る。
[0044]プロセッサ214は、処理機能のみならず、他の計算および制御機能を提供する1つまたは複数のマイクロプロセッサ、マイクロコントローラ、および/またはデジタルシグナルプロセッサを含み得る。プロセッサ214はまた、モバイルプラットフォーム200内でプログラムされた機能を実行するためのソフトウェア命令およびデータを記憶するためのメモリ220を含み得る。メモリ220は、プロセッサ214の基板上(例えば、同じICパッケージ内)に存在し得、および/または、メモリは、プロセッサ214の外部メモリであり、データバス224を通して機能的に結合され得る。本開示の態様に関連付けられた機能的な詳細は、以下でより詳細に説明される。
[0045]制御ユニット210は、視覚慣性オドメトリ(VIO)システム226、測位モジュール228、位置データベース230、およびアプリケーションモジュール232をさらに含み得る。VIOシステム226は、カメラ204から受信される画像244に応答して、VIO速度測定値248を生成するように構成され得る。測位モジュール228は、1つまたは複数の測位技法に基づいて、モバイルプラットフォームの位置を決定するように構成され得る。以下でより詳細に説明されるように、測位モジュール228は、SPS測定値246とVIO速度測定値248を組み合わせることによって、モバイルプラットフォーム200の位置を決定するように構成され得る。位置データベース232は、モバイルプラットフォーム200の位置および/またはオリエンテーションを記憶および更新するように構成され得る。すなわち、制御ユニット210がモバイルプラットフォーム200の新しい位置および/またはオリエンテーションを決定するたびに、位置データベース230は更新され得る。その後、更新された位置およびオリエンテーション情報は、例えば、ディスプレイ238上に新しい位置を有するデジタルマップを表示させることによって、または、ディスプレイ上におよび/またはスピーカ234を介して、追加のナビゲーション命令を提供することによって、提供され得る。
[0046]アプリケーションモジュール232は、モバイルプラットフォーム200のプロセッサ214で実行中のプロセスであり得、それは、測位モジュール228から位置情報を要求する。アプリケーションは、典型的に、ソフトウェアアーキテクチャの上位層内で実行され、屋内/屋外ナビゲーション、バディロケータ(Buddy Locator)、ショッピングおよびクーポン(Shopping and Coupons)、アセットトラッキング(Asset Tracking)、およびロケーション認識サービス発見(location Aware Service Discovery)を含み得る。
[0047]プロセッサ214、VIOシステム226、測位モジュール228、および位置データベース230は、明確にするために別個に例示されているが、単一のユニットであり得、および/または、プロセッサ214で実行されるソフトウェア222における命令に基づいて、プロセッサ214においてインプリメントされ得る。プロセッサ214、VIOシステム226、測位モジュール228は、1つまたは複数のマイクロプロセッサ、埋め込みプロセッサ、コントローラ、特定用途向け集積回路(ASIC)、デジタルシグナルプロセッサ(DSP)、および同様のもの含み得るが、必ずしもそれらを含む必要があるとは限らない。プロセッサという用語は、特定のハードウェアではなく、システムによってインプリメントされる機能を説明する。さらに、ここで使用される場合、「メモリ」という用語は、モバイルプラットフォーム200に関連付けられた長期、短期、または他のメモリを含む、任意のタイプのコンピュータ記憶媒体を指し、任意の特定のタイプのメモリまたはメモリの数、あるいはメモリが記憶される媒体のタイプに限定されるべきではない。
[0048]ここで説明されるプロセスは、アプリケーションに依存して、様々な手段によってインプリメントされ得る。例えば、これらのプロセスは、ハードウェア216、ファームウェア218、ソフトウェア222との組合せにおけるプロセッサ214、またはこれらの任意の組合せにおいてインプリメントされ得る。ハードウェアインプリメンテーションの場合、プロセッサ214は、1つまたは複数の特定用途向け集積回路(ASIC)、デジタルシグナルプロセッサ(DSP)、デジタル信号処理デバイス(DSPD)、プログラマブル論理デバイス(PLD)、フィールドプログラマブルゲートアレイ(FPGA)、プロセッサ、コントローラ、マイクロコントローラ、マイクロプロセッサ、電子デバイス、ここで説明された機能を実行するように設計された他の電子ユニット、またはこれらの組合せ内でインプリメントされ得る。
[0049]ファームウェアおよび/またはプロセッサ/ソフトウェアインプリメンテーションの場合、プロセスは、ここで説明される機能を実行するモジュール(例えば、プロシージャ、関数(functions)、等)でインプリメントされ得る。命令を有形に具現化する(tangibly embodying)任意の非一時的なコンピュータ可読媒体が、ここで説明されるプロセスをインプリメントする際に使用され得る。例えば、プログラムコードは、メモリ220に記憶され、プロセッサ214によって実行され得る。メモリ220は、プロセッサ214の内部または外部でインプリメントされ得る。
[0050]ファームウェア218および/またはソフトウェア222を用いてプロセッサ214においてインプリメントされる場合、機能は、コンピュータ可読媒体上で1つまたは複数の命令またはコードとして記憶され得る。例には、データ構造で符号化された非一時的なコンピュータ可読媒体、およびコンピュータプログラムで符号化されたコンピュータ可読媒体が含まれる。コンピュータ可読媒体は、物理的なコンピュータ記憶媒体を含む。記憶媒体は、コンピュータによってアクセスされ得る任意の利用可能な媒体であり得る。限定ではなく例として、このようなコンピュータ可読媒体は、RAM、ROM、フラッシュメモリ、EEPROM(登録商標)、CD−ROMまたは他の光ディスク記憶装置、磁気ディスク記憶装置または他の磁気記憶デバイス、あるいは所望のプログラムコードを命令またはデータ構造の形で記憶するために使用され得、かつコンピュータによってアクセスされ得るその他任意の媒体を備え得る。ここで使用される場合、ディスク(disk)およびディスク(disc)は、コンパクトディスク(CD)、レーザーディスク(登録商標)、光ディスク、デジタル多目的ディスク(DVD)、フロッピー(登録商標)ディスクおよびブルーレイディスクを含み、ここで、ディスク(disks)は、通常磁気的にデータを再生し、一方ディスク(discs)は、レーザーを用いて光学的にデータを再生する。上記の組合せもまた、コンピュータ可読媒体の範囲内に含まれるべきである。
[0051]モバイルプラットフォーム200は、モバイルプラットフォーム200とのユーザの対話を可能にするマイクロフォン/スピーカ234、キーパッド236、およびディスプレイ238のような、任意の適切なインターフェースシステムを提供するオプションのユーザインターフェース212を含み得る。マイクロフォン/スピーカ234は、ワイヤレストランシーバ202を使用して、音声通信サービスを提供する。キーパッド236は、ユーザ入力用の任意の適切なボタンを備える。ディスプレイ238は、例えば、バックライト付きのLCDディスプレイのような、任意の適切なディスプレイを備え、追加のユーザ入力モード用のタッチスクリーンディスプレイをさらに含み得る。
[0052]一態様では、モバイルプラットフォーム200は、位置決定の正確度を改善するために、VIO速度測定値248とSPS測定値246を組み合わせることによって、モバイルプラットフォーム200の位置を決定するように構成される。しかしながら、上述されたように、SPS測定値246は、グローバル基準フレーム126に関するものであり得、一方、VIO速度測定値248は、ローカル基準フレーム130に関するものである。したがって、VIO速度測定値248とSPS測定値246を組み合わせるために、モバイルプラットフォーム200は、最初に、グローバル基準フレーム126とローカル基準フレーム130をアラインし得る。一態様では、制御ユニット210の測位モジュール228は、グローバル基準フレーム126とローカル基準フレーム130をアラインするために、回転行列のような、オリエンテーションパラメータを決定するように構成される。一例では、測位モジュール228は、SPS測定値246およびVIO速度測定値248に基づいて、オリエンテーションパラメータを決定する。この推定を実行するための2つのアプローチが以下に提供され、1つは、オリエンテーションパラメータの推定が、SPS208から取得されるSPS速度測定値に基づくものであり、もう1つのアプローチは、推定が、同様にSPS208から取得される未加工の(raw)レンジレート測定値に基づくものである。
[0053]上述されたように、SPS208から取得されるSPS測定値246は、モバイルプラットフォーム200のSPS速度測定値を含み得る。第1のアプローチでは、VIO速度測定値とSPS速度測定値をマッチ(matches)させる「最良の(best)」回転行列が決定され得るように、SPS速度測定値およびVIO速度測定値の両方が経時的に蓄積される(accumulated)。戸外状況では(in an open-sky condition)、SPS速度測定値は、比較的小さい推定誤差(例えば、0:1 m/s)を含み得るので、この例では、SPS速度測定値が使用され得、その結果として(in turn)、測位モジュール228が、オリエンテーションパラメータの非常に信頼性のある推定値を決定することを可能にする。
[0054]代替として、SPS208から取得されるSPS測定値246は、GPSドップラーレンジレート測定値のような、レンジレート測定値を含み得る。したがって、測位モジュール228は、明示的にモバイルプラットフォーム200にSPS速度を求めさせる(solve for the SPS velocities)必要なしに、レンジレート測定値から直接的にオリエンテーションパラメータを決定し得る。一態様では、これは、たとえSPS速度を求めるために、利用可能であるレンジレート測定値が不十分であったとしても、モバイルプラットフォーム200がオリエンテーションパラメータを決定することを可能にする。すなわち、この例では、オリエンテーションパラメータを決定するために測位モジュール228によって使用されるレンジレート測定値の数は、モバイルプラットフォーム200のSPS速度を計算するために必要とされるものよりも少なくなり得る。
[0055]以下で詳細に説明される、グローバル基準フレームとローカル基準フレームをアラインする態様は、著しいパフォーマンス改善を提供し得る半定値緩和技法(semidefinite relaxation technique)と共に、この問題の四元数の再公式化(quaternion reformulation)を組み合わせる。
[0056]図3は、本開示の一態様による、衛星測位システム(SPS)基準フレームと視覚慣性オドメトリ(VIO)基準フレームをアラインする例となるプロセス300を例示する。プロセスブロック302において、測位モジュール228は、SPS208からレンジレート測定値246を取得し、ここで、レンジレート測定値は、グローバル基準フレーム126に関するものである。一態様では、SPS208は、1秒の長さの各エポック中に、異なる衛星からの未加工のレンジレート測定値を提供する。対流圏、電離圏、および衛星クロックのバイアスは、ネットワークデータからか、またはシングルポイントソリューション(single-point solutions)において使用される標準モジュールを通じてかのいずれかで、これらのレンジレート測定値において補正されていると仮定され得る。補正されたレンジレート測定値は、次のようにモデル化され得る:
Figure 0006965253
ここで、
Figure 0006965253
は、衛星s(例えば、衛星102a)からモバイルプラットフォーム200の位置x(t)の粗い推定値
Figure 0006965253
までの単位ベクトルである。v(t)およびv(t)は、それぞれ、モバイルプラットフォーム200および衛星sの速度であり、
Figure 0006965253
は、SPS208の受信機クロックドリフトであり、w(t)は、測定値における他の全てのノイズをキャプチャする。例えば、200m以内の正確度での、このような粗い位置推定値は、標準モデルを使用して計算され得る。
[0057]次に、プロセスブロック304において、測位モジュール228は、VIOシステム226からVIO速度測定値248を取得し、ここで、VIO速度測定値248は、ローカル基準フレーム130に関するものである。VIOシステム226は、VIO速度測定値248を生成するために、カメラ204によって生成される画像244のみならず、動きセンサ206(例えば、加速度計およびジャイロスコープ)のうちの1つまたは複数によって提供されるデータを利用し得る。VIOシステム226によって生成されるVIO速度測定値248は、分散の推定値と共に(along with estimates of the variances)、各時間インスタントにおける回転行列および速度のベクトルであり得る。VIO速度測定値248がVIOシステム226によって生成されるレートは、毎秒約100回(be around 100 per second)であり得、これは、毎秒約1回である、SPS208によって生成されるSPS測定値246のレートよりもはるかに高い。VIO速度測定値248に含まれる回転行列は、初期のカメラ基準フレームに関しての現在の時間インスタントにおけるカメラ204のオリエンテーションを記述する。いくつかの態様では、VIO速度測定値248は、非常に正確であり、距離の関数として約1%のドリフトを有し、すなわち、100mに対して1mの誤差である。
[0058]VIOシステム226は、システム起動時に任意に選ばれ得るローカル基準フレーム130におけるVIO速度測定値248を測位モジュール228に提供する。SPS測定値246とVIO速度測定値248を統合するために、測位モジュール228は、グローバル基準フレーム126とローカル基準フレーム130をアラインするために、少なくとも1つのオリエンテーションパラメータを決定する(例えば、回転行列を推定する)(すなわち、プロセスブロック306)。一態様では、グローバル基準フレーム126とローカル基準フレーム130をアラインすることは、VIO速度測定値248をグローバル基準フレーム126に変換することを含む。回転行列のような、オリエンテーションパラメータを推定するために、測位モジュール228は、ローカル基準フレーム130におけるVIO速度測定値248に関連するグローバル基準フレーム126におけるSPS測定値248を取得する。一態様では、SPS208から取得されるレンジレート測定値(例えば、ドップラーレンジレート測定値)が、この目的のために使用され得る。いったんオリエンテーションパラメータ(例えば、回転行列)が決定されると、VIO速度測定値248は、以下で説明されるように、グローバル基準フレームに変換され得る。
[0059]上述されたように、一態様では、SPS208によって提供されるGPS測定値246は、モバイルプラットフォーム200の速度を表すSPS速度測定値(例えば、GPSドップラー速度測定値)を含み得る。モバイルプラットフォーム200が戸外環境にあるとき、SPS速度測定値を使用することは、比較的正確である。オリエンテーションパラメータを決定するために、SPS速度測定値を使用することは、閉形式解を提供し得る。さらに、オリエンテーションパラメータは、ビークルの場合のように、経時的に著しく変化しないことがあり得、ここで、オリエンテーションパラメータにおける変化は、主として、VIOシステム226に関連付けられたスロードリフト(slow drift)、ならびにVIOシステム226によって使用される基準フレームのリセットの可能性によるものであり得る。したがって、SPS速度測定値を利用することは、SPS208から良い品質のSPS速度測定値が利用可能である時はいつでも、モバイルプラットフォーム200によって使用され得る。
[0060]この例を続けると、v(t)は、グローバル基準フレーム126におけるモバイルプラットフォーム200の真の速度に等しいとし、v(t)は、SPS208からのSPS速度測定値246に等しいとし、v(t)は、VIOシステム226から取得されるVIO速度測定値248に等しいとする。したがって、これらのパラメータは、
Figure 0006965253
のようにモデル化され得、ここで、Rは、グローバル基準フレームとローカル基準フレームとを関連させる回転行列であり、ここで、これら測定値におけるそれぞれのノイズは、z(t)およびz(t)によって表される。一態様では、測位モジュール228は、Tのウィンドウサイズにわたって回転行列Rを推定する。例えば、時間インターバル{t−T+1,t−T+2,...t}における測定値のセットを考慮する。この式は、表記を簡単にするために、その時間が、秒単位(units of seconds)に離散化されていると仮定する。その後、式3aは、次のように、このウィンドウにわたって書き換えられ得る、
Figure 0006965253
ここで、
Figure 0006965253
であり、行列V、V、Z、Zは、同様に定義されている。その後、測位モジュール228は、以下の最小二乗最適化問題のミニマイザ(minimizer)として、回転行列Rを推定し得る、
Figure 0006965253
ここで、
Figure 0006965253
は、フロベニウスノルムを表す。一態様では、この問題は、直交プロクラステス問題の特別なケースであり、ここで、Kabschアルゴリズムは、以下のように、最適な閉形式解を提供し得る:
Figure 0006965253
ここで、svdは、特異値分解を表し、detは、行列式(determinant)を表す。
[0061]Kabschアルゴリズムは、以下のように、式3eを計算することによって、何らかの対称半正定値行列W(some symmetric positive-semidefinite matrix W)についての重み付けられたフロベニウスノルム
Figure 0006965253
を最小化するために拡張され得る:
Figure 0006965253
Kabschアルゴリズムの残りの部分は、前のままである。この重み付けられたバージョンのKabschアルゴリズムは、反復再重み付け最小二乗プロシージャのためのビルディングブロック(building block)として使用され得る。ここで、測位モジュール228は、W=Iから開始し、その後、回転行列Rの最初の推定値(a first estimate)
Figure 0006965253
を計算し得る。この推定値を使用して、その後、測位モジュール228は、残差
Figure 0006965253
を計算する。これらの残差から、測位モジュール228は、新しい重み行列Wを計算し得る。例えば、標準のバイスクエア重み関数(standard bisquare weight function)が、この目的のために使用され得る。測位モジュール228は、この計算を(例えば、5回)繰り返し得る。この反復再重み付け最小二乗アプローチは、大きな残差を有する測定値の重みを下げ(downweights)、それによって、外れ値に対するロバスト性を提供する。
[0062]式1−式3eを参照して上記で説明された、グローバル基準フレーム126とローカル基準フレーム130をアラインするためのオリエンテーションパラメータを決定する上記のアプローチは、SPS測定値246に含まれるSPS速度測定値を利用する。このアプローチは、SPS208が、SPS速度(例えば、GPSドップラー速度)を求めるのに十分な良い品質のレンジレート測定値にアクセスを有するときに、うまく機能する。しかしながら、モバイルプラットフォーム200が、著しい数の外れ値が存在する困難な環境に位置するとき、SPS速度を明示的に推定するのに十分なレンジレート測定値がないことがある。このシナリオに対処するために、測位モジュール228は、直接的に(すなわち、SPS速度を使用することなく)利用可能なレンジレート測定値を使用することによって、オリエンテーションパラメータ(例えば、回転行列)を推定するように構成され得る。結果として、以下のアプローチは、たとえSPS速度を求めるために必要とされる必要な数(例えば、4つ)よりも少ないレンジレート測定値が、時間エポックにおいて利用可能であったとしても、グローバル基準フレーム126とローカル基準フレーム130をアラインするために、測位モジュール228によって利用され得る。
[0063]例えば、同じ時間エポックtでの衛星sおよびs’(例えば、それぞれ、衛星102aおよび102b)からのレンジレート測定値のペアを考慮する。次に、修正された一重差(modified single difference)は、次のように形成される:
Figure 0006965253
[0064]上記の式(1)から、式3(f)の修正された一重差は、以下を満たす:
Figure 0006965253
と共に、
Figure 0006965253
式3(f)の修正された一重差に加えて、式(3a)により上記で定義されているように、VIO速度推定値v(t)もまた利用可能である。
[0065]その後、回転行列Rは、以下の最小二乗問題のミニマイザとして、測位モジュール228によって推定され得る:
Figure 0006965253
[0066]式(5b)の最小二乗問題は、たとえ衛星の数が、特定の時間エポックtについてのSPS速度v(t)を求めるのに十分でなかったとしても、明確に定義され得る。
[0067]推定されたSPS速度を利用する上記で説明されたアプローチとは異なり、式(5b)の最小二乗問題は、閉形式解を有していない。代わりに、反復数値法が、それを解くために、適用され得る。この目的のために、直交行列
Figure 0006965253
を直接的に求めるのではなく、測位モジュール228は、代わりに、それに対応する四元数
Figure 0006965253
を求め得る。形式上、この四元数パラメータ化(quarternion parametrization)は、各4次元単位ノルムベクトルと、回転行列を関連付ける:
Figure 0006965253
このパラメータ化は、2対1(two-to-one)であり、単位ベクトルqごとに(every unit vector q)、一意の回転行列Q(q)が対応し、全ての回転行列(to every rotation matrix)
Figure 0006965253
に対しては、ちょうど2つの単位ベクトルqおよび−qが対応することを意味し、したがって、
Figure 0006965253
となる。
[0068]その後、上記の最小二乗問題は、次のように、等価に書き換えられ得る:
Figure 0006965253
[0069]その後、回転行列Rの推定値
Figure 0006965253
は、
Figure 0006965253
をセットすることによって、式(7)のミニマイザ
Figure 0006965253
から構築され得る。
[0070]一態様では、その後、測位モジュール228は、反復局所最適化法を使用して、式(7)の非線形問題を解き得る。このアプローチは、正しい解の近傍において初期化された場合に、うまく機能し得る。しかしながら、式(7)の問題は、複数の局所極小(local minima)を示し得、ランダムに選ばれた開始点と共に、測位モジュール228は、大域的最適化を達成する代わりに、それらの局所ミニマイザのうちの1つにしばしば収束し(frequently converge)得る。この問題を軽減するために、いくつかの例では、測位モジュール228は、局所最小化のための開始点として使用され得る半定値緩和を利用し得る。
[0071]例えば、式6から、式(7)における項
Figure 0006965253
は、qにおける二次式となることに留意されたい。これは、次のように、この項を書き換えることによって、より明確に見られ得る:
Figure 0006965253
と共に、
Figure 0006965253
ここで、簡潔に表記すると、
Figure 0006965253
となる(where to simply notation)。式(8a)の恒等式は、四元数処理(quaternion manipulations)によって導出され得るが、また、行列方程式の直接比較によっても検証され得る。したがって、式(7)の最適化問題は、
Figure 0006965253
として等価に表され得る。
[0072]次に、
Figure 0006965253
であり、ここで、
Figure 0006965253
である。同様に、
Figure 0006965253
である。
[0073]したがって、Pは、対称の、半正定値の、ランク1行列であることが観察され得る。さらに、行列
Figure 0006965253
が、対称であり、半正定値であり、かつランク1である場合には、その固有の分解(eigendecomposition)は、
Figure 0006965253
をもたらす。さらに、
Figure 0006965253
の場合には、
Figure 0006965253
であり、したがって、何らかの(some)単位ノルムベクトルuについては、
Figure 0006965253
となる。したがって、式(9a)の最小化問題は、等価な形に書き換えられ得、
Figure 0006965253
ここで、最小化は、全体的な(over all)対称の、半正定値行列
Figure 0006965253
であり、これは、記号的に
Figure 0006965253
として表される。
[0074]式10の最小化における困難の1つが、非凸ランク制約(nonconvex rank constraint)であり得る。この最小化問題の半定値緩和は、このランク制約を取り除くことである。そうすると、緩和問題は、
Figure 0006965253
として表され得る。
[0075]式11の緩和問題は、凸(convex)であり、例えば、内点法(interior-point methods)を使用して、効率的および最適に解かれ得る。いったん式(11)の大域的最適解(global optimizer)が求められると、測位モジュール228は、その最大の固有値に対応するPの固有ベクトルを計算することによって、それらか単位ノルムベクトル
Figure 0006965253
を抽出し得る。その後、この単位ノルムベクトル
Figure 0006965253
は、式7の正確な問題(exact problem)についての反復最適化プロシージャのための初期解として、測位モジュール228によって使用され得る。
[0076]いくつかの態様では、回転行列Rを推定することについての上記で説明されたアプローチは、外れ値検出アルゴリズムと密結合(tightly coupled)され得、ここで、測位モジュール228は、良い品質のレンジレート測定値を反復的に見つけ出し、その後、回転行列を計算し得る。
[0077]いったん測位モジュール228が、回転行列Rの推定値
Figure 0006965253
を計算すると、ここで、VIO速度測定値248は、グローバル基準フレーム126へとオリエント(oriented)(例えば、変換)され得る。GPSでは、SPS測定値246は、典型的に、1秒ごとに取得され、一方、VIO速度測定値248は、はるかにより高い頻度において取得されることに留意されたい。外れ値検出では、2つの時間エポック間の変位情報は、関心事である(is of interest)。例えば、x(t)を、時間エポックtにおけるモバイルプラットフォーム200のロケーションとする。2つのエポックt−1とtの間の変位は、
Figure 0006965253
によって与えられ得る。
[0078]いくつかのアプリケーションでは、測位モジュール228は、ローカル基準フレーム130が変化し得る(例えば、VIOベースのシステムでは、基準フレームは、経時的にドリフトするか、またはリセットされ得る)ので、規則的なインターバルにおいて、オリエンテーションパラメータ(例えば、回転行列)を再計算するように構成される。したがって、ある特定の態様は、測位モジュール228が、スライドする時間ウィンドウを使用して、連続的に(in a continuous fashion)オリエンテーションパラメータを決定することを含む。図4は、本開示の一態様による、複数の時間エポックに関するスライドする時間ウィンドウ402−206を例示する。図4に示されるように、測位モジュール228は、時間エポックtから時間エポックt10まで延びる時間ウィンドウ402にわたって(over)最初のオリエンテーションパラメータを決定し得る。その後、オリエンテーションパラメータの次の決定のための時間ウィンドウは、時間ウィンドウ404にスライドし得、ここで、測位モジュール228は、時間エポックtないしt11を使用してオリエンテーションパラメータを決定する。同様に、オリエンテーションパラメータの3番目の決定は、時間エポックtないしt12の間で延びる時間ウィンドウ406を利用することによって実行され得る。したがって、測位モジュール228は、測位モジュール228が、オリエンテーションパラメータを連続的に決定し得るように、スライドする時間ウィンドウにわたって、VIO速度測定値248およびSPS測定値246(例えば、レンジレート測定値)を取得する。
[0079]図4に示されるように、時間ウィンドウ402は、オリエンテーションパラメータを決定するときに、測位モジュール228によって使用される時間エポックの数を規定する(dictates)サイズ408を含む。いくつかの態様では、時間ウィンドウ402−406のサイズ408は、取得される測定値の品質に依存して適応可能にされ得る(例えば、見通し(line-of-sight)シナリオ対マルチパスシナリオ、等)。1つの例では、制御ユニット210は、モバイルプラットフォーム200の移動の大きさ(magnitude)に基づいて、レンジレート測定値の品質を決定し得、ここで、より大きい移動は、より高い品質のレンジレート測定値をもたらすと決定される。レンジレート測定値の品質が高いほど、時間ウィンドウのサイズ408はより小さくなる。
[0080]さらに、測位モジュール228は、SPS208から取得されるSPS測定値246の品質に基づいて、SPS測定値246をフィルタにかけるように構成され得る。すなわち、SPS測定値246に含まれるレンジレート測定値は、それらそれぞれの品質に基づいてフィルタにかけられ得る。例として、レンジレート測定値をフィルタにかけることは、1つまたは複数のレンジレート測定値を、それらの品質が低すぎる(例えば、モバイルプラットフォーム200の移動の大きさが小さすぎる)場合に、破棄することを含み得る。別の例では、レンジレート測定値をフィルタにかけることは、1つまたは複数のレンジレート測定値を、それらの品質に基づいて重み付けすることを含み得る(より大きい大きさの移動(higher magnitudes of movement)に対応するレンジレート測定値は、より小さい大きさの移動(lower magnitudes of movement)に対応するレンジレート測定値と比較して、より重く重み付けされ得る)。なお別の例では、制御ユニット210および/またはSPS208は、レンジレート測定値が見通し外(non-line-of-sight)測定値であるかどうかを決定し、そうである場合、このレンジレート測定値を破棄し得る。
[0081]図5は、ここで教示されるような衛星測位システム(SPS)グローバル基準フレームとの視覚慣性オドメトリ(VIO)ローカル基準フレームのアラインメントをサポートするように構成されたモバイルプラットフォーム装置500において用いられ得るコンポーネントのいくつかのサンプル態様を例示する。モバイルプラットフォーム装置500は、図1のモバイルプラットフォーム108および/または図2のモバイルプラットフォーム200の1つの可能なインプリメンテーションである。
[0082]グローバル基準フレームに関して衛星測位システムからレンジレート測定値を取得するためのモジュール502が、少なくともいくつかの態様では、例えば、図2のSPS208および/または測位モジュール228に対応し得る。ローカル基準フレームに関してVIOシステムから視覚慣性オドメトリ(VIO)速度測定値を取得するためのモジュール504が、少なくともいくつかの態様では、例えば、図2のVIOシステム226および/または測位モジュール228に対応し得る。グローバル基準フレームとローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定するためのモジュール506が、いくつかの態様では、例えば、図2の測位モジュール228および/またはプロセッサ214に対応し得る。
[0083]図5のモジュール502−506の機能は、ここでの教示と一致する様々な方法でインプリメントされ得る。いくつかの設計では、これらのモジュール502−506の機能は、1つまたは複数の電気コンポーネントとしてインプリメントされ得る。いくつかの設計では、これらのモジュール502−506の機能は、1つまたは複数のプロセッサコンポーネントを含む処理システムとしてインプリメントされ得る。いくつかの設計では、これらのモジュール502−506の機能は、例えば、1つまたは複数の集積回路(例えば、ASIC)のうちの少なくとも一部分を使用してインプリメントされ得る。ここで説明されるように、集積回路は、プロセッサ、ソフトウェア、他の関連するコンポーネント、またはこれらの何らかの組合せを含み得る。したがって、異なるモジュールの機能は、例えば、集積回路の異なるサブセットとして、1セットのソフトウェアモジュールの異なるサブセットとして、またはこれらの組合せでインプリメントされ得る。また、(例えば、集積回路の、および/または1セットのソフトウェアモジュールの)所与のサブセットは、1つより多くのモジュールについての機能の少なくとも一部分を提供し得ることが理解されるであろう。
[0084]加えて、図5によって表されるコンポーネントおよび機能、ならびにここで説明された他のコンポーネントおよび機能は、任意の適切な手段を使用してインプリメントされ得る。このような手段はまた、少なくとも部分的に、ここで教示されるような対応する構造を使用して、インプリメントされ得る。例えば、図5の「〜のためのモジュール」コンポーネントと併せて上記で説明されたコンポーネントはまた、同様に指定された「〜のための手段」機能に対応し得る。したがって、いくつかの態様では、このような手段のうちの1つまたは複数は、ここで教示されるようなプロセッサコンポーネント、集積回路、または他の適切な構造のうちの1つまたは複数を使用してインプリメントされ得る。
[0085]当業者であれば、情報および信号は、様々な異なる技術および技法のうちの任意のものを使用して表され得ることを理解するであろう。例えば、上記の説明全体を通して参照され得るデータ、命令、コマンド、情報、信号、ビット、シンボル、およびチップは、電圧、電流、電磁波、磁場または磁性粒子、光場または光粒子、あるいはこれらの任意の組合せによって表され得る。
[0086]さらに、当業者であれば、ここで開示された態様に関連して説明された様々な例示的な論理ブロック、モジュール、回路、およびアルゴリズムステップは、電子ハードウェア、コンピュータソフトウェア、または両方の組合せとしてインプリメントされ得ることを理解するであろう。ハードウェアおよびソフトウェアのこの互換性を明確に例示するために、様々な例示的なコンポーネント、ブロック、モジュール、回路、およびステップが、概してそれらの機能の観点から上記で説明されてきた。このような機能が、ハードウェアとしてインプリメントされるか、あるいはソフトウェアとしてインプリメントされるかは、特定のアプリケーションおよびシステム全体に課せられる設計制約に依存する。当業者は、特定のアプリケーションごとに様々な方法において、説明された機能をインプリメントし得るが、このようなインプリメンテーションの決定は、本開示の範囲から逸脱するように解釈されるべきでない。
[0087]ここで開示された態様に関連して説明された様々な例示的な論理ブロック、モジュール、および回路は、汎用プロセッサ、DSP、ASIC、FPGAまたは他のプログラマブル論理デバイス、個別ゲートまたはトランジスタロジック、個別ハードウェアコンポーネント、あるいはここで説明された機能を実行するように設計されたこれらの任意の組合せを用いてインプリメントまたは実行され得る。汎用プロセッサは、マイクロプロセッサであり得るが、代替として、このプロセッサは、任意の従来のプロセッサ、コントローラ、マイクロコントローラ、またはステートマシン(state machine)であり得る。プロセッサはまた、コンピューティングデバイスの組合せ(例えば、DSPとマイクロプロセッサの組合せ、複数のマイクロプロセッサ、DSPコアと連携した1つまたは複数のマイクロプロセッサ、またはその他任意のこのような構成)としてインプリメントされ得る。
[0088]ここで開示された態様に関連して説明された方法、シーケンスおよび/またはアルゴリズムは、直接的にハードウェアにおいて、プロセッサによって実行されるソフトウェアモジュールにおいて、またはこれら2つの組合せにおいて、具現化され得る。ソフトウェアモジュールは、RAM、フラッシュメモリ、ROM、EPROM、EEPROM、レジスタ、ハードディスク、リムーバブルディスク、CD−ROM、または当該技術分野において周知であるその他任意の形態の記憶媒体内に存在し得る。例示的な記憶媒体は、プロセッサが記憶媒体から情報を読み取り、また記憶媒体に情報を書き込み得るように、プロセッサに結合される。代替として、記憶媒体は、プロセッサと一体化され得る。プロセッサおよび記憶媒体は、ASIC内に存在し得る。ASICは、IoTデバイス内に存在し得る。代替として、プロセッサおよび記憶媒体は、ユーザ端末内の個別コンポーネントとして存在し得る。
[0089]1つまたは複数の例示的な態様では、説明された機能は、ハードウェア、ソフトウェア、ファームウェア、またはこれらの任意の組合せでインプリメントされ得る。ソフトウェアでインプリメントされる場合、これら機能は、コンピュータ可読媒体上で、1つまたは複数の命令またはコードとして送信または記憶され得る。コンピュータ可読媒体は、1つの場所から別の場所へのコンピュータプログラムの転送を容易にする任意の媒体を含む通信媒体とコンピュータ記憶媒体との両方を含む。記憶媒体は、コンピュータによってアクセスされ得る任意の利用可能な媒体であり得る。限定ではなく例として、このようなコンピュータ可読媒体は、RAM、ROM、EEPROM、CD−ROMまたは他の光ディスク記憶装置、磁気ディスク記憶装置または他の磁気記憶デバイス、あるいは所望のプログラムコードを命令またはデータ構造の形で記憶するために使用され得、かつコンピュータによってアクセスされ得るその他任意の媒体を備え得る。また、任意の接続は、厳密にはコンピュータ可読媒体と称される。例えば、ソフトウェアが、同軸ケーブル、光ファイバーケーブル、ツイストペア、DSL、または赤外線、無線、およびマイクロ波のようなワイヤレス技術を使用して、ウェブサイト、サーバ、または他の遠隔ソースから送信される場合には、同軸ケーブル、光ファイバーケーブル、ツイストペア、DSL、または赤外線、無線、およびマイクロ波のようなワイヤレス技術は、媒体の定義に含まれる。ここで使用される場合、ディスク(disk)およびディスク(disc)は、CD、レーザーディスク、光ディスク、DVD、フロッピーディスクおよびブルーレイディスクを含み、ここで、ディスク(disks)は、通常、磁気的に、および/またはレーザーを用いて光学的にデータを再生する。上記の組合せもまた、コンピュータ可読媒体の範囲内に含まれるべきである。
[0090]前述の開示が本開示の例示的な態様を示している一方で、添付された特許請求の範囲によって定義される本開示の範囲から逸脱することなく、様々な変更および修正が、ここで行われ得ることに留意されたい。ここで説明された本開示の態様による方法の請求項の機能、ステップ、および/またはアクションは、任意の特定の順序で実行されることを必要としない。さらに、本開示の要素は、単数形で説明または特許請求され得るが、単数形に限定することが明記されていない限り、複数形が企図される。
以下に、本願出願の当初の特許請求の範囲に記載された発明を付記する。
[C1]
衛星測位システム(SPS)から、モバイルプラットフォームの複数のレンジレート測定値を取得することと、ここにおいて、前記複数のレンジレート測定値は、前記SPSのグローバル基準フレームに関するものである、
視覚慣性オドメトリ(VIO)システムから、前記モバイルプラットフォームの複数のVIO速度測定値を取得することと、ここにおいて、前記複数のVIO速度測定値は、前記VIOシステムのローカル基準フレームに関するものである、
前記複数のレンジレート測定値と前記複数のVIO速度測定値とに基づいて、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定することと
を備える方法。
[C2]
前記複数のレンジレート測定値に基づいて、前記モバイルプラットフォームの1つまたは複数のSPS速度測定値を決定すること、ここにおいて、前記少なくとも1つのオリエンテーションパラメータを決定することは、前記1つまたは複数のSPS速度測定値および前記複数のVIO速度測定値に基づく、
をさらに備える、[C1]に記載の方法。
[C3]
前記複数のレンジレート測定値は、前記モバイルプラットフォームのSPS速度を計算するために必要されるよりも少ない数のレンジレート測定値を備える、[C1]に記載の方法。
[C4]
前記SPSから、前記モバイルプラットフォームの前記複数のレンジレート測定値を取得することは、スライドする時間ウィンドウにわたって、前記複数のレンジレート測定値を取得することを備え、
前記VIOシステムから、前記複数のVIO速度測定値を取得することは、前記スライドする時間ウィンドウにわたって、前記VIO速度測定値を取得することを備え、前記方法は、前記スライドする時間ウィンドウを使用して、前記少なくとも1つのオリエンテーションパラメータを連続的に決定することをさらに備える、
[C1]に記載の方法。
[C5]
前記複数のレンジレート測定値の品質に基づいて、前記スライドする時間ウィンドウのサイズを調整することをさらに備える、[C4]に記載の方法。
[C6]
前記モバイルプラットフォームの移動の大きさに基づいて、前記複数のレンジレート測定値の前記品質を決定することをさらに備える、[C5]に記載の方法。
[C7]
前記複数のレンジレート測定値の品質に基づいて、前記複数のレンジレート測定値をフィルタにかけることをさらに備える、[C1]に記載の方法。
[C8]
前記複数のレンジレート測定値をフィルタにかけることは、1つまたは複数のレンジレート測定値の品質に基づいて、前記複数のレンジレート測定値から前記1つまたは複数のレンジレート測定値を破棄することを備える、[C7]に記載の方法。
[C9]
前記複数のレンジレート測定値をフィルタにかけることは、1つまたは複数のレンジレート測定値の品質に基づいて、前記複数のレンジレート測定値のうちの前記1つまたは複数のレンジレート測定値に重み付けすることを備える、[C7]に記載の方法。
[C10]
前記複数のレンジレート測定値から1つまたは複数の見通し外レンジレート測定値を破棄することをさらに備える、1]に記載の方法。
[C11]
前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、前記少なくとも1つのオリエンテーションパラメータを決定することは、
前記ローカル基準フレームと前記グローバル基準フレームとの間の回転行列を決定することと、
前記回転行列に基づいて、前記VIO速度測定値を前記グローバル基準フレームに変換することと
を備える、[C1]に記載の方法。
[C12]
衛星測位システム(SPS)から、モバイルプラットフォームの複数のレンジレート測定値を取得するための手段と、ここにおいて、前記複数のレンジレート測定値は、前記SPSのグローバル基準フレームに関するものである、
視覚慣性オドメトリ(VIO)システムから、前記モバイルプラットフォームの複数のVIO速度測定値を取得するための手段と、ここにおいて、前記複数のVIO速度測定値は、前記VIOシステムのローカル基準フレームに関するものである、
前記複数のレンジレート測定値と前記複数のVIO速度測定値とに基づいて、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定するための手段と
を備える装置。
[C13]
前記複数のレンジレート測定値に基づいて、前記モバイルプラットフォームの1つまたは複数のSPS速度測定値を決定するための手段、ここにおいて、前記少なくとも1つのオリエンテーションパラメータを決定するための前記手段は、前記1つまたは複数のSPS速度測定値および前記複数のVIO速度測定値に基づく、
をさらに備える、[C12]に記載の装置。
[C14]
前記複数のレンジレート測定値は、前記モバイルプラットフォームのSPS速度を計算するために必要されるよりも少ない数のレンジレート測定値を備える、[C12]に記載の装置。
[C15]
前記SPSから、前記モバイルプラットフォームの前記複数のレンジレート測定値を取得するための前記手段は、スライドする時間ウィンドウにわたって、前記複数のレンジレート測定値を取得するための手段を備え、
前記VIOシステムから、前記複数のVIO速度測定値を取得するための前記手段は、前記スライドする時間ウィンドウにわたって、前記VIO速度測定値を取得するための手段を備え、前記装置は、前記スライドする時間ウィンドウを使用して、前記少なくとも1つのオリエンテーションパラメータを連続的に決定するための手段をさらに備える、
[C12]に記載の装置。
[C16]
前記複数のレンジレート測定値の品質に基づいて、前記スライドするウィンドウのサイズを調整するための手段をさらに備える、[C15]に記載の装置。
[C17]
前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、前記少なくとも1つのオリエンテーションパラメータを決定するための前記手段は、
前記ローカル基準フレームと前記グローバル基準フレームとの間の回転行列を決定するための手段と、
前記回転行列に基づいて、前記VIO速度測定値を前記グローバル基準フレームに変換するための手段と
を備える、[C12]に記載の装置。
[C18]
少なくとも1つのプロセッサと、
前記少なくとも1つのプロセッサに結合された少なくとも1つのメモリと
を備える装置であって、前記少なくとも1つのプロセッサおよび前記少なくとも1つのメモリは、前記装置に、
衛星測位システム(SPS)から、モバイルプラットフォームの複数のレンジレート測定値を取得することと、ここにおいて、前記複数のレンジレート測定値は、前記SPSのグローバル基準フレームに関するものである、
視覚慣性オドメトリ(VIO)システムから、前記モバイルプラットフォームの複数のVIO速度測定値を取得することと、ここにおいて、前記複数のVIO速度測定値は、前記VIOシステムのローカル基準フレームに関するものである、
前記複数のレンジレート測定値と前記複数のVIO速度測定値とに基づいて、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定することと
を行うように指示するように構成される、
装置。
[C19]
前記少なくとも1つのプロセッサおよび前記少なくとも1つのメモリは、前記装置に、 前記複数のレンジレート測定値に基づいて、前記モバイルプラットフォームの1つまたは複数のSPS速度測定値を決定すること、ここにおいて、前記少なくとも1つのオリエンテーションパラメータを決定することは、前記1つまたは複数のSPS速度測定値および前記複数のVIO速度測定値に基づく、
を行うように指示するようにさらに構成される、[C18]に記載の装置。
[C20]
前記複数のレンジレート測定値は、前記モバイルプラットフォームのSPS速度を計算するために必要されるよりも少ない数のレンジレート測定値を備える、[C18]に記載の装置。
[C21]
前記少なくとも1つのプロセッサおよび前記少なくとも1つのメモリは、前記装置に、 スライドする時間ウィンドウにわたって、前記複数のレンジレート測定値を取得することと、
前記スライドする時間ウィンドウにわたって、前記VIO速度測定値を取得することと、
前記スライドする時間ウィンドウを使用して、前記少なくとも1つのオリエンテーションパラメータを連続的に決定することと
を行うように指示するようにさらに構成される、[C18]に記載の装置。
[C22]
前記少なくとも1つのプロセッサおよび前記少なくとも1つのメモリは、前記装置に、前記複数のレンジレート測定値の品質に基づいて、前記スライドするウィンドウのサイズを調整するように指示するようにさらに構成される、[C21]に記載の装置。
[C23]
前記少なくとも1つのプロセッサおよび前記少なくとも1つのメモリは、前記装置に、前記複数のレンジレート測定値の品質に基づいて、前記複数のレンジレート測定値をフィルタにかけるように指示するようにさらに構成される、[C18]に記載の装置。
[C24]
前記少なくとも1つのプロセッサおよび前記少なくとも1つのメモリは、前記装置に、 前記ローカル基準フレームと前記グローバル基準フレームとの間の回転行列を決定することと、
前記回転行列に基づいて、前記VIO速度測定値を前記グローバル基準フレームに変換することと
を行うように指示するようにさらに構成される、[C18]に記載の装置。
[C25]
コンピュータ実行可能命令を記録した非一時的なコンピュータ可読記憶媒体であって、ここにおいて、1つまたは複数のプロセッサ上で前記コンピュータ実行可能命令を実行することは、前記1つまたは複数のプロセッサに、
衛星測位システム(SPS)から、モバイルプラットフォームの複数のレンジレート測定値を取得することと、ここにおいて、前記複数のレンジレート測定値は、前記SPSのグローバル基準フレームに関するものである、
視覚慣性オドメトリ(VIO)システムから、前記モバイルプラットフォームの複数のVIO速度測定値を取得することと、ここにおいて、前記複数のVIO速度測定値は、前記VIOシステムのローカル基準フレームに関するものである、
前記複数のレンジレート測定値と前記複数のVIO速度測定値とに基づいて、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、少なくとも1つのオリエンテーションパラメータを決定することと
を行わせる、非一時的なコンピュータ可読記憶媒体。
[C26]
前記1つまたは複数のプロセッサ上で前記コンピュータ実行可能命令を実行することは、前記1つまたは複数のプロセッサに、
前記複数のレンジレート測定値に基づいて、前記モバイルプラットフォームの1つまたは複数のSPS速度測定値を決定すること、ここにおいて、前記少なくとも1つのオリエンテーションパラメータを決定することは、前記1つまたは複数のSPS速度測定値および前記複数のVIO速度測定値に基づく、
を行わせる、[C25]に記載の非一時的なコンピュータ可読記憶媒体。
[C27]
前記複数のレンジレート測定値は、前記モバイルプラットフォームのSPS速度を計算するために必要されるよりも少ない数のレンジレート測定値を備える、[C25]に記載の非一時的なコンピュータ可読記憶媒体。
[C28]
前記1つまたは複数のプロセッサ上で前記コンピュータ実行可能命令を実行することは、前記1つまたは複数のプロセッサに、
スライドする時間ウィンドウにわたって、前記複数のレンジレート測定値を取得することと、
前記スライドする時間ウィンドウにわたって、前記VIO速度測定値を取得することと、
前記スライドする時間ウィンドウを使用して、前記少なくとも1つのオリエンテーションパラメータを連続的に決定することと
を行わせる、[C25]に記載の非一時的なコンピュータ可読記憶媒体。
[C29]
前記1つまたは複数のプロセッサ上で前記コンピュータ実行可能命令を実行することは、前記1つまたは複数のプロセッサに、前記複数のレンジレート測定値の品質に基づいて、前記スライドするウィンドウのサイズを調整することを行わせる、[C28]に記載の非一時的なコンピュータ可読記憶媒体。
[C30]
前記1つまたは複数のプロセッサ上で前記コンピュータ実行可能命令を実行することは、前記1つまたは複数のプロセッサに、
前記ローカル基準フレームと前記グローバル基準フレームとの間の回転行列を決定することと、
前記回転行列に基づいて、前記VIO速度測定値を前記グローバル基準フレームに変換することと
を行わせる、[C25]に記載の非一時的なコンピュータ可読記憶媒体。

Claims (12)

  1. 1つの衛星測位システム(SPS)から、モバイルプラットフォームの複数のSPS測定値を取得すること、
    ここにおいて、前記複数のSPS測定値は、前記SPSのグローバル基準フレームに関するものであり、前記グローバル基準フレームは、同じ衛星測位ネットワークを使用するシステムに共通し、
    前記複数のSPS測定値の各々は、複数の時間エポックのうちのそれぞれの1つに対応し、
    前記SPS測定値は、(i)前記モバイルプラットフォームの1つまたは複数のSPS速度測定値、または(ii)前記モバイルプラットフォームの複数のSPSレンジレート測定値のうちの少なくとも1つを含み、前記SPSレンジレート測定値の数は、それぞれの時間エポックのための前記モバイルプラットフォームのSPS速度を計算するために必要とされるものよりも少なく、前記モバイルプラットフォームの前記SPS速度は、前記レンジレート測定値に基づいて決定される、と、
    視覚慣性オドメトリ(VIO)システムから、前記モバイルプラットフォームの複数のVIO速度測定値を取得すること、
    ここにおいて、前記VIOシステムは、前記モバイルプラットフォームの相対的な位置、速度、加速度、および/またはオリエンテーションを推定するために、カメラによってキャプチャされる連続的な画像を利用し、
    前記複数のVIO速度測定値は、前記カメラによって生成される画像に基づいて生成され、前記VIOシステムのローカル基準フレームに関するものであり、
    前記ローカル基準フレームは、前記モバイルプラットフォームの位置および/またはオリエンテーションに依存して変化し、
    前記複数のVIO速度測定値は、前記複数の時間エポックに対応する、と、
    前記複数のSPS測定値および前記複数のVIO速度測定値のみに基づいて、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、前記複数の時間エポックのうちの前記少なくとも1つのための少なくとも1つのオリエンテーションパラメータを決定することと、
    前記複数のVIO速度測定値と前記複数のSPS測定値との組み合わせに基づいて少なくとも1つの時間エポックのための前記モバイルプラットフォームの位置を決定することと
    を備え、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、前記少なくとも1つのオリエンテーションパラメータを決定することは、
    前記ローカル基準フレームと前記グローバル基準フレームとの間の回転行列を決定することと、
    前記回転行列に基づいて、前記VIO速度測定値を前記グローバル基準フレームにオリエントすることと
    を備える方法。
  2. 前記SPSから、前記モバイルプラットフォームの前記複数のSPS測定値を取得することは、スライドする時間ウィンドウにわたって、前記複数のSPS測定値を取得することを備え、
    前記VIOシステムから、前記複数のVIO速度測定値を取得することは、前記スライドする時間ウィンドウにわたって、前記VIO速度測定値を取得することを備え、
    前記方法は、前記スライドする時間ウィンドウを使用して、前記少なくとも1つのオリエンテーションパラメータを連続的に決定することをさらに備える、
    請求項1に記載の方法。
  3. 前記複数のSPSレンジレート測定値の品質に基づいて、前記スライドする時間ウィンドウのサイズを調整することをさらに備える、請求項2に記載の方法。
  4. 前記モバイルプラットフォームの移動の大きさに基づいて、前記複数のSPSレンジレート測定値の前記品質を決定することをさらに備える、請求項3に記載の方法。
  5. 前記複数のSPSレンジレート測定値の品質に基づいて、前記複数のSPSレンジレート測定値をフィルタにかけることをさらに備える、請求項1に記載の方法。
  6. 前記複数のSPSレンジレート測定値をフィルタにかけることは、1つまたは複数のSPSレンジレート測定値の品質に基づいて、前記複数のSPSレンジレート測定値から前記1つまたは複数のSPSレンジレート測定値を破棄することを備える、請求項5に記載の方法。
  7. 前記複数のSPSレンジレート測定値をフィルタにかけることは、1つまたは複数のSPSレンジレート測定値の品質に基づいて、前記複数のSPSレンジレート測定値のうちの前記1つまたは複数のSPSレンジレート測定値に重み付けすることを備える、請求項5に記載の方法。
  8. 前記複数のSPSレンジレート測定値から1つまたは複数の見通し外SPSレンジレート測定値を破棄することをさらに備える、請求項1に記載の方法。
  9. 1つの衛星測位システム(SPS)から、モバイルプラットフォームの複数のSPS測定値を取得するための手段、ここにおいて、前記複数のSPS測定値は、前記SPSのグローバル基準フレームに関するものであり、前記グローバル基準フレームは、同じ衛星測位ネットワークを使用するシステムに共通し、前記複数のSPS測定値の各々は、複数の時間エポックのうちのそれぞれの1つに対応し、前記SPS測定値は、(i)前記モバイルプラットフォームの1つまたは複数のSPS速度測定値、または(ii)前記モバイルプラットフォームの複数のSPSレンジレート測定値のうちの少なくとも1つを含み、前記SPSレンジレート測定値の数は、それぞれの時間エポックのための前記モバイルプラットフォームのSPS速度を計算するために必要とされるものよりも少なく、前記モバイルプラットフォームの前記SPS速度は、前記レンジレート測定値に基づいて決定されると、
    視覚慣性オドメトリ(VIO)システムから、前記モバイルプラットフォームの複数のVIO速度測定値を取得するための手段、ここにおいて、前記VIOシステムは、前記モバイルプラットフォームの相対的な位置、速度、加速度、および/またはオリエンテーションを推定するために、カメラによってキャプチャされる連続的な画像を利用し、前記複数のVIO速度測定値は、前記カメラによって生成される画像に基づいて生成され、前記VIOシステムのローカル基準フレームに関するものであり、前記ローカル基準フレームは、前記モバイルプラットフォームの位置および/またはオリエンテーションに依存して変化し、前記複数のVIO速度測定値は、複数の時間エポックに対応する、と、
    前記複数のSPS測定値および前記複数のVIO速度測定値のみに基づいて、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、前記複数の時間エポックのうちの少なくとも1つのための少なくとも1つのオリエンテーションパラメータを決定するための手段と、
    前記複数のVIO速度測定値と前記複数のSPS測定値との組み合わせに基づいて前記少なくとも1つの時間エポックのための前記モバイルプラットフォームの位置を決定するための手段と
    を備え、前記グローバル基準フレームと前記ローカル基準フレームをアラインするために、前記少なくとも1つのオリエンテーションパラメータを決定するための前記手段は、
    前記ローカル基準フレームと前記グローバル基準フレームとの間の回転行列を決定するための手段と、
    前記回転行列に基づいて、前記VIO速度測定値を前記グローバル基準フレームにオリエントするための手段と
    を備える装置。
  10. 前記SPSから、前記モバイルプラットフォームの前記複数のSPS測定値を取得するための前記手段は、スライドする時間ウィンドウにわたって、前記複数のSPS測定値を取得するための手段を備え、
    前記VIOシステムから、前記複数のVIO速度測定値を取得するための前記手段は、前記スライドする時間ウィンドウにわたって、前記VIO速度測定値を取得するための手段を備え、前記装置は、前記スライドする時間ウィンドウを使用して、前記少なくとも1つのオリエンテーションパラメータを連続的に決定するための手段をさらに備える、
    請求項に記載の装置。
  11. 前記複数のSPSレンジレート測定値の品質に基づいて、前記スライドするウィンドウのサイズを調整するための手段をさらに備える、請求項10に記載の装置。
  12. コンピュータ実行可能命令を記録した非一時的なコンピュータ可読記憶媒体であって、ここにおいて、1つまたは複数のプロセッサ上で前記コンピュータ実行可能命令を実行することは、前記1つまたは複数のプロセッサに、請求項1乃至に記載の方法を実行することを行わせる、非一時的なコンピュータ可読記憶媒体。
JP2018540043A 2016-02-02 2017-01-20 視覚慣性オドメトリおよび衛星測位システムの基準フレームのアラインメント Active JP6965253B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
US15/014,004 2016-02-02
US15/014,004 US10132933B2 (en) 2016-02-02 2016-02-02 Alignment of visual inertial odometry and satellite positioning system reference frames
PCT/US2017/014344 WO2017136161A1 (en) 2016-02-02 2017-01-20 Alignment of visual inertial odometry and satellite positioning system reference frames

Publications (3)

Publication Number Publication Date
JP2019509475A JP2019509475A (ja) 2019-04-04
JP2019509475A5 JP2019509475A5 (ja) 2020-02-13
JP6965253B2 true JP6965253B2 (ja) 2021-11-10

Family

ID=57956415

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018540043A Active JP6965253B2 (ja) 2016-02-02 2017-01-20 視覚慣性オドメトリおよび衛星測位システムの基準フレームのアラインメント

Country Status (7)

Country Link
US (1) US10132933B2 (ja)
EP (1) EP3411732B1 (ja)
JP (1) JP6965253B2 (ja)
KR (1) KR20180108629A (ja)
CN (1) CN108496096B (ja)
BR (1) BR112018015744A2 (ja)
WO (1) WO2017136161A1 (ja)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10324195B2 (en) * 2015-07-27 2019-06-18 Qualcomm Incorporated Visual inertial odometry attitude drift calibration
US10849134B2 (en) 2016-11-04 2020-11-24 Qualcomm Incorporated Indicating a range of beam correspondence in a wireless node
US10267924B2 (en) * 2017-01-04 2019-04-23 Qualcomm Incorporated Systems and methods for using a sliding window of global positioning epochs in visual-inertial odometry
US10859713B2 (en) * 2017-01-04 2020-12-08 Qualcomm Incorporated Position-window extension for GNSS and visual-inertial-odometry (VIO) fusion
CN111278688B (zh) * 2017-11-03 2022-09-20 黑拉有限责任两合公司 驱动车辆的部件的方法、***、计算机程序产品和计算机可读介质
US20190301871A1 (en) * 2018-03-27 2019-10-03 Artisense Corporation Direct Sparse Visual-Inertial Odometry Using Dynamic Marginalization
WO2019203677A1 (en) * 2018-04-18 2019-10-24 Limited Liability Company "Topcon Positioning Systems" Attitude determination with multiple antennas using semi-definite programming relaxation
US10636190B2 (en) 2018-05-31 2020-04-28 Robert Bosch Gmbh Methods and systems for exploiting per-pixel motion conflicts to extract primary and secondary motions in augmented reality systems
CN109540126B (zh) * 2018-12-03 2020-06-30 哈尔滨工业大学 一种基于光流法的惯性视觉组合导航方法
CN109917644B (zh) * 2018-12-26 2022-06-14 达闼科技(北京)有限公司 一种提高视觉惯导***鲁棒性的方法、装置和机器人设备
CN110874569B (zh) * 2019-10-12 2022-04-22 西安交通大学 一种基于视觉惯性融合的无人机状态参数初始化方法
CN116381760B (zh) * 2023-06-05 2023-08-15 之江实验室 Gnss rtk/ins紧耦合定位方法、装置及介质
CN116718153B (zh) * 2023-08-07 2023-10-27 成都云智北斗科技有限公司 一种基于gnss和ins的形变监测方法及***

Family Cites Families (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4402049A (en) * 1981-03-23 1983-08-30 The United States Of America As Represented By The Secretary Of The Army Hybrid velocity derived heading reference system
US5672872A (en) * 1996-03-19 1997-09-30 Hughes Electronics FLIR boresight alignment
US5894323A (en) * 1996-03-22 1999-04-13 Tasc, Inc, Airborne imaging system using global positioning system (GPS) and inertial measurement unit (IMU) data
JP3776094B2 (ja) * 2002-05-09 2006-05-17 松下電器産業株式会社 監視装置、監視方法および監視用プログラム
JP2004177362A (ja) * 2002-11-29 2004-06-24 Nippon Telegr & Teleph Corp <Ntt> 位置計測方法、位置計測装置、位置計測方法のプログラム、およびこのプログラムを記録した記録媒体
US7346452B2 (en) * 2003-09-05 2008-03-18 Novatel, Inc. Inertial GPS navigation system using injected alignment data for the inertial system
JP2008066953A (ja) * 2006-09-06 2008-03-21 Sanyo Electric Co Ltd 画像監視装置
JP2008217330A (ja) * 2007-03-02 2008-09-18 Kobe Univ 速度推定方法および速度推定プログラム
JP2011508190A (ja) * 2007-12-11 2011-03-10 クゥアルコム・インコーポレイテッド カメラ支援を伴うgnss方法及び受信機
JP2009168614A (ja) * 2008-01-16 2009-07-30 Alpine Electronics Inc 車載用ナビゲーション装置
US9766074B2 (en) 2008-03-28 2017-09-19 Regents Of The University Of Minnesota Vision-aided inertial navigation
WO2010088290A1 (en) * 2009-01-27 2010-08-05 Arthur Thomas D Tight optical intergation (toi) of images with gps range measurements
US8855929B2 (en) * 2010-01-18 2014-10-07 Qualcomm Incorporated Using object to align and calibrate inertial navigation system
CN101949715B (zh) * 2010-08-10 2012-06-20 武汉武大卓越科技有限责任公司 高精度时空数据获取的多传感器集成同步控制方法和***
US9160980B2 (en) * 2011-01-11 2015-10-13 Qualcomm Incorporated Camera-based inertial sensor alignment for PND
CN102538781B (zh) * 2011-12-14 2014-12-17 浙江大学 基于机器视觉和惯导融合的移动机器人运动姿态估计方法
US9031782B1 (en) * 2012-01-23 2015-05-12 The United States Of America As Represented By The Secretary Of The Navy System to use digital cameras and other sensors in navigation
JP6008510B2 (ja) 2012-02-20 2016-10-19 株式会社小野測器 計測装置及び計測方法
CN103424114B (zh) * 2012-05-22 2016-01-20 同济大学 一种视觉导航/惯性导航的全组合方法
JP2015532077A (ja) * 2012-09-27 2015-11-05 メタイオ ゲゼルシャフト ミット ベシュレンクテル ハフツングmetaio GmbH 少なくとも1つの画像を撮影する撮影装置に関連する装置の位置及び方向の決定方法
US9377519B2 (en) * 2013-03-12 2016-06-28 Qualcomm Incorporated Server-based mobile device regional candidate position fix mode selection
US20140267686A1 (en) * 2013-03-15 2014-09-18 Novatel Inc. System and method for augmenting a gnss/ins navigation system of a low dynamic vessel using a vision system
US9957692B2 (en) * 2013-03-15 2018-05-01 Hexagon Technology Center Gmbh System and method for heavy equipment navigation and working edge positioning using an image acquisition device that provides distance information
CN103438906B (zh) * 2013-09-10 2016-06-01 上海海事大学 适用于机器人导航的视觉与卫星定位传感器联合校准方法
US20150092048A1 (en) * 2013-09-27 2015-04-02 Qualcomm Incorporated Off-Target Tracking Using Feature Aiding in the Context of Inertial Navigation
US20170102467A1 (en) 2013-11-20 2017-04-13 Certusview Technologies, Llc Systems, methods, and apparatus for tracking an object
WO2015085483A1 (en) * 2013-12-10 2015-06-18 SZ DJI Technology Co., Ltd. Sensor fusion
US20150219767A1 (en) 2014-02-03 2015-08-06 Board Of Regents, The University Of Texas System System and method for using global navigation satellite system (gnss) navigation and visual navigation to recover absolute position and attitude without any prior association of visual features with known coordinates
US9435651B2 (en) * 2014-06-04 2016-09-06 Hexagon Technology Center Gmbh System and method for augmenting a GNSS/INS navigation system in a cargo port environment
JP6380550B2 (ja) * 2014-11-14 2018-08-29 日産自動車株式会社 表示装置及び表示方法
CN104729506B (zh) * 2015-03-27 2017-11-14 北京航空航天大学 一种视觉信息辅助的无人机自主导航定位方法
CN104848867B (zh) * 2015-05-13 2017-12-08 北京工业大学 基于视觉筛选的无人驾驶汽车组合导航方法

Also Published As

Publication number Publication date
BR112018015744A2 (pt) 2019-01-08
CN108496096A (zh) 2018-09-04
CN108496096B (zh) 2022-06-10
EP3411732A1 (en) 2018-12-12
JP2019509475A (ja) 2019-04-04
US20170219717A1 (en) 2017-08-03
KR20180108629A (ko) 2018-10-04
WO2017136161A1 (en) 2017-08-10
EP3411732B1 (en) 2021-07-28
US10132933B2 (en) 2018-11-20

Similar Documents

Publication Publication Date Title
JP6965253B2 (ja) 視覚慣性オドメトリおよび衛星測位システムの基準フレームのアラインメント
US10495763B2 (en) Mobile platform positioning using satellite positioning system and visual-inertial odometry
KR101750469B1 (ko) 하이브리드 포토 네비게이션 및 맵핑
US9677887B2 (en) Estimating an initial position and navigation state using vehicle odometry
US9250083B2 (en) Heading, velocity, and position estimation with vehicle sensors, mobile device, and GNSS inputs
US9791572B2 (en) Batch processing for improved georeferencing
KR102252566B1 (ko) 로케이션 서비스를 개선하기 위해 3차원 로케이션 정보를 사용하기 위한 시스템 및 방법
KR101524395B1 (ko) 이미지 프로세싱에 기초한 카메라-기반 포지션 로케이션 및 네비게이션
US10502840B2 (en) Outlier detection for satellite positioning system using visual inertial odometry
JP5173035B2 (ja) 運動センサを使用した無線ベースの測位調整
US11714161B2 (en) Distance-based positioning system and method using high-speed and low-speed wireless signals
WO2018184108A1 (en) Location-based services system and method therefor
JP2017534047A (ja) センサおよび無線周波数測定によるリアルタイムのモバイルベースの測位のための方法および装置
US11035915B2 (en) Method and system for magnetic fingerprinting
CN113391263B (zh) 基于无线电指纹序列更新无线电地图
US20140283578A1 (en) Mobile device and vehicle mounted sensor calibration

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191223

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191223

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201216

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210202

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210422

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20211020

R150 Certificate of patent or registration of utility model

Ref document number: 6965253

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150