JP4892982B2 - 磁気マッピング装置 - Google Patents

Description

本発明は、磁気方式のヘッドモーショントラッカ（以下ＨＭＴと呼ぶ）を使用する空間についての磁気分布を計測する磁気マッピング装置に関する。
本装置は、例えば、空間に交流磁界を発生させておき、頭部装着型表示装置（ヘッドマウントディスプレイ（ＨＭＤ））に取り付けた磁気センサが検出する磁気データに基づいて、頭部装着型表示装置の向きや角度を測定する磁気方式のＨＭＴに関連して用いられる。

ＨＭＴは、ゲーム機のヴァーチャルリアリティ（ＶＲ）や実際の航空機で、頭部装着型表示装置の使用者の頭部位置および角度を計測する装置として利用されている。
例えば、ＶＲ技術では、頭部装着型表示装置を装着する者の頭部の動きに応じて変化する画像を視認させることで、ＶＲ空間を体験させる。この場合、装着者の頭部の位置と向き（角度）とを測定し、測定結果に対応させて頭部装着型表示装置の表示画像を変化させるようにするために、ＨＭＴを用いている。

また、救難飛行艇による救難活動において、発見した救難目標を見失うことがないようにするため、頭部装着型表示装置により表示される照準画像と救難目標とが対応した時にロックすることにより、その後は、頭部の位置と角度とを測定し、ロックされた救難目標との位置関係を演算して、上記表示装置装着者が救難目標を見失わないように表示することが行われている。この場合、救難目標との位置関係を演算する際に、航空機の緯度、経度、高度、飛行体の姿勢に加えて、頭部装着型表示装置を装着する者の頭部の位置と角度とを測定することが必要になり、ＨＭＴを用いている。

頭部装着型表示装置に取り付けられるヘッドモーショントラッカ（ＨＭＴ）としては、磁気ソースを用いて周囲の空間に磁界を発生させておき、頭部装着型表示装置に固定した磁気センサにより磁気を測定し、測定された磁気データから磁気センサの現在位置や現在角度、ひいては頭部装着装置の現在位置や現在角度を検出する磁気測定方式のものが開示されている（特許文献１参照）。

図８は磁気方式のＨＭＴの構成を模式的に示した図である。ＨＭＴ１００は、３軸コイルにより交流磁界を発生する磁気ソース１０１と、座席１０２に座ったＨＭＴ使用者が頭部に取り付ける頭部装着型表示装置１０３と、頭部装着型表示装置１０３に固定された磁気センサ１０４と、磁気ソース１０１および磁気センサ１０４の制御を行うとともに、磁気センサ１０４が測定した磁気データに基づいて磁気センサ１０４の位置や角度を算出する機能を備えた制御部１０５とから構成される。このＨＭＴ１００では、磁気ソース１０１が発生する交流磁界により、空間の各点には、それぞれの位置に固有の磁気変化（大きさおよび向きを有する磁気データ）が生じる。磁気センサ１０４を用いて、磁気センサ１０４の現在位置での磁気を測定し、空間各点が有する磁気データと比較することにより、磁気センサ１０４の位置関係、角度関係が算出される。

交流磁気方式のＨＭＴでは、予め、位置の基準となる原点および座標系と、方向の基準となる基準方向とを定めている。具体的には、磁気ソースの位置を原点としてＸＹＺ座標系を定め、さらに、Ｘ軸方向を基準方向として定めている。
そして磁気センサの出力に基づいて、座標原点から磁気センサまでの位置移動量であるＸ、Ｙ、Ｚの位置座標情報、および磁気センサの基準方向に対する角度移動量であるアジマス方向（Ｘ軸に対する回転）、エレベーション方向（Ｙ軸に対する回転）、ロール方向（Ｚ軸に対する回転）の角度情報を求めるようにして、これらから磁気センサを固定してある頭部装着型表示装置、さらには頭部の測定原点および基準方向に対する位置や角度を求めている。

空間の磁気データ分布は、磁界発生源である磁気ソースと磁気センサだけが存在するような理想状態では、電磁気学理論に基づく理論計算（ビオサバールの法則などによる計算）により、ほぼ正確に求めることができる。
しかし、磁気ソースや磁気センサの周辺に、金属等の導電性物質が存在する場合は、磁気データの分布は単純ではなく、導電性物質内に発生する渦電流により誘起される磁界によって、交流磁界内に磁気歪を生じることとなる。特に、ゲーム機や航空機の場合は、構造上、金属製の座席などを設ける必要があり、ＨＭＴの周囲から導電性物質をなくすことは困難なため、どうしても導電性物質の影響による磁気歪が生じてしまう。

そのため、導電性物質の影響を除去するために、磁気マッピング装置を用いて各測定位置における磁気データ分布（さらには位置誤差データ、角度誤差データ）を予め収集している。磁気マッピング装置は、磁気センサを移動するための移動装置（移動ステージ）により一定間隔ごと離れた測定位置（例えば格子状に配置された測定位置）に磁気センサを移動させ、各測定位置における磁気データを実測し、その出力に基づいて、各測定点の位置や角度の誤差データを取得する。

このように、磁気方式は、磁気センサが移動する空間に磁界が発生している限り特に制限なく使用することができるものの、磁気センサを移動させる空間の磁気データ（位置誤差データ、角度誤差データ）を予め磁気マッピング装置により測定しておく必要がある。

これに対し、光学的に頭部装着型表示装置の位置や角度を測定するものが開示されている。すなわち、頭部装着型表示装置に位置特定用の発光体や反射体からなるマーカを取り付け、カメラを用いたステレオ視を行うことにより光学的にマーカ位置を読み取ることで頭部装着型表示装置の位置や角度を測定するものが開示されている。例えば、頭部装着型表示装置に反射板を取り付けて、光源から光を照射して反射光をカメラで撮影し、その画像データを利用してマーカの位置や角度を測定するような光学測定によるものが開示されている（特許文献２参照）。

光学測定方式は、磁気マッピングの必要がなく、また、金属等による影響を受けることはない点で優れているが、外乱光の多い空間等では外乱光とマーカとを見誤り、誤動作するおそれがある。
また、マーカがカメラに映らない死角が発生しないようにする必要があり、例えば、個々のマーカどうし識別可能にした相当数のマーカを（例えば発光波長を異ならせた複数マーカを用いて識別する方法、あるいは同一出願人の先行出願である特願２００５−１０６４５８号に記載するようなマーカ間の位置情報から個々のマーカを識別する方法）、頭部装着型表示装置の外表面の全方向にちりばめて配置しておき、カメラに映っているマーカが必ず存在するようにする等の工夫が必要となる。そのため、マーカ数が増えると頭部装着型表示装置の電気配線が複雑になり、また、重量が磁気方式に比べて重くなる。

さらに、光学測定方式では、マーカが移動する空間全体を映すことができるようにするため、使用者から少し離れた位置に、マーカを光学的に読み取るカメラを設置する必要があるが、航空機の操縦席等で使用する場合等では、地上でのメンテナンス時以外にカメラ設置用の空間を確保することが困難な場合もある。
そのため、磁気測定方式ＨＭＴと光学測定方式ＨＭＴとは、それぞれ使用場所や使用目的に応じて使い分けられている。
特開２００２−８１９０４号公報 特表平９−５０６１９４号公報

上述したように、磁気方式と光学方式とはそれぞれ他方に比べて長所、短所があるため使い分けられており、光学方式が使えない用途においては、磁気マッピング装置による周囲空間の磁気データの計測作業を行った上で磁気方式のＨＭＴが使用されている。

ところで、磁気方式ＨＭＴを採用する場合において、従来の磁気マッピング装置による磁気データの収集は、モータ駆動の移動装置(移動ステージ)によって磁気センサを一定間隔ずつ移動することにより、各点での磁気データを実測している。この測定は、磁気センサ（頭部）が移動する空間全体にわたって行う必要があり、通常は５０００点以上の測定点を設けて、それぞれの位置で計測するようにしている。測定点のひとつひとつの点に磁気センサを移動して正確に位置が定まれば停止し、各位置でのデータを取得する動作を繰り返すことになるため、この作業は多大な時間が必要となる。例えば、２秒ごとに測定点を移動して測定するようにすれば、５０００点以上の測定を行うには少なくとも１００００秒(２時間４７分)もの時間が必要となる。また、せっかく磁気マッピングを行ったとしても、測定対象領域の金属分布が変化すれば、再度磁気マッピングを行わなければならず、その度に、同程度の時間が必要となる。

そこで、本発明は、磁気方式のＨＭＴの使用する上で必要な磁気データ（誤差データ）の取得を短時間で行うことができる磁気マッピング装置を提供することを目的とする。

上記課題を解決するためになされた本発明の磁気マッピング装置は、ヘッドモーショントラッカ（ＨＭＴ）の使用時と同様の磁界を発生する磁気ソースと、支持体と、前記支持体に取り付けられ前記磁界中の磁気データを測定する磁気センサと、互いに正三角形を形成しないようにして前記支持体の外表面に取り付けられ前記磁気センサに対する位置が固定されるとともに互いの間の距離情報が既知である少なくとも３つのマーカ群と、３つのマーカを同時にステレオ視するための一対のカメラと、前記一対のカメラで撮影された各画像に同時に映る３つのマーカの画像上の位置に基づいてエピポーラ幾何学に基づく予測により３つのマーカの対応付けを行い、次いで対応付けられた３つのマーカの位置座標を三角測量により求めるとともに求めた位置座標から３つのマーカ間の距離を求め、次いで既知であるマーカ間の距離情報との比較により３つのマーカの識別を行い、識別された３つのマーカの位置座標に基づいて磁気センサの位置座標を算出する磁気センサ位置算出部と、算出された磁気センサの位置座標とカメラ画像の撮影時に測定された磁気データとに基づいて位置座標と磁気データとを対応付けた磁気マッピングデータを蓄積する磁気マッピング部とを備えるようにしている。

ここで支持体は、磁気センサとマーカ群とを固定できて、これらの間の位置関係を一定にすることができるものであれば特に形状等は限定されない。
この発明によれば、磁気ソースは、実際に磁気方式ＨＭＴを使用するときと同様の磁界を、周囲の空間に発生する。この状態で、磁気センサとマーカ群とが取り付けられている支持体を磁界が生じている空間内で移動する。支持体の移動は、使用者が手動で移動させてもよいし、自動で移動装置を用いてもよい。移動はランダムに任意の方向に行えばよく、予め測定点の座標を定めてその座標位置に停止させる必要がないので継続して迅速に移動すればよい。移動範囲は、ＨＭＴ使用時に磁気センサが移動する可能性のある空間全体を移動させる。

対をなす２つのカメラにより、移動中の支持体を次々と撮影し、支持体表面に取り付けてあるマーカ群のなかから３つの共通のマーカを２つのカメラで同時に撮影するようにして、各時点で同時に撮影された２つのカメラ画像に３つの共通のマーカが映し出されるようにする。すなわち、３つのマーカはステレオ視がなされるようにする。
物体は、物体上の３点の位置を定めることにより、その時点での物体の位置および角度を一義的に決定することができる。
磁気センサ位置角度算出部は、後述するエピポーラ幾何学に基づく予測により３つのマーカの対応付けを行い、対応付けられた３つのマーカの位置座標を求める。
位置座標は、各カメラとマーカとの間の角度情報を求め、さらにカメラ間の距離情報を用いて、三角測量により各時点での３つのマーカの位置座標を求める。３つのマーカそれぞれの位置座標から、３つのマーカ間の距離を求める。これと、予め既知であるマーカ間の距離情報との比較により３つのマーカの識別を行う。そして識別された３つのマーカの位置座標に基づいて、支持体の位置および角度を一義的に定めることができ、支持体の位置・角度が定まることにより、支持体に固定されている磁気センサのその時点の位置座標についても一義的に定めることができる。

このようにして、ある時点での磁気センサの位置座標を光学的測定によって求めるとともに、同時にその時点での磁気センサによる磁気データを採取する。この動作を繰り返すことで、多数の点についての磁気センサの位置座標と磁気データとを対応付けた磁気マッピングデータが得られる。光学測定による位置座標の計測は、１秒間に６０回くらいの回数で行うことができることから、５０００点の測定を行う場合であっても、数分程度で計測することができる。そして磁気マッピング部は採取した磁気マッピングデータを蓄積する。蓄積した磁気マッピングデータは測定誤差データの作成などに利用される。

上記発明によれば、予め測定点を定めて、磁気マッピング装置に記憶させておく必要がなく、測定準備作業が簡素化できる。また、光学測定により磁気センサの位置座標を求めることにより、測定点数が多い場合でも、測定点ごと停止して測定する必要がないことから磁気マッピングに要する測定時間を大幅に短縮することができる。

（その他の課題を解決するための手段および効果）
上記発明において、支持体として頭部装着型支持体を用いるようにしてもよい。頭部装着型支持体としては、具体的には磁気マッピング専用のヘルメットを用いることができるが、例えば実際にＨＭＴとして使用する頭部装着型表示装置（ＨＭＤ）にマーカを取り付けたものでもよい。
支持体として頭部装着型支持体を用いることにより、実際にＨＭＴを使用する際の頭部の動きを真似ることができるので、実際のＨＭＴ使用時における磁気センサ移動領域を重点的に測定した磁気マッピングデータを採取することができるので、実情に即したデータを得ることができる。

支持体として頭部装着型支持体を用いる場合に、マーカ群は、いずれの方向からも少なくとも３つのマーカが一対のカメラで撮影されるように頭部装着型支持体の外表面全体に散りばめて配置するようにしてもよい。

これにより、頭部装着型支持体を極端に傾けた場合等でも確実に３つのマーカをステレオ視することができる。また、一対のカメラの配置場所についての自由度を増すことができる。

以下、本発明の実施形態について図面を用いて説明する。なお、本発明は、以下に説明するような実施形態に限定されるものではなく、本発明の趣旨を逸脱しない範囲で種々の態様が含まれることはいうまでもない。

（実施形態１）
図１は、本発明の一実施形態である磁気マッピング装置の構成を示す図であり、図２はその磁気マッピング装置の一部であるヘルメットを上から見た図である。この磁気マッピング装置１は、交流磁界を発生する磁気ソース２と、磁気データを検出する磁気センサ３と、ステレオ視を行う一対のカメラ１２、１４と、ヘルメット１６と、マーカとして用いられる３つのＬＥＤ１８（１８ａ〜１８ｃ）と、磁気ソース２、磁気センサ３、カメラ１２、カメラ１４、ＬＥＤ１８の制御および演算を行う制御演算部２０とからなる。制御演算部２０の実行する機能を便宜上機能ブロックとして説明すると、磁気センサ３の位置を算出する磁気センサ位置算出部２１および磁気マッピングデータを蓄積する磁気マッピング部２２が含まれている。

この磁気マッピング装置１では、図８で説明したＨＭＴ１００と同じ磁界を形成するようにセットされる。例えば、磁気ソース２は、図８における磁気ソース１０１をそのまま用い、また、座席４は、図８の座席１０２をそのまま用いる。これにより、ＨＭＴ１００と磁気マッピング装置１とは、磁気的な環境が同一になるようにしてある。
磁気センサ３は、ピックアップコイルを有しており、現在位置での磁気の大きさと向きとを磁気データとして測定する。

一対のカメラ１２とカメラ１４は、ヘルメット１６の上方からヘルメット１６のステレオ視が可能となるように互いに距離ｄ（ｄは測定により既知とする）を隔てて設置され、それぞれのカメラの位置座標が求めてあるものとする。
ヘルメット１６には、磁気センサ３とともに、３つのＬＥＤ１８ａ〜１８ｃが固定してあり、ヘルメット１６自体がこれらの間の位置関係を一定に保つ支持体となる。予め、ヘルメット１６上での磁気センサ３とＬＥＤ１８ａ〜１８ｃとの位置関係（距離情報）を求めておくことにより、３つのＬＥＤの位置座標が求まれば、磁気センサ３の位置座標を求めることができる。３つのＬＥＤ１８ａ〜１８ｃは、ヘルメット使用者が通常の動きを行う際に、上方に設置されたカメラ１２、１４に、常に同時に映るようにするため、ヘルメット上部の位置に取り付けられる。

３つのＬＥＤ１８ａ〜１８ｃには、それぞれが他の隣接するＬＥＤと識別できるように異なる発光波長（発光色）のものを用いる。なお、ＬＥＤ１８ａ，１８ｂ間の距離、ＬＥＤ１８ｂ，１８ｃ間の距離、ＬＥＤ１８ｃ，１８ａ間の距離のうち少なくとも２つを互いに異なるようにしてＬＥＤを取り付けておくことにより（すなわち３つのＬＥＤが正三角形を形成しないように取り付けておくことにより）、後述する演算によって各ＬＥＤの位置座標を求めれば、ＬＥＤ間の距離についても求めることができ、それぞれのＬＥＤを特定することができるので、その場合は，ＬＥＤ自体には発光波長のような識別情報を与えておかなくてもよい。

制御部２０は、ＣＰＵやメモリを含むコンピュータにより構成され、メモリに記憶されたプログラムを実行することにより、磁気マッピング装置の制御動作や演算動作を行う。

制御部２０に含まれる機能ブロックのひとつである磁気センサ位置算出部２１は、一対のカメラ１２、１４によりそれぞれ撮影された一対の画像に同時に映る３つのＬＥＤの画像上の位置に基づいて、これら３つのＬＥＤの位置座標を三角測量により求め、求めた３つのＬＥＤの位置座標に基づいて、磁気センサ３の位置座標を算出する演算を行う。図３は、三角測量による位置座標の算出について説明する図である。
ＬＥＤ１８ｘ（１８ｘは１８ａ，１８ｂ，１８ｃ）の座標は、カメラ１２からＬＥＤ１８ｘへの方向角αｘと、カメラ１４からＬＥＤ１８ｘへの方向角βｘと、カメラ間距離ｄとがわかれば一意的に算出できる。方向角αｘは、カメラ１２の撮影方向と、カメラ１２により映された画像上におけるＬＥＤ１８ｘの位置とにより定めることができ、同様に方向角βｘは、カメラ１４の撮影方向と、カメラ１４により映された画像上におけるＬＥＤ１８ｘの位置とにより定めることができる。また、カメラ間距離ｄは既知であることから、αｘ、βｘ、ｄからＬＥＤ１８ｘの位置座標を算出することができる。

上記演算により、３つのＬＥＤ１８ａ，１８ｂ，１８ｃについて、それぞれの位置座標が求まることにより、これらＬＥＤ間の距離も簡単な計算により求めることができるので、３つのＬＥＤに識別情報（例えば発光波長の違い）が付されていない場合は、ＬＥＤ間の位置関係情報（距離の違い）からＬＥＤ１８ａ、１８ｂ、１８ｃを特定する。

３つのＬＥＤ１８ａ〜１８ｃについて位置が特定され、座標が定まることにより、ヘルメット１６のその時点での位置および向きが一義的に決定される。磁気センサ３のヘルメット１６上での位置は固定してあるので、磁気センサ位置算出部２１は、磁気センサ３の位置座標についても、ＬＥＤ１８ａ，１８ｂ，１８ｃの位置座標に基づいて一義的に特定する。

磁気マッピング部２２は、算出された磁気センサ３の位置座標とカメラ画像の撮影時に同時に測定された磁気データとに基づいて位置座標と磁気データとを対応付けて、図示しないメモリに蓄積する制御を行う。

次に、上記磁気マッピング装置による測定動作について説明する。
磁気ソース１１により、ヘッドモーショントラッカ（ＨＭＴ）を使用する際と同様の磁界を発生しておく（Ｓ１０１）。
続いて、ヘルメット１６を磁界内で移動させ、ある時点での磁気データを採取すると同時に、その時点の３つのＬＥＤ１８ａ〜１８ｃの位置座標を算出する（Ｓ１０２）。
続いて、算出された３つのＬＥＤ１８ａ〜１８ｃの位置座標、および、既知である磁気センサ３とＬＥＤ１８ａ〜１８ｃとのヘルメット１６上の位置関係とに基づいて、磁気センサの位置座標を算出する（Ｓ１０３）。

続いて、磁気データを採取した時点における磁気センサ３の位置座標（算出された位置座標）とその磁気データとを対応付けた磁気マッピングデータを作成し、図示しないメモリに蓄積していく（Ｓ１０４）。
続いて、ヘルメット１６の移動により、磁気センサ３の位置座標を変更する（Ｓ１０５）。
そして、新しい位置座標で磁気測定を続行するか否かを判断し、測定を続行するときはＳ１０２に戻って同様の処理を繰り返す。既に必要な領域の測定を終えたときは処理を終了する（Ｓ１０６）。

以上の測定動作により、磁気センサによる磁気データの測定を行いつつ、光学的手法で磁気データを採取したときの磁気センサ３の位置座標を求めるようにして、これらから磁気マッピングデータを作成することにより、測定時間を大幅に短縮するようにする。

(実施形態２)
実施形態１においては、ヘルメット１６の上部に３つのＬＥＤ１８ａ〜１８ｃをマーカとして取り付け、その上方に設けた一対のカメラ１２、１４によりステレオ視を行うようにした。この場合、通常の動作での頭部の移動範囲では問題ないが、ヘルメット１６を極端に傾けたときには、いずれかのＬＥＤがいずれかのカメラの視野から外れてしまうことがありうる。また、磁気マッピングを行う際に、何らかの事情で、カメラ１２、１４をヘルメット１６の上方に取り付けることができない場合もある。
それゆえ、ヘルメットをどのように傾けても、どのように回転させても、確実に３つのマーカを一対のカメラに同時に映し出すことができ、また、カメラをヘルメットの上方以外に取り付けても常にステレオ視することができるようにすることが望ましい。

そのため、本実施形態では、図５に示すように、ヘルメット１６ａに、マーカ群として少なくとも４つ以上のＬＥＤ１８を取り付けるようにする。取り付けるＬＥＤの適切な数は、ヘルメット１６ａの大きさや形状、一対のカメラ１２、１４の設置位置によって異なるが、要するに一対のカメラ１２、１４で撮影される一対の画像上に、それぞれ３つの共通のＬＥＤ１８が確実に含まれる程度にちりばめるようにする。例えば、図５では３つのＬＥＤ１８ａ〜１８ｃがそれぞれのカメラ画像に同時に含まれている。

各ＬＥＤ１８は、何らかの方法でそれぞれが他の隣接するＬＥＤ１８と識別できるようにする必要がある。本実施形態では、実施形態１の場合と同様に、識別情報としてＬＥＤごとに異なる発光波長（発光色）で発光するようにする。
これにより、各時点で一対のカメラ画像に共通に映し出されている３つのＬＥＤ１８ａ〜１８ｃを用いて、実施形態１と同様の位置座標を求める演算を行うことにより、３つのＬＥＤ１８ａ〜１８ｃの座標、さらには磁気センサ３の位置座標を求めることができ、磁気センサ３で計測した磁気データと対応付けることにより、磁気マッピングデータを得ることができる。

（実施形態３）
実施形態２では、使用する各ＬＥＤに、識別情報（例えば発光波長の違い）が含まれるようにしていた。しかしながら、ヘルメット１６ａに各ＬＥＤ１８を取り付けるときに、隣接するＬＥＤ間の距離を互いに異ならせることにより（３つのＬＥＤが正三角形を形成しないように取り付けることにより）、ＬＥＤ自体に識別情報（例えば発光波長の違い）を含んでいない場合でも、以下に説明する方法でカメラ画像上に映し出されたＬＥＤを識別し、さらに実施形態１で用いた演算を利用することによって、各ＬＥＤの位置座標を求めることができる。

ＬＥＤ自体に識別情報を含んでいない場合は、まず、図５に示すように、２つのカメラ１２、１４の視野内に入る３つのＬＥＤ（ただし３つの位置関係が正三角形とならないもの）を探索用マーカとして点灯し、それ以外のＬＥＤ群１８を消灯する。便宜上、これら３つのＬＥＤは、ＬＥＤ１８ａ、１８ｂ、１８ｃの組であるとする。

２つのカメラ１２、１４のそれぞれの画像Ａ、Ｂ内に、点灯中の３つのＬＥＤが映っていることを確認する。図６はこのときの画像例を示している。多数のＬＥＤが存在するなかで、ＬＥＤは３つだけが点灯している。この段階では、画像Ａ、Ｂ内に映る３つのＬＥＤ像は、それぞれがＬＥＤ１８ａ、１８ｂ、１８ｃのいずれかであることは判明しているが、それぞれのＬＥＤ像が、３つのうちのどれであるかは特定されていない。

そこで、エピポーラ幾何学に基づく予測により、画像Ａ、Ｂ間での共通のＬＥＤの組（探索用マーカの組）を認識するための対応付けを行う。図７は、エピポーラ幾何学に基づく予測を説明する図である。
カメラ１２の撮影方向とカメラ１４の撮影方向とが定まった状態で、カメラ１２の画像Ａには、点灯中のＬＥＤ１８ａ、１８ｂ、１８ｃのいずれかであるＬＥＤ１８ｘ（ＬＥＤ１８ｙ、ＬＥＤ１８ｚは図示を省略する）が映し出されているとする。このときカメラ１２とＬＥＤ１８ｘとを結ぶ仮想直線Ｌが存在するとして、これをカメラ１４で映したとすると、カメラ１４の画像Ｂ上に仮想直線ＬＢが映し出されることになる。画像Ｂ上の仮想直線ＬＢの位置は、画像Ａ内でのＬＥＤ１８ｘが映る位置、および、カメラ１２の撮影方向とカメラ１４の撮影方向との関係に基づいて一意的に定まる。そして、ＬＥＤ１８ｘの像は、この仮想直線ＬＢ上のいずれかの位置に存在することになる。したがって、画像Ｂ上に映し出される点灯中のＬＥＤ像のうちで、仮想直線ＬＢ上に存在するものがあれば、それがＬＥＤ１８ｘの像であると特定することができる。同様に、他の２つのＬＥＤ１８ｙの像、ＬＥＤ１８ｚの像についても特定することにより、画像Ａと画像Ｂとに映し出される３つのＬＥＤ１８ｘ、ＬＥＤ１８ｙ、ＬＥＤ１８ｚの組の対応付けを行うことができる。

続いて、３つの探索用マーカであるＬＥＤ１８ｘ、ＬＥＤ１８ｙ、ＬＥＤ１８ｚの位置座標を算出し、これら３つのＬＥＤの３次元位置を特定する。このとき、図３により先に説明した三角測量による位置座標特定方法を利用する。
すなわち、ＬＥＤ１８ｘの位置座標を求める場合は、方向角αｘはカメラ１２の撮影方向と、画像ＡにおけるＬＥＤ１８ｘの位置とにより定めることができ、方向角βｘはカメラ１４の撮影方向と、画像ＢにおけるＬＥＤ１８ｘの位置とにより定めることができる。また、カメラ間距離ｄは既知であることから、αｘ、βｘ、ｄからＬＥＤ１８ｘの位置座標が算出される。同様に、ＬＥＤ１８ｙ、ＬＥＤ１８ｚについても位置座標が算出される。

続いて、３つの探索用マーカであるＬＥＤ１８ｘ、ＬＥＤ１８ｙ、ＬＥＤ１８ｚ間の距離を算出する。これら３つのＬＥＤそれぞれの位置座標が算出されているので、ＬＥＤ１８ｘとＬＥＤ１８ｙとの距離ｄｘ、ＬＥＤ１８ｙとＬＥＤ１８ｚとの距離ｄｙ、ＬＥＤ１８ｚとＬＥＤ１８ｘとの距離ｄｚは、簡単な計算で求められる。

続いて、３つの探索用マーカであるＬＥＤ１８ｘ、ＬＥＤ１８ｙ、ＬＥＤ１８ｚが、それぞれＬＥＤ１８ａ、１８ｂ、１８ｃのいずれであるかを特定するための探索用マーカの識別を行う。探索用マーカの識別は、ＬＥＤ１８ｘ、ＬＥＤ１８ｙ、ＬＥＤ１８ｚ間の距離ｄｘ、ｄｙ、ｄｚと、予め既知であるＬＥＤ１８ａ、１８ｂ、１８ｃ間の距離ａ、ｂ、ｃとを比較することによりなされる。なお、ＬＥＤ１８ａ、１８ｂ、１８ｃ間の距離ａ、ｂ、ｃがすべて等しければ（すなわちＬＥＤ１８ａ、１８ｂ、１８ｃが正三角形の位置関係）、距離による探索用マーカ識別はできないことになるが、点灯させる３つのＬＥＤとして正三角形の位置関係とならないものを選択してあるので、識別が可能である。

続いて、３つのＬＥＤが識別され、ＬＥＤ１８ａ、１８ｂ、１８ｃが特定されると、これら３つのＬＥＤについての位置座標から、ヘルメット１６ａの位置および向きを特定することができる。ヘルメットの位置および向きが特定されることにより、そのヘルメット１６ａに固定されている磁気センサ３の位置座標についても特定できる。

以上の手順により、ＬＥＤ自体に識別情報を含んでいない場合であっても磁気センサ３の位置座標を求めることができるので、以下、実施形態１、２と同様の処理を実行することで、磁気マッピングを行うことができる。

本発明は、磁気方式のＨＭＴを使用する空間について磁気マッピングを行う場合に利用することができる。

本発明の一実施形態である磁気マッピング装置の構成を示すブロック構成図。 図１の磁気マッピング装置におけるヘルメットを上方から見た図。 三角測量によるＬＥＤ（マーカ）の位置座標の算出について説明する図。 本発明の一実施形態である磁気マッピング装置による処理手順を説明するフローチャート。 本発明の他の実施形態において用いるヘルメットおよびカメラ位置を説明する図。 カメラに映し出される画像例を説明する図。 エピポーラ幾何学に基づく予測を説明する図。 磁気方式のＨＭＴの構成を示す図。

符号の説明

１： 磁気マッピング装置
２： 磁気ソース
３： 磁気センサ
１２、１４： カメラ
１６： ヘルメット
１８： ＬＥＤ（マーカ）
２０： 制御演算部
２１： 磁気センサ位置算出部
２２： 磁気マッピング部

Claims (3)

1. ヘッドモーショントラッカの使用時と同様の磁界を発生する磁気ソースと、支持体と、前記支持体に取り付けられ前記磁界中の磁気データを測定する磁気センサと、互いに正三角形を形成しないようにして前記支持体の外表面に取り付けられ前記磁気センサに対する位置が固定されるとともに互いの間の距離情報が既知である少なくとも３つのマーカ群と、３つのマーカを同時にステレオ視するための一対のカメラと、前記一対のカメラで撮影された各画像に同時に映る３つのマーカの画像上の位置に基づいてエピポーラ幾何学に基づく予測により３つのマーカの対応付けを行い、次いで対応付けられた３つのマーカの位置座標を三角測量により求めるとともに求めた位置座標から３つのマーカ間の距離を求め、次いで既知であるマーカ間の距離情報との比較により３つのマーカの識別を行い、識別された３つのマーカの位置座標に基づいて磁気センサの位置座標を算出する磁気センサ位置算出部と、算出された磁気センサの位置座標とカメラ画像の撮影時に測定された磁気データとに基づいて位置座標と磁気データとを対応付けた磁気マッピングデータを蓄積する磁気マッピング部とを備えたことを特徴とする磁気マッピング装置。
   
2. 支持体として頭部装着型支持体を用いることを特徴とする請求項１に記載の磁気マッピング装置。
3. 前記マーカ群は、いずれの方向からも少なくとも３つのマーカが一対のカメラで撮影されるように頭部装着型支持体の外表面全体に散りばめて配置することを特徴とする請求項２に記載の磁気マッピング装置。
   

Images