(57)【要約】      （修正有）【課題】リニア加速度計を使用して、３つの軸のうちの任意あるいはすべてに関する回転を含むオブジェクトの位置の変化を測定する方法を提供する。【解決手段】６次元の情報、すなわち、３つの次元における平行移動と３つの軸に関する回転について測定し、供給するために、２つの他の３Ｄのリニア加速度計２０を積分する１つのリニア加速度計を使用する方法が開示される。２つのリニア加速度計センサは、６自由度における変数のうちの１つ以外のすべてを決定するように使用される。第３の加速度計２３からの出力は、回転６自由度を決定するために必要なデータを生成する。ヘディングにおける変化（すなわち、ヨーあるいは方位）を検出するためのジャイロスコープの必要性は、それゆえに避けられることができる。【選択図】図２
2011141284.tif 000002
【特許請求の範囲】
【請求項１】
６自由度のオブジェクトのオリエンテーションの変化および動きを測定するための方法であって、
前記オブジェクト上に、虚軸上に配置された第１および第２のリニア加速度計を準備することと、
前記オブジェクト上に、前記虚軸から離れて配置された第３のリニア加速器を配置することと、
前記第１および第２のリニア加速度計を用いて、ｘ−ｙ−ｚ座標系に関する前記オブジェクトの線形運動を測定することと、
前記第１および第２のリニア加速度計を用いて、２つの軸の回転に関するオブジェクトの角回転を測定することと、
前記ｘ−ｙ−ｚ座標系に関する前記虚軸の任意の運動を、前記第３のリニア加速器の少なくとも１つの出力から決定することと、
のステップ、を備えている方法。
【発明の詳細な説明】
【関連出願の相互参照】
【０００１】
本願は、ここでの譲受人に譲渡され、参照により、ここに明示的に組み込まれる、２００６年３月１５日に出願され、「センサベースのオリエンテーションシステム(“Sensor-based Orientation System”)」と題された、米国仮特許出願第６０／７８３，１９６号の優先権を主張する。
【技術分野】
【０００２】
本開示は、一般にオリエンテーションシステム(orientation systems)に関し、より具体的には、３次元空間における移動体(moving body)の線形移動(linear translation)に加えて、移動体のロール(roll)、ピッチ(pitch)、ヨー(yaw)を検知する(sensing)ための方法および装置(apparatus)に関する。
【背景技術】
【０００３】
物理的な状態あるいは現象(physical conditions or phenomena)を検出、あるいは測定するために利用可能な多種多様のセンサが存在する。多くの産業的、商業的、あるいは科学的なコンテキストにおいて一般に導入されるタイプのセンサは、リニア加速度計(linear accelerometers)である。地球の重力ベクトルの方向(direction)を検出することによって、線形(linear)「３Ｄ」加速度計はオブジェクトの平行移動(translation)（角回転(angular rotation)のない線形運動）を測定するために使用され、またさらに「チルト(“tilt”)」（例えば、「ロール(“roll”)あるいは「ピッチ(“pitch”)」に関連する角加速度(angular acceleration)）、自由落下(free-fall)、および衝撃(shock)を検知(sense)できる。異なるタイプおよび感度の加速度計(accelerometers)は、任意の様々な物理的現象、例えば小さなボールのローリング(rolling of a small ball)、導電性液体あるいは重液のシフティング／フローイング(shifting/flowing of a conductive or heavy liquid)、振り子のスウィンギング(swinging of the pendulum)、あるいは、正確度(accuracy)および感度を変える他の力学的手段(mechanical means)を活用すること(exploiting)によって機能することができる。より精巧で知られているリニア加速度計は、地球の磁界を通して運動(movement)を検知するか、あるいは他の磁気現象あるいは光学現象(magnetic or optical phenomena)を活用することができる。
【０００４】
しかしながら、現在のところ、従来の費用効率のよい(cost-effective)リニア加速度計を使用して、線形の動き(linear motion)（通常のデカルト座標系に関する加速度）とデバイス(device)のオリエンテーションにおける変化と、ロールあるいはピッチにおける対応する変化（すなわち、角加速度(angular acceleration)）とを区別することは、困難あるいは不可能である。「ヘディング(“heading”)」における変化、あるいは移動しているオブジェクトのヨーは、従来のリニア加速度計によって全く検知されることができない。比較的高価で、複雑で、壊れやすいジャイロスコープは、一般に、可動オブジェクト(moveable object)のヨー、ロールとピッチのような回転的自由(rotational freedom)におけるシフト(shift)あるいは変化を検知するための手段として役立つ。マイクロ電子機械システム(micro-electromechanical systems)（ＭＥＭＳ）技術における最近の発展は、２つの軸のジャイロスコープの開発を可能にしたが、通常、３つのジャイロスコープが、回転の軸につき１つ、使用される。したがって、比較的単純な加速度計センサを使用して、ロールとピッチ同様ヨーにおける変化を含む、全６自由度(all six degrees of freedom)におけるオブジェクトの運動を確実に測定するための方法および手段について、当技術分野において必要性がある。
【発明の概要】
【０００５】
ここに開示された実施形態は、事実上、任意の可動オブジェクト(movable object)についての全６自由度における運動を測定するためのプロセスおよび装置を提供することによって、上に述べられた必要性に対処する。３つのリニア加速度計は、そのような測定について必要とされるすべてのデータを生成する。２つの加速度計は、それらの加速度計に関連する同一線上の２つの点の位置の変化を検出するのに必要とされるデータを提供し、一方で最初の２つに非同一直線に配置された第３の加速度計は、最初の２つの加速度計を接続している虚軸の位置あるいはオリエンテーションの変化を、もしあれば、正確に測定する(gauge)のに適切なデータを生成する。
【図面の簡単な説明】
【０００６】
【図１】図１は、ローカル水平面に関して図示された選択された座標軸と共に示された、先行技術の加速度計あるいは「チルト」センサの透視図である。
【図２】図２は、動き６自由度に関しての加速度を測定することにおいて使用されるメトリックボード上に３つの加速度計センサがある、本開示の一態様を示す。
【図３】図３は、垂直に位置合わせされた４つの加速度計のアレイと各センサの軸に対応する出力データとを示し、また、一方が他方に対して逆さにされている水平に位置合わせされた２つのセンサを、同様に、対応する出力データと共に示す。
【図４】図４は、与えられた角のチルトτに対応する座標系のＸ軸上での加速度における変化の決定を示す幾何学図である。
【図５】図５は、線形平行移動を経験するメトリックボード上での２つの加速度計タイプセンサの出力の向きを示す。
【図６】図６は、軸Ｓ−Ｓについて回転を経験するメトリックボード上での２つの加速度計タイプのセンサの対抗する出力の向きを示す。
【図７】図７は、３つの加速度計センサと１つのクロックとＭＰＲＯＣの組合せとの間の動作する接続を示している簡単な概略図である。
【図８】図８は、本開示の方法の一態様を図示しているフローチャートである。
【発明の詳細な説明】
【０００７】
今、開示される方法は、オブジェクトのオリエンテーションおよび線形の動き(linear motion)が検知され、測定されることを可能にする。開示される方法によって、限定されないが、アビオニクス機器(avionics)および地上の運輸(ground transportation)、テレコミュニケーション、リモートセンシングおよびフォトグラフィ(remote sensing and photography)、人あるいは貨物の電子追跡(electronic tracking)およびモニタリング、そして、人、製品および消費家電製品の安全を含む広範の分野および環境において、有益な応用が見出されることが意図されている。
【０００８】
今開示される方法によって、選択されるオブジェクトの線形の動きおよび３次元のオリエンテーションは、確実に測定されることができる。それによって生成された動きおよび位置データは、その後で、任意の適切な手段によって、他のシステムコンポーネント(components)あるいはプロセッサに送信されることができる。例えば、３次元の位置における求められていない(unwanted)変化の測度(measure)は、例えば、適切なオリエンテーション（例、垂直についての）からの逸脱(deviation)が修正される(rectified)ように、姿勢制御システム(attitude control systems)に提供されることが出来る。あるいは、さらなる例の方法によって、もしオブジェクトの加速度とオリエンテーションが同時に測定され、あらかじめ決定されたパラメータからはずれるように(fall outside predetermined parameters)る場合、信号が送られてアラームシステムを作動させることが可能である。消費家電製品においては、６次元情報は、ジョイスティックのようなゲーム機器(gaming devices)を制御するために使用されることができ、出力とメニュー選択の点からユーザ相互作用を可能にし、デジタルスチルおよびビデオカメラ(digital still and video cameras)についての画像安定化(image stabilization)を提供する。
【０００９】
様々な異なるタイプおよび機能性を有するリニア加速度計は、科学的で産業的な適用の広域スペクトルにおいて広く使用されている。３次元の加速度計は、複雑さおよび費用の多数の異なるレベルにおいて(at a number of different levels of sophistication and expense)一般に利用可能で、なかでも最も広く用いられているのはマイクロ電子機械システム（ＭＥＭＳ）センサである。図１は、チルトセンサとして役立つ従来のリニア加速度計を示す。加速度計センサは、線形の動き（すなわちローカル水平面(local horizontal plane)のような、任意の面(plane)における平行移動）を検知することができ、平行移動は、少なくとも２つの軸（例、ＸｈとＹｈ）に関連して測定されることができる。そのような加速度計はまた、オブジェクトのチルトの測度（図１において示唆されたようにロールあるいはピッチ）をオファ(offer)することができる。したがって、単独の３Ｄ加速度計を用いて、デカルト座標空間（ｘ，ｙ，ｚ）にあるオブジェクトの動きは検知されることができ、重力の方向は、オブジェクトのロール（τ）およびピッチ（φ）を推定するように検知されることができる。本方法および装置の著しい利点は、３つの、そのような一般的に利用可能で、比較的手ごろな３Ｄ加速度計が、第６の変数の変化、つまりヨー、またしばしば方位あるいは「ヘディング(“heading”)」（ψ）と呼ばれる、を検知するように機能的に組み合わせられることができる。
【００１０】
図２を参照する。本開示にしたがって、同一である必要はないが好ましくは同一の２つの３Ｄ加速度計２０、２０´が、自動車、テレコミュニケーション、無線あるいは感光デバイス(photographic device)、航空機、あるいは同様なもののような、対象のオブジェクトに関連するメトリックボード２２上に空間をおいて配置される。３次元空間における２つの加速度計２０、２０´の正確な配置(disposition)は決定的ではなく、それらの分離の直線距離が固定される場合は、距離に顕著に比例して、動きの程度(degree)は、モニタされるように求められる。一実施形態において、加速度計２０、２０´は、平面ボード(planar board)２２のほぼ対角線上の端に位置を定められる。各加速度計は、ローカル水平面２５、２５´を有するとみなされることができ、面２５、２５´は、メトリックボード２２において含まれる、あるいはメトリックボード２２に平行であることができる。ボード２２は、オブジェクトあるいはデバイス（示されていない）上に取り付けられており、オブジェクトあるいはデバイスの平行移動および回転が検知され、モニタされるようになっている。
【００１１】
本開示は、第３の加速度計２３を使用して、第１の２０および第２の２０´の加速度計の出力を、求められる「６次元(“six-dimensional”)」データ行列（ｘ，ｙ，ｚ，τ，φ，ψ）を提供するために、積分する方法をオファする。リニア加速度計が第２オーダーの運動量測定値(second-order momentum measurements)を提供するので、加速度計２０、２０´および２３によってされたロコモーション測定値(locomotion measurements)は、変化（線形のあるいは角度の速度における）の率を得るために一度積分されなくてはならず、また、その後で絶対測度(absolute measure)、すなわち位置あるいはチルトにおける変化の絶対測度を得るために、二度積分されなくてはならない。
【００１２】
図２の考察は、２つの加速度計２０と２０´だけによって完全に検出されない動きは、２つの加速度計２０と２０´を接続している線によって定義される虚軸Ｒ−Ｒについての回転であることを示唆する。対象のオブジェクトに関するボード２２のオリエンテーションによって、そのような回転は、ロール（τ）、ピッチ（φ）あるいはヨー（ψ）において変化するよう対応することができる、しかし２つのセンサデバイスは、すべての３つのタイプの回転を確実に検出するには不適当である。
【００１３】
図３は、加速度計センサの出力レスポンス対重力に関するオリエンテーションを、図表を用いて示す。各センサの個々のオリエンテーションが示される場合には、重力加速度(gravitational acceleration)は、センサのアレイにおける(in an array of sensors)各センサについての各感度軸に関して測定される。図で示されているのは、４つのセンサのアレイ（あるいは、代替的に、異なる時間の４つの異なる位置で図示される単独のセンサ）で、それらのオリエンテーションは観察できる（センサ上にある白い角の印の位置に注目）。センサのｘ−ｙ座標面（感度のｘおよびｙ軸によって定義される）は、重力ベクトルに平行であるので、一番上のセンサは、ｘ軸に沿った重力による加速度以外はゼロ出力を示す。アレイの一番下のセンサは同様に、一番上のセンサについてのｘ軸の逆さ(inversion)であるため、加速度測定が反対の「向き(“sense”)」を備える出力であること以外には重力加速度のみを示す。アレイの２つのサイドセンサは、それぞれ２つの平行で、しかし反対に向けられている感度のｙ軸に沿って、重力加速度を用いて、一致出力(concordant outputs)を生成する。すべてのセンサ軸は、設計によって互いに垂直であることと、どんなミスアライメント(misalignment)も加速度測定エラーを結果としてもたらすことは注意されるべきである。以後の議論については、センサ軸は完璧に位置合わせされ、互いに垂直であることと、またセンサ自体が、センサ２０のｘ、ｙ、ｚ軸が完璧にセンサ２０´および２３のｘ、ｙ、ｚ軸と位置合わせされているような方法で、面２２に位置されることとが仮定される。
【００１４】
図３はまた、どのように単独のセンサがセンサのｚ軸の感度についてのデータを出力するかを示す。図の下のほうの右において、単独のセンサのｘ−ｙ座標面は重力ベクトルに垂直である。したがって、ｘおよびｙ軸の感度に対応する出力は０である、しかし、感度のｚ軸に沿った加速度は、重力加速度の定数ｇ、あるいは、センサのｚ軸の感度の方向的「向き」をリバースするために、センサが逆にされる場合は−ｇと等しい。
【００１５】
図５は、２つの３Ｄ加速度計２０および２０´が、線形運動、例えばｚ軸４０に平行である「ドロップ(“drop”)」（おそらくは重力ベクトル）、を検知できるということを示す。そのような状況において、加速度計２０と２０´は、一般的に平行なベクトル（図で、複数の矢印によって示されている）に沿って、同じ方向に動く、したがって同様の出力を生成する。対照に、図６によって示されているように、２つの加速度計２０と２０´は、それらが反対に向けられたベクトルに沿って動くので、オリエンテーション（例えば、任意の与えられた虚軸の回転Ｓ−Ｓについての）を検知できる、したがって反対の出力(opposite outputs)を生成する。
【００１６】
２つの加速度計システムの感覚欠陥(sensory deficiencies)を克服するために、第３のリニア加速度計２３が提供される。第３の加速度計センサ２３は、それぞれ、センサ番号１の２０からと、センサ番号２の２０´からの固定された分離距離において配置され、センサ２０と２０´の位置によって規定される虚軸Ｒ−Ｒから離れて配置される（すなわち、３つのセンサ２０、２０´そして２３は、同じ虚の面内にあるが同一線上に配列されていない）。追加のセンサコンポーネント２３は、「６つの軸(“six axis”)」運動、すなわち線形（ｘ，ｙ，ｚ）、回転（τ，φ，ψ）、の観察と区分を可能にする。したがって、図２で示される３つのセンサアレイは、３つの加速度計２０、２０´および２３の配置によって規定される面（例えば、メトリックボード２２）のすべての６つの動きの程度を効果的に検出し、説明することができる。
【００１７】
加速度計は、加速度計を据え付けているオブジェクトのオリエンテーションによって重力(force of gravity)を検知するので（図３）、装置(apparatus)の異なる軸は、本開示によるとオブジェクトによって経験された(experienced)任意の他の加速度と重力(gravitational force)の測度を検知し、報告する。本発明については、重力が常に存在していることは注意されるべきである。図４に示されているように、チルト加速度は角度τのサインと重力(gravitational force)の積から決定される。もし、例えば、加速度計２０、２０´あるいは２３の感度のｘ軸に関連する加速度がａｘとして表される場合、そのときサインτ＝ａｘ／ｇとなる、なおｇは重力（〜９．８ｍ／ｓ２）による加速度である。従って、ｘ軸におけるチルトの１度（１°)については、
【数１】
2011141284.tif 000003
【００１８】
のｘ軸に関連する加速度の変化がある。したがって、もしおよそ１度のチルトが観察され、報告される場合には、測定値を生成した加速度計の質は、１７．４５ｍｇよりもよいものでなければならない。
【００１９】
図５を再び参照すると、２つの３Ｄ加速度計（センサ２０、２０´）は、それぞれ３つの感度軸（ｘ，ｙ，ｚ）を有する。もしｚ軸４０が重力ベクトルに位置合わせされる場合、すべての運動のアブセンスにおいて、センサ２０は、それぞれ０ｇ、０ｇ、および１ｇの、複数の感度の軸に関連する加速度を経験し報告する、センサ２０´も同様に経験し、報告する。もしｚ軸４０のみに沿った線形運動がある場合、そのときには、センサ２０、２０´の両方は、０ｇ、０ｇ、ａｚ＋１ｇの加速度を報告する、なおａｚは、ｚ軸４０に沿った運動による加速度を表す。他のｘおよびｙ軸に関連する線形の動きおよび加速度は、同じ概念的フレームワーク(conceptual framework)において分析される。
【００２０】
角運動(Angular movement)もまた検出され、評価される(evaluated)。もし回転が、図６に示されているように、軸Ｓ−Ｓ（感度のセンサの軸のうちの１つと平行であるかもしれないし、あるいはないかもしれない）について生じる場合、２つのセンサ２０および２０´は、図６の複数のまっすぐな矢印によって示されているように、複数の反対の「向き」を有する変化を報告する。軸Ｓ−Ｓについての回転は、センサ２０に、それぞれ０ｇ、０ｇ、およびａｚ＋１ｇの感度のセンサの軸に関する加速度を経験させ報告させるであろう。反対に、センサ２０´は、それぞれ０ｇ、０ｇ、および-ａｚ＋１ｇの感度のそのセンサの軸に関連する加速度を経験し、報告する、またｚ軸に沿った加速度は、重力加速度から差し引かれている。特に、回転および線形の動きの両方の組み合わせは、ｚ軸に沿った加速度のマグニチュードのアンバランスをひき起こすだろう。それゆえ、もしそれぞれの加速度ａｚのマグニチュードが同じであるとセンサ２０及び２０´によって報告されない場合は、デバイスは、回転および線形の動きの組み合わせを示す。重ねて、当業者は、同じコンセプトが他の直交軸についての回転に適用されることをすぐに理解するだろう。
【００２１】
上述のコンセプトを適用し、また、センサの所与の感度軸に関して角度τを通してチルトによる加速度についての式（サインτ＝ａｘ／ｇ（あるいはａｙ／ｇ）など）を使用して、各センサ２０、２０´および２３は、特定のセンサが選択される時間のインターバルの間、どのように線形的にあるいは回転的に動いたのかを信号で伝える出力を生成する。述べたように、それぞれの加速度計センサ出力の方向およびマグニチュードは、その後で、位置がモニタされるべきオブジェクトの全体的動作(gross motion)を計算するためにＣＰＵによって測定され、比較され、対比させられることができる。加速度計２０および２０´からの出力のみは、知られているアルゴリズムを使用して、全体的なオブジェクト(gross object)が３Ｄ空間を通じて平行移動的、非回転運動を経験した(undergone)程度の計算を可能にする、さらに、１つの選択される軸についての回転は、反対の方向的「向き」の出力を生成する２つのセンサ２０、２０´によって検出され測定されることができるので、３Ｄ空間における２自由度における回転（例、「ロール」および「ピッチ」）はまた計算されることができる。
【００２２】
第３のセンサ２３は、最初の２つのセンサ２０および２０’を「接続している」軸Ｒ−Ｒから離れて位置されている、そして軸Ｒ−Ｒ自体が回転を経験した(undergone)かどうか−すなわち、メトリックボード２２、したがって対象のオブジェクトの、測定されていない３自由度における回転的変化（例えば、「ヨー」あるいは「方位」）があったかどうかを決定するのに十分な出力データを生成する。
【００２３】
すべての６自由度（ｘ，ｙ，ｚ，τ，φ，ψ）における変化をモニタする方法は、初期の座標（Ｘ０，Ｙ０，Ｚ０）を３つの加速度計２０、２０´また２３のそれぞれに、時間ゼロ（ｔ０）において、割り当てることと、またその後で、任意の適して選択される座標系に基づいて、座標における変化をコンピュートすることを含む。方法にしたがって、各センサ２０、２０´および２３の３Ｄ座標は、初期化され、また対象のオブジェクトは、その後で動きがモニタされることを経験することを可能にする。加速度計センサ２０、２０´および２３のそれぞれの出力は、選択される座標系に関する各センサの位置的変化を生成するために、受信され、二重積分方程式への入力として使用される。
【００２４】
位置の変化を計算する、すなわち、その後の時間ｔ１において単一の与えられたセンサに関連した座標を決定する、ためのアルゴリズムは、以下となる。
【００２５】
（１）（Ｘ１，Ｙ１，Ｚ１）＝（Ｘ０，Ｙ０，Ｚ０）＋∫∫（ａｘ，ａｙ，ａｚ）（ｔ―ｔ０）
なお、Ｘ０は、時間ゼロ（ｔ０）における特定のセンサのｘ座標であり、同様に時間ゼロにおいて、Ｙ０はセンサのｙ座標であり、Ｚ０は、センサのｚ座標である。すべての３つの座標軸に関連する加速度の積分(integration)は、当業者のプログラミングスキル内でプログラムを動作する(running)プロセッシングユニットによって実行されることができる計算法である。他の２つのセンサのそれぞれに関連する、後に続く座標（Ｘ１，Ｙ１，Ｚ１）は、同様に式（１）のアルゴリズムを実行することによって、各センサの出力データを入力として使用して計算される。対応する座標を備える各センサは、ボード２２上で位置される１つの点の３Ｄ運動（また一般に面を定義するために３つの点を使用する）を説明するので、時間の関数として計算される３つのセンサおよびそれらの対応する座標は、差ｔ１―ｔ０として定義される測定ドエル(measurement dwell)の間にわたって、ボード２２のオリエンテーションと位置における変化を説明する。
【００２６】
図７を参照する。方法の最適パフォーマンスに対して重要なのは、同時的、あるいはほぼ同時的な、すべての加速度計２０、２０´および２３からの測定値の読み出しである。同時的読み出しは、デジタル信号プロセッサと適切なＤＲＡＭの手段によって、受信され、記録されることができる。代替実施形態において、測定信号は、受信され、「タイムスタンプされる」(“time stamped.”)ことができる。タイムスタンプされたデータは、その後に続いて、さらなるプロセッシングについて関連づけられることができ、もし必要であれば、ナビゲーションあるいは画像安定化システムにおいて用いられているもののような、任意の様々な、知られている動き検出アルゴリズム(motion detection algorithms)への組み込みについても関連づけられることができる。図７は、分離センサ２０、２０´２３が、データをプロセッサ３２に、共通クロック(common clock)３４との動作関連において、センサ２０、２０´、２３から分かれて受信されるデータの座標の「データスタンピング」を提供するように、データを提供できるということを示す。単一のレファレンスクロックを有することによって、正確で相対的なタイムスタンピングが成し遂げられることができる。プロセッサ３２は、センサ２０、２０´、２３から加速度測定データを要求し、受信する。センサレスポンスにおける相対的な遅延がある可能性があるので、プロセッサ３２は、タイムスタンプを、センサ２０、２０´、２３からの個々の測定値に、リファレンスクロック３４にしたがって割り当てる。これらのタイムスタンプは、そのときに、測定値を相互に関連させるために使用され、オプションとして、センサ２０、２０´および２３から個々の加速度計測定値を、共通時間(common time)に、補間する(interpolate)ように使用される。オプションとして、プロセッサ３２はまた、測定ノイズを減らすために未処理の測定値をフィルタリングし、未処理センサ測定値を積分し、補間するローパス(low pass)、あるいは動きの検出および伝播に利益があると考えられ得る任意の他の機能、のようないくつかの測定処理を実行することができる。
【００２７】
前述の例について、個々の人間は、その動きがモニタされるべきオブジェクトとして考えられることができる。人間の動きは、約１０Ｈｚの範囲内にあると推測されることができる。したがって、１００Ｈｚアップデートレートにおいてセンサ２０、２０´、２３を動作することは、測定されモニタされる動きの帯域幅の１０倍において１０ミリ秒ごとに測定値を引き起こすであろう。タイムスタンピングは、それゆえに、複数のセンサ２０、２０´、２３からの測定を適切に位置合わせするために、５ミリ秒より低い正確度(accuracy)で行なわれるべきである。特に、絶対時間(absolute time)は決定的ではない、なぜならそこにあるどんなエラーもすべてのセンサからの測定値に対して共通(common)となるであろう。追跡されるプラットフォームの動力(dynamics)が高いほど、より高いサンプリングレートが動きを検知し、説明するのに必要とされる、すなわち、よりよいタイムスタンピングが必要とされている。しかし、とても好ましくは、同じクロックが、異なるセンサから測定値をタイムスタンプするために使用されている。
【００２８】
図８は、例えば、画像安定化ルーチンにおいて、使用されることができるような開示方法の典型的なアプリケーションについての呼び出しフローをオファする。アプリケーションを開始するとき、クロック３４は、システムについての共通タイミングを初期化するためにリセットされる。クロックのリセットと同時に、あるいは極めて直後に、いくつかの選択される時間ゼロ（ｔ０）において、すべてのセンサ２０、２０´、２３についての座標は、初期化される、例えば、センサ２０の座標は(ｘ，ｙ，ｚ)１０に初期化され、２０´の座標は、(ｘ，ｙ，ｚ)２０に初期化され、センサ２３の座標は(ｘ，ｙ，ｚ)３０に初期化される。アプリケーションが作動すると、センサ２０の完全な角および線形の動き（もしあれば）は検出され、測定され、プロセッサ３２に送信される、それによってセンサ２０についてのデータはタイムスタンプされ、記録される。センサ２０´の完全な動き（もしあれば）も同様に検出され、測定され、プロセッサ３２に送信される、またセンサ２０´についての受信されるデータはまた、タイムスタンプされ、記録される。測定記録およびタイムスタンピングは、プロセッサ３２によって制御されるサンプリングレートにおいて実行される。
【００２９】
図８を引き続いて参照すると、正確なデータ処理は、各測定値を得るために必要な時間が好ましくは説明されることを必要とすることがわかる。したがって、プロセッサ３２は、時間インターバル、あるいはセンサ２０の測定ドエル、と同様にセンサ２０´の測定ドエルについての「デルタ(“delta”)」を、時間の期間の間（平行移動的および／または回転的運動が生じている可能性がある）に計算する。測定ドエルは、測定サンプリングレートによって規定され、ｔ１―ｔ０と等しい、なおｔ０は前の測定のタイムスタンプであり、ｔ１は現在の測定のタイムスタンプである。十分な観察期間(full observation period)は複数のドエル期間から成り立っており、位置的および回転的変化は十分な観察期間にわたって、時間のこの期間の間に起こったすべての動きを説明するために、積分されなくてはならない。例えば、１００Ｈｚサンプリングレートにおいて、それぞれが１０ミリ秒持続時間の１００ドエルが１秒の観察期間内にオブジェクトの線形および回転的位置における変化を生成するために積分されることができる。
【００３０】
センサ２０についての位置座標は、その後で、上の式（１）を使用して、時間ｔ１において計算される。センサ２０´の位置座標も計算される。
【００３１】
最後に、センサ２３によって提供される動きの検出および測定は、６自由度、観察、およびプロセッシングについて同様に処理される。（ｘ，ｙ，ｚ，τ，φ，ψ）におけるいかなる変化も、センサ２０、２０´および２３についての時間t1における「新しい」座標（すなわち、（ｘ，ｙ，ｚ）１１、（ｘ，ｙ，ｚ）２１および（ｘ，ｙ，ｚ）３１）の完全な決定(complete determination)を可能にする、センサ２０、２０´およびセンサ２３の座標によって定義される面２２の位置を計算し、アップデートし、記憶するために使用される。このプロセスは、動きが潜在するアプリケーション(underlying application)について観察される必要がある間に、繰り返される。新しいアプリケーションは、その後で、再びセットされるクロック、再初期化されるセンサ２０、２０´および２３についての座標と望まれるように繰り返される方法で再開されることができる。
【００３２】
当業者は、情報および信号は、様々な異なる技術および技法のいずれかを使用して表わされることができるということを、理解するであろう。例えば、上記の説明をとおして参照されることができる、データ、インストラクション、コマンド、情報、信号、ビット、シンボル、およびチップは、電圧、電流、電磁波、磁場あるいは磁性粒子、光場あるいは光学粒子、あるいはそれらの任意の組合せによって表わされることができる。
【００３３】
当業者は、様々な説明のための論理ブロック、モジュール、回路、および、ここに開示された実施形態に関連して説明されたアルゴリズムステップは、電子ハードウェア、コンピュータソフトウェアあるいは両方の組合せとしてインプリメントされることができる、ということをさらに理解するであろう。ハードウェアとソフトウェアのこの互換性を明瞭に説明するために、様々な説明のためのコンポーネント、ブロック、モジュール、回路およびステップが、一般に、それらの機能性という観点から、上記に説明されてきた。そのような機能性が、ハードウェアあるいはソフトウェアとしてインプリメントされるかどうかは、特定のアプリケーションと全体のシステムに課された設計制約(design constraints)に依存する。熟練職人は、各特定のアプリケーションについての様々な方法で、説明された機能性をインプリメントすることができるが、そのようなインプリメンテーションの決定は、本発明の範囲からの逸脱を生じさせるものとして解釈されるべきでない。
【００３４】
ここに開示された実施形態に関連して説明された様々な説明のための論理ブロック、モジュールおよび回路は、汎用プロセッサ、デジタル信号プロセッサ（ＤＳＰ）、特定用途向け集積回路（ＡＳＩＣ）、フィールドプログラマブルゲートアレイ（ＦＰＧＡ）あるいは他のプログラマブル論理デバイス、ディスクリートゲートあるいはトランジスタロジック、ディスクリートハードウェアコンポーネント、あるいはここに説明された機能を実行するために設計されたそれらの任意の組み合わせで、インプリメントあるいは実行されることができる。汎用プロセッサは、マイクロプロセッサであってもよいが、代替として、プロセッサは、任意の従来のプロセッサ、コントローラ、マイクロコントローラ、あるいはステートマシン(state machine)であってもよい。プロセッサはまた、コンピューティングデバイス(computing devices)の組み合わせ、例えば、ＤＳＰとマイクロプロセッサとの組み合わせ、複数のマイクロプロセッサ、ＤＳＰコアと併用しての１つ以上のマイクロプロセッサ、あるいは任意の他のそのような構成のもの、としてインプリメントされてもよい。
【００３５】
ここに開示された実施形態に関連して説明された方法あるいはアルゴリズムのステップは、ハードウェアにおいて、プロセッサによって実行されたソフトウェアモジュールにおいて、あるいはこれら２つの組み合わせにおいて、直接的に具現化されることができる。ソフトウェアモジュールは、ランダムアクセスメモリ（ＲＡＭ）、フラッシュメモリ、リードオンリメモリ（ＲＯＭ）、電気的プログラマブルＲＯＭ（ＥＰＲＯＭ）、電気的消去可能ＲＯＭ（ＥＥＰＲＯＭ）、レジスタ、ハードディスク、リムーバブルディスク、ＣＤ−ＲＯＭあるいは当技術分野において知られている記憶媒体の任意の他の形態において常駐する(reside)ことができる。例示的な記憶媒体は、プロセッサが記憶媒体から情報を読み取ることができ、また記憶媒体に情報を書き込むことができるように、プロセッサに結合される。別の方法では、記憶媒体は、プロセッサと一体化していてもよい。プロセッサと記憶媒体は、ＡＳＩＣにおいて常駐していてもよい。ＡＳＩＣは、ユーザ端末に常駐していてもよい。あるいは、プロセッサと記憶媒体は、ユーザ端末におけるディスクリートコンポーネントとして常駐することができる。
【００３６】
開示された実施形態の、以上の説明は、いずれの当業者も本発明を作り、使用することができるように提供される。これらの実施形態に対する様々な修正は、当業者にとって容易に明らかであろう、そして、ここにおいて定義された包括的な原理は、本発明の精神あるいは範囲から逸脱することなく、他の実施形態に適用されることができる。したがって、本発明は、ここに示された実施形態に限定されるようには意図されておらず、ここに開示された原理および新規な特徴に整合する最も広い範囲が与えられるべきである。
【図１】
2011141284.tif 000004
【図２】
2011141284.tif 000005
【図３】
2011141284.tif 000006
【図４】
2011141284.tif 000007
【図５】
2011141284.tif 000008
【図６】
2011141284.tif 000009
【図７】
2011141284.tif 000010
【図８】
2011141284.tif 000011
【手続補正書】
【提出日】平成23年3月7日(2011.3.7)
【手続補正１】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
６自由度のオブジェクトのオリエンテーションの変化を決定するための方法であって、
前記オブジェクトに関する虚軸上に第１及び第２のリニア加速度計を配置することと、
前記第１のリニア加速度計を用いて、ｘ−ｙ−ｚ座標系に関する前記オブジェクトの第１の線形運動を測定することと；
前記第２のリニア加速度計を用いて、前記ｘ−ｙ−ｚ座標系に関する前記オブジェクトの第２の線形運動を測定することと；
前記第１及び第２のリニア加速度計を用いて、３つの回転軸に関する前記オブジェクトの角回転を測定することと、
前記第１及び第２のリニア加速度計からの測定値を用いて、前記オブジェクトの位置の変化を決定することと；
前記第１及び第２のリニア加速度計からの測定値を用いて、前記オブジェクトのオリエンテーションの変化を決定することと；
前記ｘ−ｙ−ｚ座標系で、第１の時間において初期の座標（X０、Y０、Z０）を前記加速度計のそれぞれに割当てることと；
前記加速度計のそれぞれについて、前記第１の時間と第２の時間との間で前記初期の座標からの変化を計算することと；
を備える方法。
【請求項２】
前記オリエンテーションの変化を決定することは、加速度計の感度軸に関する前記第１及び第２のリニア加速度計のそれぞれの出力を比較することを備える、請求項１に記載の方法。
【請求項３】
前記オリエンテーションの変化を決定することは、加速度計の各感度軸に関する前記第１および第２のリニア加速度計の前記それぞれの出力を比較することを備える、請求項１に記載の方法。
【請求項４】
少なくとも１つの前記加速度計の感度軸に関するチルト加速度を計算することを更に備える、請求項１に記載の方法。
【請求項５】
前記ｘ−ｙ−ｚ座標系の軸に沿って前記第１及び第２のリニア加速度計のそれぞれの加速度の大きさのアンバランスを検出することを更に備える、請求項１に記載の方法。
【請求項６】
前記加速度計のそれぞれについての前記初期の座標からの変化を計算することは、
前記加速度計のそれぞれからのデータを受信することと；
前記加速度計のそれぞれからの前記データを、式（X１,Y１,Z１）=（X０,Y０,Z０）＋∬（ax,ay,az）（t-t０）に入力することと、なお、aは軸に関する加速度であり、X０は前記第１の時間における加速度計のx座標であり、Y０は前記第１の時間における前記加速度計のy座標であり、Z０は前記第１の時間における前記加速度計のｚ座標であり、（X１,Y１,Z１）は、前記第２の時間における前記ｘ−ｙ−ｚ座標系での前記加速度計の位置を定義する；
を備える、請求項１に記載の方法。
【請求項７】
６自由度のオブジェクトのオリエンテーションの変化を決定するための装置であって、
第１のリニア加速度計と；
虚軸を定義するために前記第１のリニア加速度計に関して位置づけられた第２のリニア加速度計と；
前記第１及び第２のリニア加速度計を用いて、ｘ−ｙ−ｚ座標系に関する前記オブジエクトの線形運動を測定するための手段と；
前記第１及び第２のリニア加速度計を用いて、３つの回転軸に関する前記オブジェクトの角回転を測定するための手段と；
前記第１および第２のリニア加速度計の測定値から、前記装置の位置およびオリエンテーションの変化を決定するためのプロセッサと、なお、前記プロセッサは、前記ｘ−ｙ−ｚ座標系で、第１の時間において初期座標を前記加速度計のそれぞれに割当て、前記第１の時間と第２の時間との間での各加速度計の座標の変化を計算する；
を備える装置。
【請求項８】
前記第１及び第２のリニア加速度計を用いて前記オブジェクトの前記線形運動を測定するための前記手段は、加速度計の感度軸に関する前記第１及び第２のリニア加速度計のそれぞれの出力を比較するための手段を備える、請求項７に記載の装置。
【請求項９】
前記プロセッサは、前記加速度計の少なくとも１つの感度軸に関する少なくとも１つのチルト加速度を計算する、請求項７に記載の装置。
【請求項１０】
前記プロセッサは、更に、前記ｘ−ｙ−ｚ座標系の軸に沿って前記第１及び前記第２のリニア加速度計のそれぞれの加速度の大きさのアンバランスを検出する、請求項７に記載の装置
【請求項１１】
前記プロセッサは、前記加速度計のそれぞれからデータを受信し、前記第２の時間において、前記ｘ−ｙ−ｚ座標系における前記加速度計の前記位置を二重積分方程式を用いて計算する、請求項７に記載の装置。
【請求項１２】
コンピュータが６自由度のオブジェクトのオリエンテーションの変化を決定することを可能にするコンピュータプログラム製品であって、
コンピュータが予め定められた動作を実行することを可能にするソフトウェア命令と；
前記ソフトウェア命令を有するコンピュータ読み取り可能記憶媒体と；
を備え、
前記予め定められた動作は：
前記オブジェクトに関する虚軸上に配置された第１及び第２のリニア加速度計が示す情報を受信することと；
前記第１のリニア加速度計が示す前記情報を用いて、ｘ−ｙ−ｚ座標系に関する前記オブジェクトの第１の線形運動を決定することと、；
前記第２のリニア加速度計が示す前記情報を用いて、前記ｘ−ｙ−ｚ座標系に関する前記オブジェクトの第２の線形運動を決定することと；
前記第１及び第２のリニア加速度計を用いて、３つの回転軸に関する前記オブジェクトの角回転を示す情報を決定することと；
前記第１及び第２のリニア加速度計からの情報を用いて、前記オブジェクトの位置の変化を決定することと；
前記第１及び第２のリニア加速度計からの情報を用いて、前記オブジェクトのオリエンテーションの変化を決定することと；
前記ｘ−ｙ−ｚ座標系で、第１の時間において初期座標（X０、Y０、Z０）を前記加速度計のそれぞれに割当てることと；
前記加速度計のそれぞれについて、前記第１の時間と第２の時間との間での前記初期座標からの変化を計算することと； 
なお、前記コンピュータは、６自由度のオブジェクトのオリエンテーションの変化を決定する、
を含む、コンピュータプログラム製品。
【外国語明細書】
2011141284000001.pdf