Pat
J-GLOBAL ID:200903083120528236

速度算出装置

Inventor:
Applicant, Patent owner:
Agent (1): 小笠原 史朗
Gazette classification:公開公報
Application number (International application number):2003391112
Publication number (International publication number):2005156185
Application date: Nov. 20, 2003
Publication date: Jun. 16, 2005
Summary:
【課題】 より精度の良い移動速度を算出可能な速度算出装置を提供すること【解決手段】 速度算出装置では、角速度センサ1により、移動体の3軸周りの角速度p,q及びrが、加速度センサ2により、2軸方向への加速度gx及びgyが検出される。第1の傾斜角算出部3は、加速度gx及びgyから、静止中の移動体のピッチ角θ2(0)及びロール角θ3(0)を算出する。角速度補正部4は、角度θ2(0)及びθ3(0)と、第2の傾斜角算出部5からの角度θ2及びθ3とから、角速度p、q及びrを補正して、補正値α、β及びγを算出する。第2の傾斜角度算出部5は、補正値α、β及びγを使って、移動体の現在の角度θ2及びθ3を算出する。加速度算出部6は、角度θ2及びθ3と、加速度gx及びgyとを使って、移動体に加わる前後方向への加速度Axを算出する。速度算出部7は、加速度Axを積算して、移動体の速度Vを算出する。【選択図】 図1
Claim (excerpt):
角速度センサ及び加速度センサが搭載された移動体の速度を算出する速度算出装置であって、 前記加速度センサにより検出された加速度を用いて、前記移動体の静止時の傾斜角を第1の傾斜角として算出する第1の傾斜角算出部と、 前記第1の傾斜角算出部で算出された第1の傾斜角を用いて、前記角速度センサにより検出された角速度を補正する角速度補正部と、 前記角速度補正部で補正された角速度を用いて、前記移動体の現在の傾斜角を第2の傾斜角として算出する第2の傾斜角算出部と、 前記加速度センサにより検出された加速度と、前記第2の傾斜角算出部により算出された第2の傾斜角とを用いて、移動体の進行方向に沿う加速度を算出する加速度算出部と、 前記加速度算出部で算出された加速度を用いて、前記移動体の進行方向への速度を算出する速度算出部とを備える、速度算出装置。
IPC (2):
G01P7/00 ,  G01C21/00
FI (2):
G01P7/00 ,  G01C21/00 A
F-Term (7):
2F029AA02 ,  2F029AB01 ,  2F029AC02 ,  2F029AC03 ,  2F029AC04 ,  2F029AC13 ,  2F029AD01
Patent cited by the Patent:
Cited by applicant (1)
  • 車速度検出装置
    Gazette classification:公開公報   Application number:特願平7-149585   Applicant:株式会社データ・テック, 株式会社ロジン, 住友精密工業株式会社

Return to Previous Page