(57)【要約】【課題】本発明の課題は、新たな外部装置などを用いることなく送信装置及び受信装置内部の情報のみに基いて送信装置と受信装置間の相対位置と姿勢を検出する光空間通信システムの相対位置姿勢推定装置を提供することにある。【解決手段】本発明は、光空間通信システムにおいて、各可動式反射鏡の動きデータとＰＳＤ上のレーザービームスポットの軌跡データから送信装置における射出ビームの発射位置及び発射方向ベクトルとそれらの微分ベクトル、さらに受信装置における入射ビームの到達位置及び入射方向ベクトルとそれらの微分ベクトルを求めて、これより送信装置と受信装置の相対位置と姿勢を推定することを特徴とする。【選択図】図１
2006319625.tif 000002
【特許請求の範囲】
【請求項１】
空間中にレーザー光を伝播させて通信を行う光空間通信システムであって、送信装置側に送信用レーザー光源によるレーザー光の発射方向（パン・チルト角）が調整可能なように２自由度の可動式反射鏡を備え、受信装置側に送信側から到達したレーザー光の向きを調整し直列に配置された２つのビームスプリッターへ導く２自由度の可動式反射鏡と最初のビームスプリッターにより２分した一方の分岐光を次のビームスプリッターによりさらに２分したレーザー光それぞれの照射位置を検知する２つのＰＳＤ（Ｐｏｓｉｔｉｏｎ  Ｓｅｎｓｉｎｇ  Ｄｅｖｉｃｅ）を備え、最初のビームスプリッターによる他方の分岐光を受信用ＰＤ（Ｐｈｏｔｏ  Ｄｅｔｅｃｔｏｒ）で受光することが可能な光空間通信システムにおいて、各可動式反射鏡の動きデータとＰＳＤ上のレーザービームスポットの軌跡データから送信装置における射出ビームの発射位置及び発射方向ベクトルとそれらの微分ベクトル、さらに受信装置における入射ビームの到達位置及び入射方向ベクトルとそれらの微分ベクトルを求めて、これより送信装置と受信装置の相対位置と姿勢を推定することを特徴とする光空間通信システムの相対位置姿勢推定装置。
【請求項２】
請求項１に記載の光空間通信システムの相対位置姿勢推定装置において、送信装置からみた受信装置の位置ベクトルに相対姿勢をノルム１の四元数で表したものを合わせた７次元の状態ベクトルを定義し、可動式反射鏡の角度とＰＳＤにより捉えられたレーザービームスポット位置の時系列データにおいて時間的に隣り合うデータをある時刻において同時に観測されたものとみなして導出される観測方程式を基に拡張カルマンフィルタを構成して送信装置と受信装置の相対位置と姿勢を推定することを特徴とする光空間通信システムの相対位置姿勢推定装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、空間中にレーザー光を伝播させて通信を行う光空間通信システムにおいて、送信装置と受信装置間の相対位置・姿勢を送信装置及び受信装置内部の情報のみを基にして推定することの可能な相対位置姿勢推定装置に関するものである。
【背景技術】
【０００２】
例えばビル−ビル間光空間通信のような通常の光空間通信では２つの送受信機を固定的に対向配置し風や振動などによる微小な軸ズレの影響を補正するメカニズムが採用されている。一方、端末の移動を伴う光空間通信では広範囲な相対位置変化に伴う軸ズレに対応する光軸調整機構が不可欠となる（例えば、非特許文献１参照。）。この場合送受信機間の距離や向きの変化を光軸調整サーボシステムに正しく反映させることが軸合わせの精度を保つ上で重要となる。このことは仮に送受信機の１８０度の相対的な向きの変化が無視されれば光軸調整のフィードバックが逆方向に作用しサーボ機構の用を成さないことを考えれば明らかである。このような相対位置・姿勢情報を例えば１つの移動局に対して複数の固定局を用意して三角測量の原理で提供することが考えられるが、そのような状態の定常的な保証可能性や設備コストの増大といった問題が生じてくる。
【０００３】
【非特許文献１】Koichi Yoshida,Tatsuro Yano,and Takeshi Tsujimura:“Automatic Optical Axis Alignment for Active Free Space Optics”,SICE Annual Conference in Sapporo,August4-6,2004,Hokkaido Institute of Tecnology,Japan,p.2035-2040
【発明の開示】
【発明が解決しようとする課題】
【０００４】
本発明は上記の事情に鑑みてなされたもので、新たな外部装置などを用いることなく送信装置及び受信装置内部の情報のみに基いて送信装置と受信装置間の相対位置と姿勢を検出する光空間通信システムの相対位置姿勢推定装置を提供することを目的とする。
【課題を解決するための手段】
【０００５】
上記目的を達成するために本発明の光空間通信システムの相対位置姿勢推定装置は、空間中にレーザー光を伝播させて通信を行う光空間通信システムであって、送信装置側に送信用レーザー光源によるレーザー光の発射方向（パン・チルト角）が調整可能なように２自由度の可動式反射鏡を備え、受信装置側に送信側から到達したレーザー光の向きを調整し直列に配置された２つのビームスプリッターへ導く２自由度の可動式反射鏡と最初のビームスプリッターにより２分した一方の分岐光を次のビームスプリッターによりさらに２分したレーザー光それぞれの照射位置を検知する２つのＰＳＤ（Ｐｏｓｉｔｉｏｎ  Ｓｅｎｓｉｎｇ  Ｄｅｖｉｃｅ）を備え、最初のビームスプリッターによる他方の分岐光を受信用ＰＤ（Ｐｈｏｔｏ  Ｄｅｔｅｃｔｏｒ）で受光することが可能な光空間通信システムにおいて、各可動式反射鏡の動きデータとＰＳＤ上のレーザービームスポットの軌跡データから送信装置における射出ビームの発射位置及び発射方向ベクトルとそれらの微分ベクトル、さらに受信装置における入射ビームの到達位置及び入射方向ベクトルとそれらの微分ベクトルを求めて、これより送信装置と受信装置の相対位置と姿勢を推定することを特徴とするものである。
【０００６】
また本発明は、前記光空間通信システムの相対位置姿勢推定装置において、送信装置からみた受信装置の位置ベクトルに相対姿勢をノルム１の四元数で表したものを合わせた７次元の状態ベクトルを定義し、可動式反射鏡の角度とＰＳＤにより捉えられたレーザービームスポット位置の時系列データにおいて時間的に隣り合うデータをある時刻において同時に観測されたものとみなして導出される観測方程式を基に拡張カルマンフィルタを構成して送信装置と受信装置の相対位置と姿勢を推定することを特徴とするものである。
【発明の効果】
【０００７】
本発明によれば、移動を伴う光空間通信システムの送信装置と受信装置間の相対位置・姿勢を新たな外部装置等の付加なしに送信装置及び受信装置の内部情報のみによって検出可能という効果がある。
【０００８】
また本発明は、位置ベクトルに姿勢を表す四元数を組み合わせて状態ベクトルを定義し可動式反射鏡の動きとＰＳＤによるレーザー光のビームスポット軌跡の時系列データに拡張カルマンフィルタを適用することによって耐ノイズ性に優れた相対位置・姿勢の滑らかな推定が可能となる。これにより光軸調整サーボシステムを適切に作動させることができるとともに移動局の現在位置情報に基いてユーザーにとって有益な情報を提供したり最も適切な固定局への切替を促したりするといった付加価値の創出が期待できるという効果がある。
【発明を実施するための最良の形態】
【０００９】
以下図面を参照して本発明の実施の形態例を詳細に説明する。
図１は本発明が対象とする光空間通信システムを示す構成説明図である。図１において、送信装置１１にはレーザー光Ｌを発射する送信用ＬＤ（Ｌａｓｅｒ  Ｄｉｏｄｅ）が設けられ、前記送信用ＬＤからのレーザー光照射位置にはモーターＤ１の回転軸に取り付けられたミラー（反射鏡）Ｍ１が設けられる。前記モーターＤ１の回転軸に直交するように回転軸が配置されたモーターＤ２の回転軸にはミラーＭ２が設けられる。ミラーＭ２はミラーＭ１からの反射光が照射される位置に設けられる。この場合、送信用ＬＤからのレーザー光Ｌの発射方向がモーターＤ２の回転軸方向になるように配置する。送信用ＬＤからミラーＭ１上のモーターＤ１の回転軸に対応する位置にレーザー光Ｌを発射して、２自由度の可動式反射鏡であるミラーＭ１及びミラーＭ２での反射を経て受信側へ送出する。送信用ＬＤによるレーザー光の発射方向（パン・チルト角）はモーターＤ１，Ｄ２を回転してミラーＭ１，Ｍ２の角度を変化させることにより調整できる。
【００１０】
受信装置１２に送信側から到達したレーザー光ＬはモーターＤ３の回転軸に取り付けられたミラーＭ３に入射される。前記モーターＤ３の回転軸に直交するように回転軸が配置されたモーターＤ４の回転軸にはミラーＭ４が設けられる。ミラーＭ４はミラーＭ３からの反射光が照射される位置に設けられる。ミラーＭ４からの反射光が照射される位置には直列に配置された２つのビームスプリッターＳ１，Ｓ２が設けられる。２自由度の可動式反射鏡であるミラーＭ３及びミラーＭ４は送信側から到達したレーザー光Ｌの向きを調整し直列に配置された２つのビームスプリッターＳ１，Ｓ２へ導く。最初のビームスプリッターＳ１により２分した一方の分岐光を次のビームスプリッターＳ２によりさらに２分したレーザー光Ｌそれぞれの照射位置には２つのＰＳＤ（Ｐｏｓｉｔｉｏｎ  Ｓｅｎｓｉｎｇ  Ｄｅｖｉｃｅ）１，ＰＳＤ２が設けられ、ＰＳＤ１，ＰＳＤ２はそれぞれレーザー光Ｌを検知する。最初のビームスプリッターＳ１による他方の分岐光を受光する位置には受信用ＰＤ（Ｐｈｏｔｏ  Ｄｅｔｅｃｔｏｒ）が設けられる。
【００１１】
送信装置１１及び受信装置１２にはそれぞれ制御部Ｃ１，Ｃ２が設けられ、電波または赤外線などによる通常の無線ＬＡＮにより互いの情報を交換できるようなインターフェイスを持っている。
【００１２】
いま、受信装置１２への到達光がミラーＭ３で反射されさらにミラーＭ４で反射されたレーザー光が直列に配置された２つのビームスプリッターＳ１，Ｓ２を貫通するようにモーターＤ３，Ｄ４の回転角が調整されているものとする。このときビームスプリッターＳ１のプリズム斜面Ｐ１に対する受信用ＰＤの鏡像をＰＤ′、ビームスプリッターＳ２のプリズム斜面Ｐ２に対するＰＳＤ２の鏡像をＰＳＤ２′とするとき、ＰＳＤ１とＰＳＤ２′が重ならないように配置されていればミラーＭ４からの反射光とＰＤ′の光軸との関係はミラーＭ４からの反射光とＰＳＤ１及びＰＳＤ２′受光面との交点の座標によりパラメトライズされることがわかる。従って、ミラーＭ４からの反射光とＰＤの光軸が一致する場合の２つのＰＳＤ１及びＰＤＳ２上のレーザースポット座標を基準点とすれば、送信装置１１及び受信装置１２の相対位置が変化して光軸が外れたときもＰＳＤ１及びＰＤＳ２上のレーザースポットが基準点に戻るようにモーターＭ３，Ｍ４の回転角を調整することにより常に光軸を一致させることが可能となる。このようなモーター回転角の存在する条件とその場合の光軸を一致させるアルゴリズムが非特許文献１に記載されている。以降、送信装置１１及び受信装置１２に固定された座標系をそれぞれΣＴ，ΣＲ，ΣＴからみたΣＲの位置ベクトルと回転（姿勢）行列をそれぞれｒ，Ｒとする。
【００１３】
本発明の第１の実施形態例は以下の通りである。
図１に示すような光空間通信システムにおいて、各可動式反射鏡であるミラーＭ１〜Ｍ４の動きデータとＰＳＤ１及びＰＳＤ２上のレーザービームスポットの軌跡データから送信装置１１における射出レーザービームの発射位置及び発射方向ベクトルとそれらの微分ベクトル、さらに受信装置１２における入射ビームの到達位置及び入射方向ベクトルとそれらの微分ベクトルを求めて、これより送信装置１１と受信装置１２の相対位置と姿勢が推定可能な相対位置姿勢推定装置を提供することができる。
【００１４】
すなわち、ＰＳＤ１とＰＳＤ２で捕らえられたレーザー光のビームスポットが送信装置１１のミラーＭ１，Ｍ２の微小な動きに対して変化する様子が記録されたときに２つのＰＳＤ１及びＰＳＤ２から逆に光線追跡を行った場合に得られるΣＲからみたミラーＭ３上のレーザースポット位置とレーザー光の入射ベクトル（単位ベクトル）をそれぞれｒ３，ｐ３、また、その微分ベクトルを
【数１】
2006319625.tif 000003
とする。一方、これに対応する送信装置１１のミラーＭ２上でのビームスポットのΣＴからみた位置ベクトルとレーザー光の射出ベクトル（単位ベクトル）をｒ２，ｐ２、微分ベクトルを
【数２】
2006319625.tif 000004
で表す。明らかに
ｐ２＝Ｒｐ３                                          （１）
【００１５】
また、ミラーの動きに対してｒ，Ｒの動きが無視できるとき
【数３】
2006319625.tif 000005
であることから、Ｒは次のように求められる。
【数４】
2006319625.tif 000006
【００１６】
一方、ｋを適当なスカラーとすればｒ２とｒ３の間に次式が成立する。
Ｒｒ３＋ｒ＝ｋｐ２＋ｒ２                                （４）
【００１７】
同様にミラーＭ１〜Ｍ４の動きに対して送信装置１１と受信装置１２間の相対位置変化が無視できるときは
【数５】
2006319625.tif 000007
が成り立つが、ここで両辺のｐ２と垂直な平面への射影を考える。ｐ２はΣＲではｐ３で置き換えられるため新たに
【数６】
2006319625.tif 000008
を定義し、さらに
【数７】
2006319625.tif 000009
とおく。このとき
【数８】
2006319625.tif 000010
が直交することを考慮すれば上式より次式が成立する。
【数９】
2006319625.tif 000011
【００１８】
これよりｋが
【数１０】
2006319625.tif 000012
より求まるので、これを式（４）へ代入してｒを得る。
【００１９】
次に本発明の第２の実施形態例について説明する。
第１の実施形態例に係る光空間通信システムの相対位置姿勢推定装置において、送信装置１１からみた受信装置１２の位置ベクトルに相対姿勢をノルム１の四元数で表したものを合わせた７次元の状態ベクトルを定義し、可動式反射鏡であるミラーＭ１〜Ｍ４の角度とＰＳＤ１及びＰＳＤ２により捉えられたビームスポット位置の時系列データにおいて時間的に隣り合うデータをある時刻において同時に観測されたものとみなして導出される観測方程式を基に拡張カルマンフィルタを構成して送信装置１１と受信装置１２の相対位置と姿勢が推定可能な相対位置姿勢推定装置を提供することができる。
【００２０】
すなわち、ΣＴからみたΣＲの位置と姿勢を受信装置１２上のＰＳＤ１及びＰＳＤ２で捉えられたビームスポット軌跡の時系列測定値から拡張カルマンフィルタを用いて推定する。ただし、回転（姿勢）行列はノルム１の四元数ｑ＝［ｑ１  ｑ２  ｑ３  ｑ４］Ｔにより表現する。ノルム１の複素数が２次元の回転を表すようにノルム１の四元数は３次元の回転を表すことができ、回転行列との間に次のような関係式が成立する。
【数１１】
2006319625.tif 000013
【００２１】
ここで、ｒ＝［ｘ  ｙ  ｚ］Ｔを含め推定すべき状態ベクトルＸを次のように定義する。
【数１２】
2006319625.tif 000014
【００２２】
さらに、時系列の測定データから状態推定を行うため次のような状態変化モデルを導入する。
Ｘｋ＋１＝Ｘｋ＋ｗｋ                        （８）
ｙｋ＝ｈ（Ｘｋ，θｋ）＋ｖｋ                （９）
【００２３】
ただし、ｙは２つのＰＳＤ１及びＰＳＤ２上のビームスポット位置に関する観測値ベクトル、ｈ（Ｘｋ，θｋ）は送信装置１１及び受信装置１２の相対位置・姿勢Ｘと各モーター回転角θ（＝［θ１  θ２  θ３  θ４］Ｔ）からビームスポット位置への写像を表す関数である。また、ｗ、ｖはそれぞれシステムノイズと観測ノイズベクトルを表す。各変数の添え字ｋは時系列上のサンプリング数を示す。
【００２４】
明らかに上記の状態変化モデルにおいてＰＳＤ１及びＰＳＤ２′上のビームスポットの測定値を単独に観測値ベクトルとして状態推定を行うことは不可能である。そこで１サンプリング時間でのＸｋの変化は微小であると仮定して、連続する２サンプルの観測データを観測値ベクトルへ割り当てることを考え、新たにＰＳＤ１及びＰＳＤ２におけるビームスポットへの写像に関する次のような関数
【数１３】
2006319625.tif 000015
を構成する。
【数１４】
2006319625.tif 000016
【００２５】
対応する観測値ベクトルは次のように拡張しておく。
【数１５】
2006319625.tif 000017
【００２６】
ただし、それぞれ３番目の要素は姿勢を表す四元数のノルムが１であることに対応している。式（９）に代わって観測方程式を新たに次のように定義する。
【数１６】
2006319625.tif 000018
【００２７】
ここで、ｗｋ，ｖｋは平均値ベクトル０で互いに独立としその共分散行列がそれぞれΣｗ，Σｖで与えられるものとすれば次のような拡張カルマンフィルタを適用することにより状態推定が可能となる。
【数１７】
2006319625.tif 000019
【００２８】
なお、本発明は、上記実施形態例そのままに限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で構成要素を変形して具体化できる。また、上記実施形態例に開示されている複数の構成要素の適宜な組み合せにより種々の発明を形成できる。例えば、実施形態例に示される全構成要素から幾つかの構成要素を削除してもよい。更に、異なる実施形態例に亘る構成要素を適宜組み合せてもよい。
【図面の簡単な説明】
【００２９】
【図１】本発明が対象とする光空間通信システムを示す構成説明図である。
【符号の説明】
【００３０】
１１…送信装置、１２…受信装置、ＬＤ…レーザーダイオード（レーザー光源）、Ｄ１〜Ｄ４…モーター、Ｍ１〜Ｍ４…ミラー、ＰＤ…ホトディテクタ、ＰＳＤ１，ＰＳＤ２…ポジションセンスデバイス、Ｓ１，Ｓ２…ビームスプリッター、Ｃ１，Ｃ２…制御部。
【図１】
2006319625.tif 000020