JP4365402B2 - 移動体の移動角度検出装置 - Google Patents
移動体の移動角度検出装置 Download PDFInfo
- Publication number
- JP4365402B2 JP4365402B2 JP2006342627A JP2006342627A JP4365402B2 JP 4365402 B2 JP4365402 B2 JP 4365402B2 JP 2006342627 A JP2006342627 A JP 2006342627A JP 2006342627 A JP2006342627 A JP 2006342627A JP 4365402 B2 JP4365402 B2 JP 4365402B2
- Authority
- JP
- Japan
- Prior art keywords
- value
- angle
- moving body
- output
- determined
- 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 - Fee Related
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manipulator (AREA)
- Gyroscopes (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Description
Claims (3)
- 移動体に配置され、前記移動体の移動に応じた角速度を示す出力を生じる検出器、前記検出器の出力を順次取り込む出力取り込み手段、前記取り込まれた出力群の中のいずれかを零点を示す較正値と仮決めする較正値仮決め手段、前記仮決めされた較正値とそれ以降に取り込まれた出力群との差の積分値を算出する積分値算出手段、前記取り込まれた出力群の変化幅を算出する変化幅算出手段、前記算出された積分値と変化幅がそれぞれ所定の許容範囲内にあるか否か判定する判定手段、前記許容範囲にあると判定されるとき、前記移動体が静止状態にあると判断して前記仮決めされた較正値を前記積分値の平均値で補正する較正値補正手段、前記積分値が前記所定の許容範囲より狭く設定された第2の所定の許容範囲内にあるか否か判定する第2の判定手段、および前記積分値が前記第2の所定の許容範囲内にあると判定されるとき、前記取り込まれた出力を前記補正された較正値で較正した値に基づき、前記移動体の移動角度を検出する移動角度検出手段を備えると共に、前記移動角度検出手段は、前記積分値が前記第2の所定の許容範囲内にないと判定されるとき、前記補正された較正値と順次取り込まれる出力群との差の第2の積分値が前記第2の所定の許容範囲内にあると判定されるまで前記補正された較正値で較正した値に基づいての前記移動体の移動角度の検出を中止することを特徴とする移動体の移動角度検出装置。
- さらに、前記補正された較正値と前記零点として設定された値の差が絶対値において所定角度未満か否か判定する所定角度判定手段を備えると共に、前記移動角度検出手段は、前記差が所定角度未満と判断されるとき、前記取り込まれた出力を前記補正された較正値で較正した値に基づいて前記移動体の移動角度を検出することを特徴とする請求項1記載の移動体の移動角度検出装置。
- さらに、前記移動体の可動部を駆動するアクチュエータの駆動量を検出する手段を備えると共に、前記移動角度検出手段は、前記駆動量が所定値未満のとき、前記取り込まれた出力を前記補正された較正値で較正した値に基づいて前記移動体の移動角度を検出することを特徴とする請求項1または2記載の移動体の移動角度検出装置。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006342627A JP4365402B2 (ja) | 2006-12-20 | 2006-12-20 | 移動体の移動角度検出装置 |
EP07254722.7A EP1936465B1 (en) | 2006-12-20 | 2007-12-06 | Travel angle detection system for mobile object |
US12/000,996 US7835878B2 (en) | 2006-12-20 | 2007-12-19 | Travel angle detection system for mobile object |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006342627A JP4365402B2 (ja) | 2006-12-20 | 2006-12-20 | 移動体の移動角度検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008151746A JP2008151746A (ja) | 2008-07-03 |
JP4365402B2 true JP4365402B2 (ja) | 2009-11-18 |
Family
ID=39203312
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2006342627A Expired - Fee Related JP4365402B2 (ja) | 2006-12-20 | 2006-12-20 | 移動体の移動角度検出装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US7835878B2 (ja) |
EP (1) | EP1936465B1 (ja) |
JP (1) | JP4365402B2 (ja) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4439572B2 (ja) | 2008-07-11 | 2010-03-24 | 任天堂株式会社 | ディジタルデータ補正プログラムおよびディジタルデータ補正装置 |
US9546883B2 (en) | 2011-11-11 | 2017-01-17 | Qualcomm Incorporated | Sensor auto-calibration |
US20150192440A1 (en) * | 2014-01-07 | 2015-07-09 | InvenSense, Incorporated | Systems and Methods for Initiating Calibration of a Sensor |
AU2015249898B2 (en) * | 2014-04-22 | 2019-07-18 | Blast Motion, Inc. | Initializing an inertial sensor using soft constraints and penalty functions |
EP3189502A1 (en) * | 2014-09-02 | 2017-07-12 | Rudolf C. King | Door and home security system and method |
JP6487385B2 (ja) * | 2016-07-20 | 2019-03-20 | ファナック株式会社 | ロボットの原点位置較正装置および方法 |
GB2555617B (en) * | 2016-11-04 | 2019-09-18 | Jaguar Land Rover Ltd | Calibration system and method |
WO2020087088A2 (en) | 2018-09-25 | 2020-04-30 | Ceva Technologies, Inc. | Methods and apparatus for calibrating the zero rate output of a sensor |
JP7383702B2 (ja) * | 2018-12-13 | 2023-11-20 | シーバ・テクノロジーズ・インコーポレイテッド | センサのゼロレート出力を較正するための方法および装置 |
JP7375038B2 (ja) * | 2019-03-21 | 2023-11-07 | シャークニンジャ オペレーティング エルエルシー | アダプティブセンサーアレイシステムおよび方法 |
CN111750896B (zh) * | 2019-03-28 | 2022-08-05 | 杭州海康机器人技术有限公司 | 云台标定方法、装置、电子设备及存储介质 |
CN112325994A (zh) * | 2020-11-04 | 2021-02-05 | 合肥科迈捷智能传感技术有限公司 | 一种差压流量计零点偏置自动修正方法 |
CN113252077B (zh) * | 2021-05-24 | 2024-05-17 | 深圳市商汤科技有限公司 | 一种标定方法、系统、装置、电子设备以及存储介质 |
Family Cites Families (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4794536A (en) * | 1984-05-24 | 1988-12-27 | Toyoda Koki Kabushiki Kaisha | Steering angle detection device |
JPH01219610A (ja) * | 1988-02-29 | 1989-09-01 | Nissan Motor Co Ltd | 車両用走行方位検出装置 |
JPH0291513A (ja) * | 1988-09-28 | 1990-03-30 | Sumitomo Electric Ind Ltd | ジャイロの零点補正方法及びその装置 |
JP2769837B2 (ja) * | 1989-03-01 | 1998-06-25 | 本田技研工業株式会社 | 自走車の位置検出装置 |
JP2736122B2 (ja) * | 1989-07-14 | 1998-04-02 | 株式会社東芝 | 目標物の位置推定装置 |
JPH03160372A (ja) | 1989-11-17 | 1991-07-10 | Sumitomo Electric Ind Ltd | 加速度検出装置及びこれに用いる加速度検出器 |
JPH04238221A (ja) * | 1991-01-21 | 1992-08-26 | Sumitomo Electric Ind Ltd | 方位検出装置 |
JPH04322995A (ja) | 1991-04-17 | 1992-11-12 | Smc Corp | アクチュエータ |
JPH051915A (ja) * | 1991-06-26 | 1993-01-08 | Toshiba Corp | 車両用走行方位検出装置 |
JP3286334B2 (ja) * | 1992-01-17 | 2002-05-27 | 本田技研工業株式会社 | 移動体の制御装置 |
JP3165045B2 (ja) * | 1996-10-31 | 2001-05-14 | 株式会社データ・テック | 角速度データ補正装置 |
US6477465B1 (en) * | 1999-11-29 | 2002-11-05 | American Gnc Corporation | Vehicle self-carried positioning method and system thereof |
JP2002107147A (ja) | 2000-09-28 | 2002-04-10 | Aisin Seiki Co Ltd | 車両のヨーレート検出装置 |
JP2002333321A (ja) * | 2001-05-07 | 2002-11-22 | Pioneer Electronic Corp | 角速度検出方法及び装置、角度検出方法及び装置、ナビゲーションシステム及びコンピュータプログラム |
KR100956520B1 (ko) * | 2002-04-26 | 2010-05-06 | 혼다 기켄 고교 가부시키가이샤 | 다리식 이동 로봇의 자기위치 추정 장치 |
JP4410051B2 (ja) | 2004-07-22 | 2010-02-03 | 本田技研工業株式会社 | 角速度計測装置および脚式移動ロボット |
JP2006220491A (ja) | 2005-02-09 | 2006-08-24 | Kubota Corp | 傾斜角度計測装置 |
JP4183693B2 (ja) | 2005-03-24 | 2008-11-19 | 株式会社クボタ | 作業機の傾斜制御装置 |
JP2007041733A (ja) * | 2005-08-01 | 2007-02-15 | Toyota Motor Corp | 運動体の姿勢角検出装置 |
-
2006
- 2006-12-20 JP JP2006342627A patent/JP4365402B2/ja not_active Expired - Fee Related
-
2007
- 2007-12-06 EP EP07254722.7A patent/EP1936465B1/en not_active Not-in-force
- 2007-12-19 US US12/000,996 patent/US7835878B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2008151746A (ja) | 2008-07-03 |
EP1936465B1 (en) | 2014-05-21 |
US20080236241A1 (en) | 2008-10-02 |
EP1936465A3 (en) | 2009-10-21 |
EP1936465A2 (en) | 2008-06-25 |
US7835878B2 (en) | 2010-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4365402B2 (ja) | 移動体の移動角度検出装置 | |
JP4673314B2 (ja) | 角速度センサユニット及び角速度センサ診断装置 | |
JP3991978B2 (ja) | 車両用角速度センサの補正診断装置 | |
US9120228B2 (en) | Method of controlling robot and robot | |
JP6622765B2 (ja) | ロボットシステム | |
US20150045952A1 (en) | Torque detecting method and arm device | |
JP2008002992A (ja) | 姿勢角検出装置と姿勢角検出方法 | |
JP2008542782A (ja) | 角速度センサの零点補正装置および補正方法 | |
WO2011111098A1 (ja) | 車両状態検出装置および車両状態検出システム | |
US7292000B2 (en) | Angular velocity measuring device and leg-moving robot | |
CN110465936B (zh) | 控制系统和被驱动体的控制方法 | |
EP1541965A1 (en) | Method and device for accurately detecting attitude of movable body | |
JP2004295027A (ja) | ブレ補正装置 | |
JP6604175B2 (ja) | ピッチ角速度補正値算出装置、姿勢角算出装置およびピッチ角速度補正値算出方法 | |
JP5245531B2 (ja) | 角速度検出装置、角速度検出方法、及び、角速度検出プログラム | |
JP2006155362A (ja) | 回転軸制御装置 | |
JP2009204459A (ja) | 車両用慣性力センサおよび車両の傾斜検出方法 | |
JP2007007796A (ja) | 歩行ロボット | |
JPH08304448A (ja) | 力学量検出器および力学量検出方法 | |
JP4004166B2 (ja) | 地磁気検出装置 | |
JP7391616B2 (ja) | 移動体の姿勢推定装置 | |
JP6632727B2 (ja) | 角度計測装置 | |
Reyhani et al. | Real-time observer designs for elastic-joint industrial robots: Experimental comparison and new strategies | |
CN115127521A (zh) | 倾斜预估 | |
JP2021075181A (ja) | 倒立振子型車両の制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20081126 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090602 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090714 |
|
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: 20090804 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090820 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120828 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4365402 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120828 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130828 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140828 Year of fee payment: 5 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |