JP5643334B2 - 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 - Google Patents
角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 Download PDFInfo
- Publication number
- JP5643334B2 JP5643334B2 JP2012544127A JP2012544127A JP5643334B2 JP 5643334 B2 JP5643334 B2 JP 5643334B2 JP 2012544127 A JP2012544127 A JP 2012544127A JP 2012544127 A JP2012544127 A JP 2012544127A JP 5643334 B2 JP5643334 B2 JP 5643334B2
- Authority
- JP
- Japan
- Prior art keywords
- angular velocity
- detection device
- velocity detection
- unit
- moving body
- 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
- 238000001514 detection method Methods 0.000 title claims description 95
- 230000001133 acceleration Effects 0.000 claims description 50
- 238000006243 chemical reaction Methods 0.000 claims description 18
- 230000009466 transformation Effects 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims 1
- 238000000034 method Methods 0.000 description 14
- 238000005070 sampling Methods 0.000 description 11
- 238000012935 Averaging Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 7
- 239000011159 matrix material Substances 0.000 description 5
- 230000003139 buffering effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
- G01C19/5776—Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
-
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Signal Processing (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Description
[ωx se,ωy se,ωz se]=[ωx s−Eav(ωx s),ωy s−Eav(ωy s),ωz s−Eav(ωz s)]
の演算を実行する。バイアス成分除去処理には、時間平均に類似した処理を用いても良い。
この場合は、ミスアライメント角Δφが小さい場合であり、α=α1とする。
この場合は、ミスアライメント角Δφが大きい場合であり、α=α2とする。
Claims (14)
- 移動体に装着され、該移動体の角速度を検出する角速度検出装置であって、
センサ座標系における直交三軸の角速度を計測するジャイロセンサと、
前記移動体が平坦地を旋回中に取得した前記センサ座標系における角速度のみを用いた演算によって、前記ジャイロセンサの直交三軸と前記移動体の直交三軸とのロール方向の角度差またはピッチ方向の角度差を推定するミスアライメント角推定部と、
前記角度差に基づいて前記センサ座標系における角速度から移動体座標系における角速度へ座標変換する座標変換部と、
を備えた角速度検出装置。 - 請求項1に記載の角速度検出装置であって、
前記角速度のバイアス成分を除去するバイアス成分除去部を備え、
前記ミスアライメント角推定部および前記座標変換部は、バイアス成分除去後の角速度を用いて演算を行う、角速度検出装置。 - 請求項2に記載の角速度検出装置であって、
前記バイアス成分除去部は、
前記ジャイロセンサから出力された角速度の時間平均値を用いて、該角速度を補正することで、バイアス成分を除去する、角速度検出装置。 - 請求項1に記載の角速度検出装置であって、
前記角速度を周波数解析し、バイアス成分および雑音成分の周波数成分を除去した周波数成分からなる角速度を算出する周波数解析部を備え、
前記ミスアライメント角推定部および前記座標変換部は、前記周波数解析部から出力される角速度を用いて演算を行う、角速度検出装置。 - 請求項4に記載の角速度検出装置であって、
前記周波数解析部は、ウェーブレット変換を用いて周波数解析を行う、角速度検出装置。 - 請求項1乃至請求項5のいずれかに記載の角速度検出装置であって、
前記移動体の加速度および過去に検出した角速度に基づいて前記旋回中であることを検出する旋回検出部を備える角速度検出装置。 - 請求項1乃至請求項6のいずれかに記載の角速度検出装置と、
該角速度検出装置で検出した角速度を用いて、前記移動体の姿勢角を検出する姿勢角検出部と、
前記移動体の加速度を検出する加速度センサと、
前記測位用信号を受信して、前記移動体の位置、速度、方位を測定する測位部と、
前記姿勢角検出部で得られた姿勢角、前記加速度センサで得られた加速度、前記測位部で得られた位置、速度、方位を用いて、前記移動体の位置、速度、姿勢角を含む移動状態を算出する移動状態算出部と、
を備えた移動状態検出装置。 - 請求項7に記載の移動状態検出装置と、
前記移動状態を含むナビゲーション情報を通知するユーザ通知部と、を備えたナビゲーション装置。 - 移動体の角速度を検出する角速度検出方法であって、
前記移動体に装着されたジャイロセンサによって直交三軸の角速度を計測する計測工程と、
前記移動体が平坦地を旋回中に取得した前記直交三軸の角速度のみを用いた演算によって、前記ジャイロセンサの直交三軸と前記移動体の直交三軸とのロール方向の角度差およびピッチ方向の角度差を推定するミスアライメント角推定工程と、
前記角度差に基づいてセンサ座標系における角速度から移動体座標系における角速度へ座標変換する座標変換工程と、
を有する角速度検出方法。 - 請求項9に記載の角速度検出方法であって、
前記角速度のバイアス成分を除去するバイアス成分除去工程を有し、
前記ミスアライメント角推定工程および前記座標変換工程では、バイアス成分除去後の角速度を用いて演算を行う、角速度検出方法。 - 請求項10に記載の角速度検出方法であって、
前記バイアス成分除去工程では、
前記計測された角速度の時間平均値を用いて、該角速度を補正することで、バイアス成分を除去する、角速度検出方法。 - 請求項9に記載の角速度検出方法であって、
前記角速度を周波数解析し、バイアス成分および雑音成分の周波数成分を除去した周波数成分からなる角速度を算出する周波数解析工程を有し、
前記ミスアライメント角推定工程および前記座標変換工程は、前記周波数解析工程で算出された角速度を用いて演算を行う、角速度検出方法。 - 請求項12に記載の角速度検出装置であって、
前記周波数解析工程では、ウェーブレット変換を用いて周波数解析を行う、角速度検出方法。 - 請求項9乃至請求項13のいずれかに記載の角速度検出方法であって、
前記移動体の加速度に基づいて前記旋回中であることを検出する旋回検出工程を有する角速度検出方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012544127A JP5643334B2 (ja) | 2010-11-18 | 2011-07-15 | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010257377 | 2010-11-18 | ||
JP2010257377 | 2010-11-18 | ||
JP2012544127A JP5643334B2 (ja) | 2010-11-18 | 2011-07-15 | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 |
PCT/JP2011/066179 WO2012066821A1 (ja) | 2010-11-18 | 2011-07-15 | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2012066821A1 JPWO2012066821A1 (ja) | 2014-05-12 |
JP5643334B2 true JP5643334B2 (ja) | 2014-12-17 |
Family
ID=46083765
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012544127A Expired - Fee Related JP5643334B2 (ja) | 2010-11-18 | 2011-07-15 | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20130238277A1 (ja) |
JP (1) | JP5643334B2 (ja) |
WO (1) | WO2012066821A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110133319A (zh) * | 2019-05-10 | 2019-08-16 | 国网上海市电力公司 | 一种gis设备中快速接地开关主轴角速度检测装置 |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101727136B1 (ko) | 2012-11-19 | 2017-04-17 | 한국전자통신연구원 | 차량의 주행 상태를 판단하기 위한 장치 및 방법 |
JP6155873B2 (ja) * | 2013-06-13 | 2017-07-05 | コベルコ建機株式会社 | 建設機械 |
JP6191580B2 (ja) * | 2014-10-28 | 2017-09-06 | トヨタ自動車株式会社 | 移動体のセンサ校正方法 |
FR3035523B1 (fr) * | 2015-04-23 | 2017-04-21 | Parrot | Systeme de pilotage de drone en immersion |
GB201516122D0 (en) | 2015-09-11 | 2015-10-28 | Bae Systems Plc | Inertial sensor data correction |
JP6604175B2 (ja) * | 2015-12-02 | 2019-11-13 | 株式会社Jvcケンウッド | ピッチ角速度補正値算出装置、姿勢角算出装置およびピッチ角速度補正値算出方法 |
JP6883236B2 (ja) * | 2016-09-23 | 2021-06-09 | 株式会社Jvcケンウッド | 取付角算出装置、取付角評価装置、取付角算出方法および取付角評価方法 |
US10580386B2 (en) * | 2017-04-21 | 2020-03-03 | Ford Global Technologies, Llc | In-vehicle projected reality motion correction |
WO2020080459A1 (ja) * | 2018-10-19 | 2020-04-23 | パナソニックIpマネジメント株式会社 | 表示システム、表示装置、及び表示制御方法 |
CN111637901B (zh) * | 2020-04-28 | 2021-12-07 | 北京控制工程研究所 | 一种基于非齐次方程解的多陀螺故障诊断与重构方法 |
CN111649743B (zh) * | 2020-05-08 | 2022-03-22 | 武汉高德红外股份有限公司 | 一种基于光电转塔的目标角速度解算方法及装置 |
JP2021192012A (ja) * | 2020-06-05 | 2021-12-16 | 株式会社東芝 | センサ及び電子装置 |
CN112344965B (zh) * | 2020-11-17 | 2022-07-22 | 中北大学 | 磁测信号与弹体坐标系间姿态失准角的在线标定补偿方法 |
CN112902944B (zh) * | 2021-02-04 | 2022-08-26 | 浙江大学 | 补偿光纤陀螺安装和失准角引起的角度测量误差的方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0243612U (ja) * | 1988-09-19 | 1990-03-26 | ||
JPH02247521A (ja) * | 1989-03-20 | 1990-10-03 | Nec Home Electron Ltd | 角速度センサの補正方法 |
JPH05215564A (ja) * | 1992-02-05 | 1993-08-24 | Japan Aviation Electron Ind Ltd | 車両用位置測定装置 |
JPH08210855A (ja) * | 1995-02-01 | 1996-08-20 | Japan Aviation Electron Ind Ltd | 方位測定装置 |
JPH0996534A (ja) * | 1995-09-29 | 1997-04-08 | Matsushita Electric Ind Co Ltd | ナビゲーション装置 |
JP2000356523A (ja) * | 1999-06-15 | 2000-12-26 | Japan Aviation Electronics Industry Ltd | 角速度センサ |
JP2004045385A (ja) * | 2002-05-16 | 2004-02-12 | Furuno Electric Co Ltd | 移動体の姿勢検出装置 |
JP2004264240A (ja) * | 2003-03-04 | 2004-09-24 | Japan Aviation Electronics Industry Ltd | 慣性装置のミスアライメント計測方法 |
JP2007107951A (ja) * | 2005-10-12 | 2007-04-26 | Matsushita Electric Ind Co Ltd | 取付け角度算出装置 |
WO2010134411A1 (ja) * | 2009-05-19 | 2010-11-25 | 古野電気株式会社 | 移動状態検出装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4344142A (en) * | 1974-05-23 | 1982-08-10 | Federal-Mogul Corporation | Direct digital control of rubber molding presses |
US6556908B1 (en) * | 2002-03-04 | 2003-04-29 | Ford Global Technologies, Inc. | Attitude sensing system for an automotive vehicle relative to the road |
US8239162B2 (en) * | 2006-04-13 | 2012-08-07 | Tanenhaus & Associates, Inc. | Miniaturized inertial measurement unit and associated methods |
DE102005033237B4 (de) * | 2005-07-15 | 2007-09-20 | Siemens Ag | Verfahren zur Bestimmung und Korrektur von Fehlorientierungen und Offsets der Sensoren einer Inertial Measurement Unit in einem Landfahrzeug |
US8712639B2 (en) * | 2006-08-30 | 2014-04-29 | Ford Global Technologies | Integrated control system for stability control of yaw, roll and lateral motion of a driving vehicle using an integrated sensing system to determine longitudinal velocity |
-
2011
- 2011-07-15 US US13/988,202 patent/US20130238277A1/en not_active Abandoned
- 2011-07-15 JP JP2012544127A patent/JP5643334B2/ja not_active Expired - Fee Related
- 2011-07-15 WO PCT/JP2011/066179 patent/WO2012066821A1/ja active Application Filing
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0243612U (ja) * | 1988-09-19 | 1990-03-26 | ||
JPH02247521A (ja) * | 1989-03-20 | 1990-10-03 | Nec Home Electron Ltd | 角速度センサの補正方法 |
JPH05215564A (ja) * | 1992-02-05 | 1993-08-24 | Japan Aviation Electron Ind Ltd | 車両用位置測定装置 |
JPH08210855A (ja) * | 1995-02-01 | 1996-08-20 | Japan Aviation Electron Ind Ltd | 方位測定装置 |
JPH0996534A (ja) * | 1995-09-29 | 1997-04-08 | Matsushita Electric Ind Co Ltd | ナビゲーション装置 |
JP2000356523A (ja) * | 1999-06-15 | 2000-12-26 | Japan Aviation Electronics Industry Ltd | 角速度センサ |
JP2004045385A (ja) * | 2002-05-16 | 2004-02-12 | Furuno Electric Co Ltd | 移動体の姿勢検出装置 |
JP2004264240A (ja) * | 2003-03-04 | 2004-09-24 | Japan Aviation Electronics Industry Ltd | 慣性装置のミスアライメント計測方法 |
JP2007107951A (ja) * | 2005-10-12 | 2007-04-26 | Matsushita Electric Ind Co Ltd | 取付け角度算出装置 |
WO2010134411A1 (ja) * | 2009-05-19 | 2010-11-25 | 古野電気株式会社 | 移動状態検出装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110133319A (zh) * | 2019-05-10 | 2019-08-16 | 国网上海市电力公司 | 一种gis设备中快速接地开关主轴角速度检测装置 |
Also Published As
Publication number | Publication date |
---|---|
WO2012066821A1 (ja) | 2012-05-24 |
US20130238277A1 (en) | 2013-09-12 |
JPWO2012066821A1 (ja) | 2014-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5643334B2 (ja) | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 | |
JP5736106B2 (ja) | 移動状態検出装置 | |
EP1653194B1 (en) | Azimuth/attitude detecting sensor | |
JP6094026B2 (ja) | 姿勢判定方法、位置算出方法及び姿勢判定装置 | |
EP2717014B1 (en) | Position calculation method and position calculation device | |
JP5602070B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
US20110320164A1 (en) | Bias estimating method, posture estimating method, bias estimating device, and posture estimating device | |
RU2007137197A (ru) | Навигационный комплекс, устройство вычисления скорости и координат, бесплатформенная инерциальная курсовертикаль, способ коррекции инерциальных датчиков и устройство для его осуществления | |
JP2010112854A (ja) | 歩行者用ナビゲーション装置および歩行者用ナビゲーション装置における移動方向検出方法 | |
JP6008510B2 (ja) | 計測装置及び計測方法 | |
WO2018179189A1 (ja) | 車載器、演算装置及びプログラム | |
JP6383907B2 (ja) | 車輌位置計測装置及び方法 | |
JP5273127B2 (ja) | 角速度センサ補正装置および角速度センサ補正方法 | |
EP3236206B1 (en) | Direction estimation device and direction estimation method | |
JP5686703B2 (ja) | 移動体回転半径測定装置及び方法 | |
JP5365606B2 (ja) | 角速度センサ補正装置および角速度センサ補正方法 | |
JP4807301B2 (ja) | 姿勢角計測装置及び該姿勢角計測装置に用いられる姿勢角計測方法 | |
JP4376738B2 (ja) | 角速度センサのゼロ点誤差検出装置および方法 | |
JP2015102330A (ja) | 移動情報算出装置、移動情報算出方法、移動情報算出プログラム、および移動体 | |
JP2000292170A (ja) | 移動体姿勢角検出装置 | |
JP5753026B2 (ja) | 移動体横流れ量計測装置及び方法 | |
JP3169213B2 (ja) | 移動速度検出方法及び装置、車両のすべり角検出装置 | |
JP6287804B2 (ja) | 方位推定装置および方位推定方法 | |
JP2012141219A (ja) | 傾斜角検出装置、方法、プログラムおよび記録媒体 | |
JP2002365085A (ja) | 実車速推定装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140311 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140509 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20140509 |
|
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: 20141021 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20141030 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5643334 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |