特許
J-GLOBAL ID:200903014435283744

姿勢角検出装置

発明者:
出願人/特許権者:
公報種別:公開公報
出願番号(国際出願番号):特願平10-023742
公開番号(公開出願番号):特開平11-211474
出願日: 1998年01月20日
公開日(公表日): 1999年08月06日
要約:
【要約】【課題】 使用する場所や環境の制限を緩和し、幅広く使用できる移動体の姿勢制御検出に用いる姿勢角検出装置を提供すること。【解決手段】 3個のジャイロスコープ5,6,7と、2個の加速度センサ10,11と、2個の地磁気センサ8,9を配置し、前記3個のジャイロスコープが出力する角速度に基づいて運動角検出する運動角演算装置31と、加速度及び地磁気に基づいて姿勢角を検出する静止角演算装置32と、静止角検出結果の正誤を判別する判別装置33と、この判別装置の演算結果に応じて運動角検演算装置と静止角演算装置の演算結果を用いて出力すべき姿勢角度を演算する姿勢角演算装置30を備え、外部の信号発生源を使用することなく移動体の姿勢角度を検出する。
請求項(抜粋):
水平面内で直交する軸をX軸、Y軸とし、そのX軸、Y軸に直交する軸をZ軸とするとき、これら互いに直交するX軸、Y軸、Z軸が形成する基準座標系において、互いに直交する3軸の回りの回転角を検出する姿勢角検出装置において、X軸、Y軸及びZ軸の回りの角速度を検出する3個のジャイロスコープと、該ジャイロスコープの角速度に応じた出力に基づいて単位時間に移動した角度を演算する運動角演算装置と、X-Y平面で互いに直交する2軸の加速度を検出するように配置された加速度センサと、X-Y平面で互いに直交する2軸の地磁気を検出するように配置される地磁気センサと、該加速度センサ及び地磁気センサの出力に基づいて、X軸、Y軸、Z軸回りの回転角を演算する静止角演算装置と、静止角演算装置による演算結果の真偽を判別する判別装置と、該判別装置の演算結果に応じて、運動角演算装置の演算結果と静止角演算装置の演算結果から出力するべき姿勢角を演算する姿勢角演算装置とから構成されることを特徴とする姿勢角検出装置。
IPC (7件):
G01C 15/00 ,  G01C 17/30 ,  G01C 19/00 ,  G01C 19/56 ,  G01P 9/04 ,  G06F 3/033 310 ,  H04N 5/64 511
FI (7件):
G01C 15/00 A ,  G01C 17/30 Z ,  G01C 19/00 Z ,  G01C 19/56 ,  G01P 9/04 ,  G06F 3/033 310 Y ,  H04N 5/64 511 A

前のページに戻る