JP4004165B2 - 姿勢角検出装置 - Google Patents
姿勢角検出装置 Download PDFInfo
- Publication number
- JP4004165B2 JP4004165B2 JP37596598A JP37596598A JP4004165B2 JP 4004165 B2 JP4004165 B2 JP 4004165B2 JP 37596598 A JP37596598 A JP 37596598A JP 37596598 A JP37596598 A JP 37596598A JP 4004165 B2 JP4004165 B2 JP 4004165B2
- Authority
- JP
- Japan
- Prior art keywords
- angle
- axis
- posture
- correction coefficient
- static
- 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.)
- Expired - Lifetime
Links
Images
Landscapes
- Gyroscopes (AREA)
- Measuring Magnetic Variables (AREA)
- Geophysics And Detection Of Objects (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、特に、移動体の姿勢検出や姿勢制御、バーチャルリアリティ等に使用されるヘッドマウントディスプレイ（以下、ＨＭＤという）のうち頭の姿勢角を検出するトラッカー、３Ｄゲームパッド等、３次元空間中で対象物の姿勢角（３軸の回転角）の検出に用いるのに適した姿勢角検出装置に関する。
【０００２】
【従来の技術】
従来、バーチャルリアリティーに使用され、頭の動きを検出する方法として、外部に設置された交流磁場発生源から微弱交流磁場を発生し、ＨＭＤに配置したセンサ部で検知し、制御演算部で頭の動きを検出する交流磁場を利用する方法や、外部に設置された超音波発生源からの超音波信号をＨＭＤに配置したセンサ部で検知し、制御演算部で頭の動きを検出する超音波を利用する方法がある。
【０００３】
【発明が解決しようとする課題】
しかしながら、前者の交流磁場を利用した方法では、信号発生源が微弱交流磁場のため、ノイズをキャンセルするためにフィルタを多用することにより応答性が低下し、頭の動きに比べて、ＨＭＤの映像の動きが遅くなり、気分を悪くしたり、酔いを発生する場合があった。
【０００４】
また、後者の超音波を利用した方法では、他の様々な超音波信号の影響を受けての誤動作や、信号発生源とセンサとの間の遮蔽物により信号を検出できなくなる可能性があり、センサの前に腕や髪の毛があるだけで受信不能になり、誤動作してしまうなどの問題があった。
【０００５】
従って、本発明は、上記問題点を解消し、使用する場所や環境の制限を緩和し、幅広く使用できる姿勢角検出装置を提供するものである。
【０００６】
【課題を解決するための手段】
本発明は、水平面で直交するＸ軸、Ｙ軸及び該Ｘ軸、Ｙ軸のそれぞれに直交するＺ軸回りの角速度を検出する３個のジャイロと、該ジャイロの角速度に応じた出力に基づいて、Ｚ軸回りの回転角であるヨー角、Ｚ軸の回りにヨー角だけ座標軸を回した後の新しいＹ軸回りの回転角であるピッチ角及びＺ軸の回りにヨー角だけ回し、新しいＹ軸の回りにピッチ角だけ回した後のさらに新しいＸ軸回りの回転角であるロール角を演算する運動角演算装置と、少なくともＸ−Ｙ平面で互いに直交する２軸の加速度を検出するように配置され、ロ−ル角、ピッチ角を検出するための加速度センサと、少なくとも前記２軸の地磁気を検出するよう配置される地磁気センサと、該加速度センサ及び地磁気センサの出力に基づいて、ロール角、ピッチ角及びヨー角を演算する静止角演算装置と、該静止角演算装置による演算結果の真偽を判定演算する判別装置と、前記静止角演算装置による演算結果により姿勢角の補正係数を選択する補正係数選択装置と、前記判別装置の演算結果に応じて、前記運動角演算装置と静止角演算装置の演算結果及び前記補正係数選択装置の選択結果から出力する姿勢角を演算する姿勢角演算装置とから構成されることを特徴とする姿勢角検出装置である。
【０００７】
また、本発明は、前記補正係数選択装置において、静止角検出手段から求められる静止角[仮のロール角Ｒ（ｎ）、仮のピッチ角Ｐ（ｎ）、仮のヨー角Φ（ｎ）]は、あらかじめ予想される精度によって複数の領域に分けられており、補正係数選択装置は前記分割された領域に応じた補正係数ｍ１（ｉ）、ｍ２(ｉ)、ｍ３（ｉ）（但し、ｉは２以上の前記分割領域を表す自然数で、ｉが小さいほど静止角が小さく予想される精度が良い）を持ち、現在の静止角の領域に応じて補正係数を選択して姿勢角を演算することを特徴とし、前記補正係数ｍ１(ｉ)、ｍ２(ｉ)、ｍ３(ｉ)は、
ｍ１（１）＞＝ｍ１（２）＞＝・・・・・・＞＝ｍ１（ｉ）
ｍ２（１）＞＝ｍ２（２）＞＝・・・・・・＞＝ｍ２（ｉ）
ｍ３（１）＞＝ｍ３（２）＞＝・・・・・・＞＝ｍ３（ｉ）
であることを特徴とする姿勢角検出装置である。
【０００８】
また、本発明は、前記姿勢角検出装置の求めるべき出力をロール角α（ｎ）、ピッチ角β（ｎ）、ヨー角γ（ｎ）、運動角検出手段から求められる運動角を、仮のロール角変化ΔＸ（ｎ）、仮のピッチ角変化ΔＹ（ｎ）、仮のヨー角変化ΔＺ（ｎ）、静止角検出手段から求められる静止角を、仮のロール角Ｒ（ｎ）、仮のピッチ角Ｐ（ｎ）、仮のヨー角Φ（ｎ）、求めるべき出力と静止角との誤差をα（ｎ−１）＋ΔＸ（ｎ）−Ｒ（ｎ）、β（ｎ−１）＋ΔＹ（ｎ）−Ｐ（ｎ）、γ（ｎ−１）＋ΔＺ（ｎ）−Φ（ｎ）、１以下の比例定数をｋ、前記補正係数選択装置により選択された補正係数をｍ１、ｍ２、ｍ３とすると、判別装置の判別結果により、 静止角検出手段からのそれぞれの姿勢角情報Ｒ・Ｐ・Φのうち正しいと判別されたときの姿勢角は、
α(ｎ)＝α(ｎ−１)＋ΔＸ(ｎ)−ｋ［α(ｎ−１)＋ΔＸ(ｎ)−Ｒ(ｎ)］×ｍ１、
β(ｎ)＝β(ｎ−１)＋ΔＹ(ｎ)−ｋ［β(ｎ−１)＋ΔＹ(ｎ)−Ｐ(ｎ)］×ｍ２、
γ(ｎ)＝γ(ｎ−１)＋ΔＺ(ｎ)−ｋ［γ(ｎ−１)＋ΔＺ(ｎ)−Φ(ｎ)］×ｍ３により、
静止角検出手段からのそれぞれの姿勢角情報Ｒ・Ｐ・Φのうち誤りと判別された姿勢角情報に対応する姿勢角は、
α（ｎ）＝α（ｎ−１）＋ΔＸ（ｎ）、
β（ｎ）＝β（ｎ−１）＋ΔＹ（ｎ）、
γ（ｎ）＝γ（ｎ−１）＋ΔＺ（ｎ）により、
演算することを特徴とする姿勢角検出装置である。
【０００９】
【発明の実施の形態】
以下、図面によって本発明の実施の形態について説明する。
【００１０】
図１は、姿勢角検出装置を適用したＨＭＤの一例を示し、このＨＭＤは、目前にあるディスプレイに表示された映像が使用者の頭の動きに連動して変化し、仮想空間を体験できるように設けられているもので、このＨＭＤを装着したまま右を向くと、姿勢角検出装置で計測した頭の姿勢角を映像発生装置に送信し、映像発生装置は、その姿勢角にあった映像をＨＭＤに送信するので、右に展開する映像が映し出され、頭の動きによって全空間の３６０度の映像を実感できるように設けられているものである。
【００１１】
図１に示すように、符号１は、ＨＭＤ本体を示し、このＨＭＤ本体１には、本発明である姿勢角検出装置２が配置され、信号ケーブル４で映像発生装置７に接続されている。
【００１２】
図２は、本発明における姿勢角検出装置の全体構成を示すブロック図である。図２に示すように、３個のジャイロ１２ａ，１２ｂ，１２ｃの出力から仮の姿勢角を演算して求める運動角演算装置１８を備えた運動角検出手段１１と、２個の地磁気センサ２２ａ，２２ｂと２個の加速度センサ２３ａ，２３ｂから静止角を求める静止角演算装置２４を備えた静止角検出手段２１と、この静止角検出手段２１で求めた姿勢角に誤差が含まれるかどうか（例えば、直線的な加速度が加わって、傾斜計としての加速度センサに傾斜以外の信号が含まれる場合）を判別する判別装置３２と、静止角により補正係数を選択する補正係数選択装置３３と、運動角演算装置１８、静止角演算装置２４、及び判別装置３２からの信号を処理する姿勢角演算装置４２とで構成されている。
【００１３】
図３は、本発明の姿勢角検出装置におけるジャイロ、加速度センサ、地磁気センサの配置を示す説明図である。図３に示すように、互いに直交する３軸（水平面で直交する軸をＸ軸、Ｙ軸、そのＸ軸、Ｙ軸それぞれに直交する軸をＺ軸、Ｚ軸回りの回転角をヨー角、Ｚ軸の回りにヨー角だけ座標軸を回した後の新しいＹ軸回りの回転角をピッチ角及びＺ軸の回りにヨー角だけ回し、新しいＹ軸の回りにピッチ角だけ回した後のさらに新しいＸ軸回りの回転角をロール角と記す）の回りの角速度を検出するための第１のジャイロ１２ａ、第２のジャイロ１２ｂ及び第３のジャイロ１２ｃは、センサ座標Ｘ、Ｙ、Ｚ軸各軸に平行に、即ち互いに直交して配置されている。ヨー角を検出する第１の地磁気センサ２２ａ及び第２の地磁気センサ２２ｂは、水平面で互いに直交する２軸（ここでは、センサ座標Ｘ軸及びＹ軸）とで構成されている。同様に、第１の加速度センサ２３ａ及び第２の加速度センサ２３ｂは、水平面で互いに直交する２軸（ここでは、センサ座標Ｘ軸及びＹ軸）に配置されている。ジャイロは、圧電セラミック、圧電単結晶、あるいは、シリコン等の非磁性材料からなる振動子を用いることができる。尚、本実施の形態では、（株）トーキン製の圧電振動セラミックジャイロを用いた。
【００１４】
次に、本発明の姿勢角検出装置のうち、静止角演算装置について示す。２軸の加速度センサ出力から得られるＸ軸方向の加速度Ａｘ（ｎ）及びＹ軸方向の加速度Ａｙ（ｎ）より、ロール角Ｒ（ｎ）及びピッチ角Ｐ（ｎ）を下記の式（１）、（２）より求める。
【００１５】
Ｒ（ｎ）＝ｓｉｎ-1[Ａｘ（ｎ）／ｃｏｓＰ（ｎ）]・・・・・（１）
【００１６】
Ｐ（ｎ）＝ｓｉｎ-1Ａｙ（ｎ）・・・・・・・（２）
【００１７】
ここで、上記式（１）、（２）は、アークサイン関数である。従って、Ｒ、Ｐは、低角度のとき精度が高く、高角度のときは精度が低い。例えば、Ａｘ、Ａｙの出力分解能が０.０１Ｇのときを考えると、０°付近での分解能は０.５７°であり、９０°付近の分解能は８.１１°である。また、Φに関しても、演算過程にＲ、Ｐを用いているので、Ｒ、Ｐのいずれかが高角度のときに精度が低くなる。したがって、Ｒ、Ｐが高角度のときは静止角演算装置が正しいと判断した場合にも精度が低いことに留意しなければならない。
【００１８】
次に、本発明の姿勢角検出装置のうち、補正係数選択装置について示す。上記のように静止角の精度は変化するが、あらかじめこれをいくつかの領域に分割し、それぞれの領域に適当な補正係数ｍ１、ｍ２、ｍ３を入れておく。表１にその１例を示す。
【００１９】
（表１）
【００２０】
表１に示すように、Ｒ、Ｐが高角度になり精度が低くなるにつれて、補正係数が小さくなる。ｍ１にはＲの精度が影響し、ｍ２にはＰの精度が影響し、ｍ３にはＲ、Ｐ両方の精度が影響していることが分かる。このように、補正係数選択装置は現在の姿勢角により補正係数ｍ１、ｍ２、ｍ３を決定する。
【００２１】
次に、本発明の姿勢角検出装置のうち、姿勢角演算装置について示す。本発明の姿勢角検出装置の求めるべき出力をα（ｎ）、β（ｎ）、γ（ｎ）、動的な運動角検出手段から得られる仮の姿勢角をＸ（ｎ）、Ｙ（ｎ）、Ｚ（ｎ）、静的な静止角検出手段から求められる静止角をＲ（ｎ）、Ｐ（ｎ）、Φ（ｎ）とすると、静止角検出手段からの姿勢角情報Ｒ及びＰが正しいと判断された場合は、
α(ｎ)＝α(ｎ−１)＋ΔＸ(ｎ)−ｋ［α(ｎ−１)＋ΔＸ(ｎ)−Ｒ(ｎ)］×ｍ１
β(ｎ)＝β(ｎ−１)＋ΔＹ(ｎ)−ｋ［β(ｎ−１)＋ΔＹ(ｎ)−Ｐ(ｎ)］×ｍ２
γ(ｎ)＝γ(ｎ−１)＋ΔＺ(ｎ)−ｋ［γ(ｎ−１)＋ΔＺ(ｎ)−Φ(ｎ)］×ｍ３
により、姿勢角を演算する。ここで、ｋは任意に選択させる１以下の比例定数である。
【００２２】
また、静止角検出手段からの姿勢角情報が誤と判断する場合、
α（ｎ）＝α（ｎ−１）＋ΔＸ（ｎ）
β（ｎ）＝β（ｎ−１）＋ΔＹ（ｎ）
γ（ｎ）＝γ（ｎ−１）＋ΔＺ（ｎ）
により、姿勢角を演算し、求める。
【００２３】
従って、本実施の形態のように、本発明の姿勢角検出装置をＨＭＤに適用した場合、外部信号を用いることなく、高速応答で累積誤差のない角度情報を得ることができ、高性能である。 なお、本発明による姿勢角検出装置において、ジャイロを素子で搭載しているので、小型軽量化が可能であり、セラミック振動子を使用しているので、磁気ノイズは受けず、磁気センサと近接させても、機能を損なうことがない。
【００２４】
また、本実施の形態では、地磁気センサ、加速度センサが、それぞれ２個の例を示したが、少なくとも、どちらか一方が３個でもよい。小型化という点では、本実施の形態が最も好ましい。
【００２５】
【発明の効果】
本発明によれば、使用する場所や環境の制限を緩和し、幅広く使用できる姿勢角検出装置を提供することができた。
【図面の簡単な説明】
【図１】本発明のＨＭＤにおける姿勢角検出装置の使用状況の説明図。
【図２】本発明の姿勢角変換装置の全体構成を示すブロック図。
【図３】本発明の姿勢角検出装置におけるジャイロ、加速度センサ、地磁気センサの配置を示す説明図。
【符号の説明】
１ ＨＭＤ本体
２ 姿勢角検出装置
４ 信号ケーブル
７ 映像発生装置
１１ 運動角検出手段
１２ａ （第１の）ジャイロ
１２ｂ （第２の）ジャイロ
１２ｃ （第３の）ジャイロ
１３ａ （第１の）Ａ／Ｄコンバータ
１３ｂ （第２の）Ａ／Ｄコンバータ
１３ｃ （第３の）Ａ／Ｄコンバータ
１４ （ＩＩＲ型）デジタルハイパスフィルタ
１５ 正負反転判定装置
１６ ＩＩＲ係数リセット装置
１７ オフセット修正装置
１８ 運動角演算装置
２１ 静止角検出手段
２２ａ （第１の）地磁気センサ
２２ｂ （第２の）地磁気センサ
２３ａ （第１の）加速度センサ
２３ｂ （第２の）加速度センサ
２４ 静止角演算装置
３２ 判別装置
３３ 補正係数選択装置
４２ 姿勢角演算装置
【発明の属する技術分野】
本発明は、特に、移動体の姿勢検出や姿勢制御、バーチャルリアリティ等に使用されるヘッドマウントディスプレイ（以下、ＨＭＤという）のうち頭の姿勢角を検出するトラッカー、３Ｄゲームパッド等、３次元空間中で対象物の姿勢角（３軸の回転角）の検出に用いるのに適した姿勢角検出装置に関する。
【０００２】
【従来の技術】
従来、バーチャルリアリティーに使用され、頭の動きを検出する方法として、外部に設置された交流磁場発生源から微弱交流磁場を発生し、ＨＭＤに配置したセンサ部で検知し、制御演算部で頭の動きを検出する交流磁場を利用する方法や、外部に設置された超音波発生源からの超音波信号をＨＭＤに配置したセンサ部で検知し、制御演算部で頭の動きを検出する超音波を利用する方法がある。
【０００３】
【発明が解決しようとする課題】
しかしながら、前者の交流磁場を利用した方法では、信号発生源が微弱交流磁場のため、ノイズをキャンセルするためにフィルタを多用することにより応答性が低下し、頭の動きに比べて、ＨＭＤの映像の動きが遅くなり、気分を悪くしたり、酔いを発生する場合があった。
【０００４】
また、後者の超音波を利用した方法では、他の様々な超音波信号の影響を受けての誤動作や、信号発生源とセンサとの間の遮蔽物により信号を検出できなくなる可能性があり、センサの前に腕や髪の毛があるだけで受信不能になり、誤動作してしまうなどの問題があった。
【０００５】
従って、本発明は、上記問題点を解消し、使用する場所や環境の制限を緩和し、幅広く使用できる姿勢角検出装置を提供するものである。
【０００６】
【課題を解決するための手段】
本発明は、水平面で直交するＸ軸、Ｙ軸及び該Ｘ軸、Ｙ軸のそれぞれに直交するＺ軸回りの角速度を検出する３個のジャイロと、該ジャイロの角速度に応じた出力に基づいて、Ｚ軸回りの回転角であるヨー角、Ｚ軸の回りにヨー角だけ座標軸を回した後の新しいＹ軸回りの回転角であるピッチ角及びＺ軸の回りにヨー角だけ回し、新しいＹ軸の回りにピッチ角だけ回した後のさらに新しいＸ軸回りの回転角であるロール角を演算する運動角演算装置と、少なくともＸ−Ｙ平面で互いに直交する２軸の加速度を検出するように配置され、ロ−ル角、ピッチ角を検出するための加速度センサと、少なくとも前記２軸の地磁気を検出するよう配置される地磁気センサと、該加速度センサ及び地磁気センサの出力に基づいて、ロール角、ピッチ角及びヨー角を演算する静止角演算装置と、該静止角演算装置による演算結果の真偽を判定演算する判別装置と、前記静止角演算装置による演算結果により姿勢角の補正係数を選択する補正係数選択装置と、前記判別装置の演算結果に応じて、前記運動角演算装置と静止角演算装置の演算結果及び前記補正係数選択装置の選択結果から出力する姿勢角を演算する姿勢角演算装置とから構成されることを特徴とする姿勢角検出装置である。
【０００７】
また、本発明は、前記補正係数選択装置において、静止角検出手段から求められる静止角[仮のロール角Ｒ（ｎ）、仮のピッチ角Ｐ（ｎ）、仮のヨー角Φ（ｎ）]は、あらかじめ予想される精度によって複数の領域に分けられており、補正係数選択装置は前記分割された領域に応じた補正係数ｍ１（ｉ）、ｍ２(ｉ)、ｍ３（ｉ）（但し、ｉは２以上の前記分割領域を表す自然数で、ｉが小さいほど静止角が小さく予想される精度が良い）を持ち、現在の静止角の領域に応じて補正係数を選択して姿勢角を演算することを特徴とし、前記補正係数ｍ１(ｉ)、ｍ２(ｉ)、ｍ３(ｉ)は、
ｍ１（１）＞＝ｍ１（２）＞＝・・・・・・＞＝ｍ１（ｉ）
ｍ２（１）＞＝ｍ２（２）＞＝・・・・・・＞＝ｍ２（ｉ）
ｍ３（１）＞＝ｍ３（２）＞＝・・・・・・＞＝ｍ３（ｉ）
であることを特徴とする姿勢角検出装置である。
【０００８】
また、本発明は、前記姿勢角検出装置の求めるべき出力をロール角α（ｎ）、ピッチ角β（ｎ）、ヨー角γ（ｎ）、運動角検出手段から求められる運動角を、仮のロール角変化ΔＸ（ｎ）、仮のピッチ角変化ΔＹ（ｎ）、仮のヨー角変化ΔＺ（ｎ）、静止角検出手段から求められる静止角を、仮のロール角Ｒ（ｎ）、仮のピッチ角Ｐ（ｎ）、仮のヨー角Φ（ｎ）、求めるべき出力と静止角との誤差をα（ｎ−１）＋ΔＸ（ｎ）−Ｒ（ｎ）、β（ｎ−１）＋ΔＹ（ｎ）−Ｐ（ｎ）、γ（ｎ−１）＋ΔＺ（ｎ）−Φ（ｎ）、１以下の比例定数をｋ、前記補正係数選択装置により選択された補正係数をｍ１、ｍ２、ｍ３とすると、判別装置の判別結果により、 静止角検出手段からのそれぞれの姿勢角情報Ｒ・Ｐ・Φのうち正しいと判別されたときの姿勢角は、
α(ｎ)＝α(ｎ−１)＋ΔＸ(ｎ)−ｋ［α(ｎ−１)＋ΔＸ(ｎ)−Ｒ(ｎ)］×ｍ１、
β(ｎ)＝β(ｎ−１)＋ΔＹ(ｎ)−ｋ［β(ｎ−１)＋ΔＹ(ｎ)−Ｐ(ｎ)］×ｍ２、
γ(ｎ)＝γ(ｎ−１)＋ΔＺ(ｎ)−ｋ［γ(ｎ−１)＋ΔＺ(ｎ)−Φ(ｎ)］×ｍ３により、
静止角検出手段からのそれぞれの姿勢角情報Ｒ・Ｐ・Φのうち誤りと判別された姿勢角情報に対応する姿勢角は、
α（ｎ）＝α（ｎ−１）＋ΔＸ（ｎ）、
β（ｎ）＝β（ｎ−１）＋ΔＹ（ｎ）、
γ（ｎ）＝γ（ｎ−１）＋ΔＺ（ｎ）により、
演算することを特徴とする姿勢角検出装置である。
【０００９】
【発明の実施の形態】
以下、図面によって本発明の実施の形態について説明する。
【００１０】
図１は、姿勢角検出装置を適用したＨＭＤの一例を示し、このＨＭＤは、目前にあるディスプレイに表示された映像が使用者の頭の動きに連動して変化し、仮想空間を体験できるように設けられているもので、このＨＭＤを装着したまま右を向くと、姿勢角検出装置で計測した頭の姿勢角を映像発生装置に送信し、映像発生装置は、その姿勢角にあった映像をＨＭＤに送信するので、右に展開する映像が映し出され、頭の動きによって全空間の３６０度の映像を実感できるように設けられているものである。
【００１１】
図１に示すように、符号１は、ＨＭＤ本体を示し、このＨＭＤ本体１には、本発明である姿勢角検出装置２が配置され、信号ケーブル４で映像発生装置７に接続されている。
【００１２】
図２は、本発明における姿勢角検出装置の全体構成を示すブロック図である。図２に示すように、３個のジャイロ１２ａ，１２ｂ，１２ｃの出力から仮の姿勢角を演算して求める運動角演算装置１８を備えた運動角検出手段１１と、２個の地磁気センサ２２ａ，２２ｂと２個の加速度センサ２３ａ，２３ｂから静止角を求める静止角演算装置２４を備えた静止角検出手段２１と、この静止角検出手段２１で求めた姿勢角に誤差が含まれるかどうか（例えば、直線的な加速度が加わって、傾斜計としての加速度センサに傾斜以外の信号が含まれる場合）を判別する判別装置３２と、静止角により補正係数を選択する補正係数選択装置３３と、運動角演算装置１８、静止角演算装置２４、及び判別装置３２からの信号を処理する姿勢角演算装置４２とで構成されている。
【００１３】
図３は、本発明の姿勢角検出装置におけるジャイロ、加速度センサ、地磁気センサの配置を示す説明図である。図３に示すように、互いに直交する３軸（水平面で直交する軸をＸ軸、Ｙ軸、そのＸ軸、Ｙ軸それぞれに直交する軸をＺ軸、Ｚ軸回りの回転角をヨー角、Ｚ軸の回りにヨー角だけ座標軸を回した後の新しいＹ軸回りの回転角をピッチ角及びＺ軸の回りにヨー角だけ回し、新しいＹ軸の回りにピッチ角だけ回した後のさらに新しいＸ軸回りの回転角をロール角と記す）の回りの角速度を検出するための第１のジャイロ１２ａ、第２のジャイロ１２ｂ及び第３のジャイロ１２ｃは、センサ座標Ｘ、Ｙ、Ｚ軸各軸に平行に、即ち互いに直交して配置されている。ヨー角を検出する第１の地磁気センサ２２ａ及び第２の地磁気センサ２２ｂは、水平面で互いに直交する２軸（ここでは、センサ座標Ｘ軸及びＹ軸）とで構成されている。同様に、第１の加速度センサ２３ａ及び第２の加速度センサ２３ｂは、水平面で互いに直交する２軸（ここでは、センサ座標Ｘ軸及びＹ軸）に配置されている。ジャイロは、圧電セラミック、圧電単結晶、あるいは、シリコン等の非磁性材料からなる振動子を用いることができる。尚、本実施の形態では、（株）トーキン製の圧電振動セラミックジャイロを用いた。
【００１４】
次に、本発明の姿勢角検出装置のうち、静止角演算装置について示す。２軸の加速度センサ出力から得られるＸ軸方向の加速度Ａｘ（ｎ）及びＹ軸方向の加速度Ａｙ（ｎ）より、ロール角Ｒ（ｎ）及びピッチ角Ｐ（ｎ）を下記の式（１）、（２）より求める。
【００１５】
Ｒ（ｎ）＝ｓｉｎ-1[Ａｘ（ｎ）／ｃｏｓＰ（ｎ）]・・・・・（１）
【００１６】
Ｐ（ｎ）＝ｓｉｎ-1Ａｙ（ｎ）・・・・・・・（２）
【００１７】
ここで、上記式（１）、（２）は、アークサイン関数である。従って、Ｒ、Ｐは、低角度のとき精度が高く、高角度のときは精度が低い。例えば、Ａｘ、Ａｙの出力分解能が０.０１Ｇのときを考えると、０°付近での分解能は０.５７°であり、９０°付近の分解能は８.１１°である。また、Φに関しても、演算過程にＲ、Ｐを用いているので、Ｒ、Ｐのいずれかが高角度のときに精度が低くなる。したがって、Ｒ、Ｐが高角度のときは静止角演算装置が正しいと判断した場合にも精度が低いことに留意しなければならない。
【００１８】
次に、本発明の姿勢角検出装置のうち、補正係数選択装置について示す。上記のように静止角の精度は変化するが、あらかじめこれをいくつかの領域に分割し、それぞれの領域に適当な補正係数ｍ１、ｍ２、ｍ３を入れておく。表１にその１例を示す。
【００１９】
（表１）
表１に示すように、Ｒ、Ｐが高角度になり精度が低くなるにつれて、補正係数が小さくなる。ｍ１にはＲの精度が影響し、ｍ２にはＰの精度が影響し、ｍ３にはＲ、Ｐ両方の精度が影響していることが分かる。このように、補正係数選択装置は現在の姿勢角により補正係数ｍ１、ｍ２、ｍ３を決定する。
【００２１】
次に、本発明の姿勢角検出装置のうち、姿勢角演算装置について示す。本発明の姿勢角検出装置の求めるべき出力をα（ｎ）、β（ｎ）、γ（ｎ）、動的な運動角検出手段から得られる仮の姿勢角をＸ（ｎ）、Ｙ（ｎ）、Ｚ（ｎ）、静的な静止角検出手段から求められる静止角をＲ（ｎ）、Ｐ（ｎ）、Φ（ｎ）とすると、静止角検出手段からの姿勢角情報Ｒ及びＰが正しいと判断された場合は、
α(ｎ)＝α(ｎ−１)＋ΔＸ(ｎ)−ｋ［α(ｎ−１)＋ΔＸ(ｎ)−Ｒ(ｎ)］×ｍ１
β(ｎ)＝β(ｎ−１)＋ΔＹ(ｎ)−ｋ［β(ｎ−１)＋ΔＹ(ｎ)−Ｐ(ｎ)］×ｍ２
γ(ｎ)＝γ(ｎ−１)＋ΔＺ(ｎ)−ｋ［γ(ｎ−１)＋ΔＺ(ｎ)−Φ(ｎ)］×ｍ３
により、姿勢角を演算する。ここで、ｋは任意に選択させる１以下の比例定数である。
【００２２】
また、静止角検出手段からの姿勢角情報が誤と判断する場合、
α（ｎ）＝α（ｎ−１）＋ΔＸ（ｎ）
β（ｎ）＝β（ｎ−１）＋ΔＹ（ｎ）
γ（ｎ）＝γ（ｎ−１）＋ΔＺ（ｎ）
により、姿勢角を演算し、求める。
【００２３】
従って、本実施の形態のように、本発明の姿勢角検出装置をＨＭＤに適用した場合、外部信号を用いることなく、高速応答で累積誤差のない角度情報を得ることができ、高性能である。 なお、本発明による姿勢角検出装置において、ジャイロを素子で搭載しているので、小型軽量化が可能であり、セラミック振動子を使用しているので、磁気ノイズは受けず、磁気センサと近接させても、機能を損なうことがない。
【００２４】
また、本実施の形態では、地磁気センサ、加速度センサが、それぞれ２個の例を示したが、少なくとも、どちらか一方が３個でもよい。小型化という点では、本実施の形態が最も好ましい。
【００２５】
【発明の効果】
本発明によれば、使用する場所や環境の制限を緩和し、幅広く使用できる姿勢角検出装置を提供することができた。
【図面の簡単な説明】
【図１】本発明のＨＭＤにおける姿勢角検出装置の使用状況の説明図。
【図２】本発明の姿勢角変換装置の全体構成を示すブロック図。
【図３】本発明の姿勢角検出装置におけるジャイロ、加速度センサ、地磁気センサの配置を示す説明図。
【符号の説明】
１ ＨＭＤ本体
２ 姿勢角検出装置
４ 信号ケーブル
７ 映像発生装置
１１ 運動角検出手段
１２ａ （第１の）ジャイロ
１２ｂ （第２の）ジャイロ
１２ｃ （第３の）ジャイロ
１３ａ （第１の）Ａ／Ｄコンバータ
１３ｂ （第２の）Ａ／Ｄコンバータ
１３ｃ （第３の）Ａ／Ｄコンバータ
１４ （ＩＩＲ型）デジタルハイパスフィルタ
１５ 正負反転判定装置
１６ ＩＩＲ係数リセット装置
１７ オフセット修正装置
１８ 運動角演算装置
２１ 静止角検出手段
２２ａ （第１の）地磁気センサ
２２ｂ （第２の）地磁気センサ
２３ａ （第１の）加速度センサ
２３ｂ （第２の）加速度センサ
２４ 静止角演算装置
３２ 判別装置
３３ 補正係数選択装置
４２ 姿勢角演算装置
Claims (3)
- 水平面で直交するＸ軸、Ｙ軸及び該Ｘ軸、Ｙ軸のそれぞれに直交するＺ軸回りの角速度を検出する３個のジャイロと、該ジャイロの角速度に応じた出力に基づいて、Ｚ軸回りの回転角であるヨー角、Ｚ軸の回りにヨー角だけ座標軸を回した後の新しいＹ軸回りの回転角であるピッチ角及びＺ軸の回りにヨー角だけ回し、新しいＹ軸の回りにピッチ角だけ回した後のさらに新しいＸ軸回りの回転角であるロール角を演算する運動角演算装置と、少なくともＸ−Ｙ平面で互いに直交する２軸の加速度を検出するように配置され、ロ−ル角、ピッチ角を検出するための加速度センサと、少なくとも前記２軸の地磁気を検出するよう配置される地磁気センサと、該加速度センサ及び地磁気センサの出力に基づいて、ロール角、ピッチ角及びヨー角を演算する静止角演算装置と、該静止角演算装置による演算結果の真偽を判定演算する判別装置と、前記静止角演算装置による演算結果により姿勢角の補正係数を選択する補正係数選択装置と、前記判別装置の演算結果に応じて、前記運動角演算装置と静止角演算装置の演算結果及び前記補正係数選択装置の選択結果から出力する姿勢角を演算する姿勢角演算装置とから構成されることを特徴とする姿勢角検出装置。
- 前記補正係数選択装置において、静止角検出手段から求められる静止角は、あらかじめ予想される精度によって複数の領域に分割されており、補正係数選択装置は前記分割された領域に応じた補正係数ｍ１（ｉ）、ｍ２(ｉ)、ｍ３（ｉ）（但し、ｉは２以上の前記分割された領域を表す自然数で、数値が大きいほど静止角が高角度の領域を表す）を持ち、現在の静止角の領域に応じて補正係数を選択して姿勢角を演算することを特徴とし、前記補正係数ｍ１（ｉ）、ｍ２(ｉ)、ｍ３（ｉ）は、
ｍ１（１）＞＝ｍ１（２）＞＝・・・・・・＞＝ｍ１（ｉ）
ｍ２（１）＞＝ｍ２（２）＞＝・・・・・・＞＝ｍ２（ｉ）
ｍ３（１）＞＝ｍ３（２）＞＝・・・・・・＞＝ｍ３（ｉ）
であることを特徴とする請求項１記載の姿勢角検出装置。 - 前記姿勢角検出装置の求めるべき出力をロール角α（ｎ）、ピッチ角β（ｎ）、ヨー角γ（ｎ）、運動角検出手段から求められる運動角を、仮のロール角変化ΔＸ（ｎ）、仮のピッチ角変化ΔＹ（ｎ）、仮のヨー角変化ΔＺ（ｎ）、静止角検出手段から求められる静止角を、仮のロール角Ｒ（ｎ）、仮のピッチ角Ｐ（ｎ）、仮のヨー角Φ（ｎ）、求めるべき出力と静止角との誤差を、α（ｎ−１）＋ΔＸ（ｎ）−Ｒ（ｎ）、β（ｎ−１）＋ΔＹ（ｎ）−Ｐ（ｎ）、γ（ｎ−１）＋ΔＺ（ｎ）−Φ（ｎ）、１以下の比例定数をｋ、前記補正係数選択装置により選択された補正係数をｍ１、ｍ２、ｍ３とすると、判別装置の判別結果により、 静止角検出手段からのそれぞれの姿勢角情報Ｒ・Ｐ・Φのうち正しいと判別されたときの姿勢角は、
α(ｎ)＝α(ｎ−１)＋ΔＸ(ｎ)−ｋ［α(ｎ−１)＋ΔＸ(ｎ)−Ｒ(ｎ)］×ｍ１、
β(ｎ)＝β(ｎ−１)＋ΔＹ(ｎ)−ｋ［β(ｎ−１)＋ΔＹ(ｎ)−Ｐ(ｎ)］×ｍ２、
γ(ｎ)＝γ(ｎ−１)＋ΔＺ(ｎ)−ｋ［γ(ｎ−１)＋ΔＺ(ｎ)−Φ(ｎ)］×ｍ３により、
静止角検出手段からのそれぞれの姿勢角情報Ｒ・Ｐ・Φのうち誤りと判別された姿勢角情報に対応する姿勢角は、
α（ｎ）＝α（ｎ−１）＋ΔＸ（ｎ）、
β（ｎ）＝β（ｎ−１）＋ΔＹ（ｎ）、
γ（ｎ）＝γ（ｎ−１）＋ΔＺ（ｎ）により、
演算することを特徴とする請求項２記載の姿勢角検出装置。
Priority Applications (13)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP37596598A JP4004165B2 (ja) | 1998-12-17 | 1998-12-17 | 姿勢角検出装置 |
| AU47995/99A AU777641B2 (en) | 1998-12-17 | 1999-07-22 | Orientation angle detector |
| PCT/JP1999/003936 WO2000036376A1 (en) | 1998-12-17 | 1999-07-22 | Orientation angle detector |
| US09/858,000 US6636826B1 (en) | 1998-12-17 | 1999-07-22 | Orientation angle detector |
| KR1020017007662A KR20010105316A (ko) | 1998-12-17 | 1999-07-22 | 방향각 검출기 |
| CNB99816237XA CN1145014C (zh) | 1998-12-17 | 1999-07-22 | 朝向角检测器 |
| CA002353629A CA2353629C (en) | 1998-12-17 | 1999-07-22 | Orientation angle detector |
| DE69904759T DE69904759T2 (de) | 1998-12-17 | 1999-07-22 | Orientierungswinkeldetektor |
| EP99931494A EP1147373B1 (en) | 1998-12-17 | 1999-07-22 | Orientation angle detector |
| TW088112491A TW392066B (en) | 1998-12-17 | 1999-07-22 | Orientation angle detector |
| MYPI99003113A MY118223A (en) | 1998-12-17 | 1999-07-23 | Orientation angle detector |
| NO20013005A NO20013005L (no) | 1998-12-17 | 2001-06-15 | Orienteringsvinkeldetektor |
| HK02102865A HK1041044A1 (en) | 1998-12-17 | 2002-04-16 | Orientation angle detector |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP37596598A JP4004165B2 (ja) | 1998-12-17 | 1998-12-17 | 姿勢角検出装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2000180462A JP2000180462A (ja) | 2000-06-30 |
| JP4004165B2 true JP4004165B2 (ja) | 2007-11-07 |
Family
ID=18506353
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP37596598A Expired - Lifetime JP4004165B2 (ja) | 1998-12-17 | 1998-12-17 | 姿勢角検出装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4004165B2 (ja) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100643304B1 (ko) | 2005-02-15 | 2006-11-10 | 삼성전자주식회사 | 관성 센서 보정 장치 및 방법, 그리고, 상기 방법을 기록한기록 매체 |
| JP4577196B2 (ja) * | 2005-11-30 | 2010-11-10 | 株式会社島津製作所 | 磁気マッピング装置ならびにその取付位置補正方法 |
| JP5043358B2 (ja) * | 2006-04-04 | 2012-10-10 | ラピスセミコンダクタ株式会社 | 傾斜角演算方法及び傾斜角演算装置 |
| JP5109800B2 (ja) * | 2008-05-19 | 2012-12-26 | 株式会社島津製作所 | 磁気計測装置 |
| JP5023111B2 (ja) * | 2009-07-28 | 2012-09-12 | 日本電信電話株式会社 | 情報処理装置、入力情報決定方法、入力情報決定プログラム、および入力情報決定プログラムを記録した記録媒体 |
| CN111928844B (zh) * | 2020-06-11 | 2023-11-03 | 嘉兴市纳杰微电子技术有限公司 | 一种mems陀螺在agv应用上的模型系统 |
-
1998
- 1998-12-17 JP JP37596598A patent/JP4004165B2/ja not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JP2000180462A (ja) | 2000-06-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3842316B2 (ja) | 位置検出装置および傾斜センサ | |
| JP5407863B2 (ja) | 入力装置、制御装置、制御システム及び制御方法 | |
| JP5258974B2 (ja) | 動き感知に基づく力強度および回転強度を入力する方法およびデバイス | |
| TWI474265B (zh) | 移動軌跡校正方法及移動軌跡產生方法 | |
| JP3763435B2 (ja) | 姿勢角検出装置 | |
| JPH09106322A (ja) | ヘッドマウントディスプレイにおける姿勢角検出装置 | |
| US20110307213A1 (en) | System and method of sensing attitude and angular rate using a magnetic field sensor and accelerometer for portable electronic devices | |
| JP2004093562A (ja) | 地磁界センサの姿勢誤差補償装置及び方法 | |
| KR20110030639A (ko) | 데이터 융합을 이용하는 모션 캡처 포인터 | |
| US20210089142A1 (en) | Electronic device for use in motion detection and method for obtaining resultant deviation thereof | |
| JP3960574B2 (ja) | 姿勢角検出装置 | |
| JPH0518750A (ja) | 全範囲傾斜方位測定装置 | |
| JP4004165B2 (ja) | 姿勢角検出装置 | |
| JP3992206B2 (ja) | 姿勢角検出装置 | |
| JP2001208529A (ja) | 計測装置及びその制御方法並びに記憶媒体 | |
| JPH0821732A (ja) | 姿勢方位位置計測装置 | |
| JP3960575B2 (ja) | 姿勢角検出装置 | |
| JP4023889B2 (ja) | 姿勢角検出装置 | |
| JP2006275523A (ja) | 電子方位装置および記録媒体 | |
| JP5457890B2 (ja) | 方位検知装置 | |
| JP2000356520A (ja) | 姿勢角検出装置 | |
| JP3505057B2 (ja) | ペン型入力装置 | |
| JP3886005B2 (ja) | 姿勢角度検出装置 | |
| JP2001033253A (ja) | 姿勢角検出装置 | |
| JP2000329557A (ja) | 姿勢角検出装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050524 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070131 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070330 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070509 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070629 |
|
| 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: 20070808 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070821 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100831 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100831 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110831 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120831 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120831 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130831 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130831 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140831 Year of fee payment: 7 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| EXPY | Cancellation because of completion of term |